bcm2835_emmc.c revision 1.14
1 /* $NetBSD: bcm2835_emmc.c,v 1.14 2014/09/13 08:08:24 skrll Exp $ */ 2 3 /*- 4 * Copyright (c) 2012 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Nick Hudson 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #include <sys/cdefs.h> 33 __KERNEL_RCSID(0, "$NetBSD: bcm2835_emmc.c,v 1.14 2014/09/13 08:08:24 skrll Exp $"); 34 35 #include "bcmdmac.h" 36 37 #include <sys/param.h> 38 #include <sys/systm.h> 39 #include <sys/device.h> 40 #include <sys/bus.h> 41 #include <sys/condvar.h> 42 #include <sys/mutex.h> 43 #include <sys/kernel.h> 44 45 #include <arm/broadcom/bcm2835reg.h> 46 #include <arm/broadcom/bcm_amba.h> 47 #include <arm/broadcom/bcm2835_dmac.h> 48 49 #include <dev/sdmmc/sdhcreg.h> 50 #include <dev/sdmmc/sdhcvar.h> 51 #include <dev/sdmmc/sdmmcvar.h> 52 53 enum bcmemmc_dma_state { 54 EMMC_DMA_STATE_IDLE, 55 EMMC_DMA_STATE_BUSY, 56 }; 57 58 struct bcmemmc_softc { 59 struct sdhc_softc sc; 60 61 bus_space_tag_t sc_iot; 62 bus_space_handle_t sc_ioh; 63 bus_size_t sc_ios; 64 struct sdhc_host *sc_hosts[1]; 65 void *sc_ih; 66 67 kmutex_t sc_lock; 68 kcondvar_t sc_cv; 69 70 enum bcmemmc_dma_state sc_state; 71 72 struct bcm_dmac_channel *sc_dmac; 73 74 bus_dmamap_t sc_dmamap; 75 bus_dma_segment_t sc_segs[1]; /* XXX assumes enough descriptors fit in one page */ 76 struct bcm_dmac_conblk *sc_cblk; 77 78 uint32_t sc_physaddr; 79 }; 80 81 static int bcmemmc_match(device_t, struct cfdata *, void *); 82 static void bcmemmc_attach(device_t, device_t, void *); 83 static void bcmemmc_attach_i(device_t); 84 #if BCMDMAC > 0 85 static int bcmemmc_xfer_data_dma(struct sdhc_host *, struct sdmmc_command *); 86 static void bcmemmc_dma_done(void *); 87 #endif 88 89 CFATTACH_DECL_NEW(bcmemmc, sizeof(struct bcmemmc_softc), 90 bcmemmc_match, bcmemmc_attach, NULL, NULL); 91 92 /* ARGSUSED */ 93 static int 94 bcmemmc_match(device_t parent, struct cfdata *match, void *aux) 95 { 96 struct amba_attach_args *aaa = aux; 97 98 if (strcmp(aaa->aaa_name, "emmc") != 0) 99 return 0; 100 101 return 1; 102 } 103 104 /* ARGSUSED */ 105 static void 106 bcmemmc_attach(device_t parent, device_t self, void *aux) 107 { 108 struct bcmemmc_softc *sc = device_private(self); 109 prop_dictionary_t dict = device_properties(self); 110 struct amba_attach_args *aaa = aux; 111 prop_number_t frequency; 112 int error; 113 114 sc->sc.sc_dev = self; 115 sc->sc.sc_dmat = aaa->aaa_dmat; 116 sc->sc.sc_flags = 0; 117 sc->sc.sc_flags |= SDHC_FLAG_32BIT_ACCESS; 118 sc->sc.sc_flags |= SDHC_FLAG_HOSTCAPS; 119 sc->sc.sc_flags |= SDHC_FLAG_NO_HS_BIT; 120 sc->sc.sc_caps = SDHC_VOLTAGE_SUPP_3_3V | SDHC_HIGH_SPEED_SUPP | 121 SDHC_MAX_BLK_LEN_1024; 122 123 sc->sc.sc_host = sc->sc_hosts; 124 sc->sc.sc_clkbase = 50000; /* Default to 50MHz */ 125 sc->sc_iot = aaa->aaa_iot; 126 127 /* Fetch the EMMC clock frequency from property if set. */ 128 frequency = prop_dictionary_get(dict, "frequency"); 129 if (frequency != NULL) { 130 sc->sc.sc_clkbase = prop_number_integer_value(frequency) / 1000; 131 } 132 133 error = bus_space_map(sc->sc_iot, aaa->aaa_addr, aaa->aaa_size, 0, 134 &sc->sc_ioh); 135 if (error) { 136 aprint_error_dev(self, 137 "can't map registers for %s: %d\n", aaa->aaa_name, error); 138 return; 139 } 140 sc->sc_ios = aaa->aaa_size; 141 sc->sc_physaddr = aaa->aaa_addr; 142 143 aprint_naive(": SDHC controller\n"); 144 aprint_normal(": SDHC controller\n"); 145 146 sc->sc_ih = bcm2835_intr_establish(aaa->aaa_intr, IPL_SDMMC, sdhc_intr, 147 &sc->sc); 148 149 if (sc->sc_ih == NULL) { 150 aprint_error_dev(self, "failed to establish interrupt %d\n", 151 aaa->aaa_intr); 152 goto fail; 153 } 154 aprint_normal_dev(self, "interrupting on intr %d\n", aaa->aaa_intr); 155 156 #if BCMDMAC > 0 157 sc->sc_dmac = bcm_dmac_alloc(BCM_DMAC_TYPE_NORMAL, IPL_SDMMC, 158 bcmemmc_dma_done, sc); 159 if (sc->sc_dmac == NULL) 160 goto done; 161 162 sc->sc.sc_flags |= SDHC_FLAG_USE_DMA; 163 sc->sc.sc_flags |= SDHC_FLAG_EXTERNAL_DMA; 164 sc->sc.sc_caps |= SDHC_DMA_SUPPORT; 165 sc->sc.sc_vendor_transfer_data_dma = bcmemmc_xfer_data_dma; 166 167 sc->sc_state = EMMC_DMA_STATE_IDLE; 168 mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SDMMC); 169 cv_init(&sc->sc_cv, "bcmemmcdma"); 170 171 int rseg; 172 error = bus_dmamem_alloc(sc->sc.sc_dmat, PAGE_SIZE, PAGE_SIZE, 173 PAGE_SIZE, sc->sc_segs, 1, &rseg, BUS_DMA_WAITOK); 174 if (error) { 175 aprint_error_dev(self, "dmamem_alloc failed (%d)\n", error); 176 goto fail; 177 } 178 179 error = bus_dmamem_map(sc->sc.sc_dmat, sc->sc_segs, rseg, PAGE_SIZE, 180 (void **)&sc->sc_cblk, BUS_DMA_WAITOK); 181 if (error) { 182 aprint_error_dev(self, "dmamem_map failed (%d)\n", error); 183 goto fail; 184 } 185 KASSERT(sc->sc_cblk != NULL); 186 187 memset(sc->sc_cblk, 0, PAGE_SIZE); 188 189 error = bus_dmamap_create(sc->sc.sc_dmat, PAGE_SIZE, 1, PAGE_SIZE, 0, 190 BUS_DMA_WAITOK, &sc->sc_dmamap); 191 if (error) { 192 aprint_error_dev(self, "dmamap_create failed (%d)\n", error); 193 goto fail; 194 } 195 196 error = bus_dmamap_load(sc->sc.sc_dmat, sc->sc_dmamap, sc->sc_cblk, 197 PAGE_SIZE, NULL, BUS_DMA_WAITOK|BUS_DMA_WRITE); 198 if (error) { 199 aprint_error_dev(self, "dmamap_load failed (%d)\n", error); 200 goto fail; 201 } 202 203 done: 204 #endif 205 config_interrupts(self, bcmemmc_attach_i); 206 return; 207 208 fail: 209 /* XXX add bus_dma failure cleanup */ 210 if (sc->sc_ih) { 211 intr_disestablish(sc->sc_ih); 212 sc->sc_ih = NULL; 213 } 214 bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_ios); 215 } 216 217 static void 218 bcmemmc_attach_i(device_t self) 219 { 220 struct bcmemmc_softc * const sc = device_private(self); 221 int error; 222 223 error = sdhc_host_found(&sc->sc, sc->sc_iot, sc->sc_ioh, sc->sc_ios); 224 if (error != 0) { 225 aprint_error_dev(self, "couldn't initialize host, error=%d\n", 226 error); 227 goto fail; 228 } 229 return; 230 231 fail: 232 /* XXX add bus_dma failure cleanup */ 233 if (sc->sc_ih) { 234 intr_disestablish(sc->sc_ih); 235 sc->sc_ih = NULL; 236 } 237 bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_ios); 238 } 239 240 #if BCMDMAC > 0 241 static int 242 bcmemmc_xfer_data_dma(struct sdhc_host *hp, struct sdmmc_command *cmd) 243 { 244 struct bcmemmc_softc * const sc = *(void **)hp; /* XXX XXX XXX */ 245 size_t seg; 246 int error; 247 248 for (seg = 0; seg < cmd->c_dmamap->dm_nsegs; seg++) { 249 sc->sc_cblk[seg].cb_ti = 250 __SHIFTIN(11, DMAC_TI_PERMAP); /* e.MMC */ 251 if (ISSET(cmd->c_flags, SCF_CMD_READ)) { 252 sc->sc_cblk[seg].cb_ti |= DMAC_TI_DEST_INC; 253 sc->sc_cblk[seg].cb_ti |= DMAC_TI_DEST_WIDTH; 254 sc->sc_cblk[seg].cb_ti |= DMAC_TI_SRC_DREQ; 255 sc->sc_cblk[seg].cb_source_ad = 256 BCM2835_PERIPHERALS_TO_BUS(sc->sc_physaddr + 257 SDHC_DATA); 258 sc->sc_cblk[seg].cb_dest_ad = 259 cmd->c_dmamap->dm_segs[seg].ds_addr; 260 } else { 261 sc->sc_cblk[seg].cb_ti |= DMAC_TI_SRC_INC; 262 sc->sc_cblk[seg].cb_ti |= DMAC_TI_SRC_WIDTH; 263 sc->sc_cblk[seg].cb_ti |= DMAC_TI_DEST_DREQ; 264 sc->sc_cblk[seg].cb_source_ad = 265 cmd->c_dmamap->dm_segs[seg].ds_addr; 266 sc->sc_cblk[seg].cb_dest_ad = 267 BCM2835_PERIPHERALS_TO_BUS(sc->sc_physaddr + 268 SDHC_DATA); 269 } 270 sc->sc_cblk[seg].cb_txfr_len = 271 cmd->c_dmamap->dm_segs[seg].ds_len; 272 sc->sc_cblk[seg].cb_stride = 0; 273 if (seg == cmd->c_dmamap->dm_nsegs - 1) { 274 sc->sc_cblk[seg].cb_ti |= DMAC_TI_WAIT_RESP; 275 sc->sc_cblk[seg].cb_ti |= DMAC_TI_INTEN; 276 sc->sc_cblk[seg].cb_nextconbk = 0; 277 } else { 278 sc->sc_cblk[seg].cb_nextconbk = 279 sc->sc_dmamap->dm_segs[0].ds_addr + 280 sizeof(struct bcm_dmac_conblk) * (seg+1); 281 } 282 sc->sc_cblk[seg].cb_padding[0] = 0; 283 sc->sc_cblk[seg].cb_padding[1] = 0; 284 } 285 286 bus_dmamap_sync(sc->sc.sc_dmat, sc->sc_dmamap, 0, 287 sc->sc_dmamap->dm_mapsize, BUS_DMASYNC_PREWRITE); 288 289 error = 0; 290 291 mutex_enter(&sc->sc_lock); 292 KASSERT(sc->sc_state == EMMC_DMA_STATE_IDLE); 293 sc->sc_state = EMMC_DMA_STATE_BUSY; 294 bcm_dmac_set_conblk_addr(sc->sc_dmac, 295 sc->sc_dmamap->dm_segs[0].ds_addr); 296 bcm_dmac_transfer(sc->sc_dmac); 297 while (sc->sc_state == EMMC_DMA_STATE_BUSY) { 298 error = cv_timedwait(&sc->sc_cv, &sc->sc_lock, hz * 10); 299 if (error == EWOULDBLOCK) { 300 device_printf(sc->sc.sc_dev, "transfer timeout!\n"); 301 bcm_dmac_halt(sc->sc_dmac); 302 sc->sc_state = EMMC_DMA_STATE_IDLE; 303 error = ETIMEDOUT; 304 break; 305 } 306 } 307 mutex_exit(&sc->sc_lock); 308 309 bus_dmamap_sync(sc->sc.sc_dmat, sc->sc_dmamap, 0, 310 sc->sc_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE); 311 312 return error; 313 } 314 315 static void 316 bcmemmc_dma_done(void *arg) 317 { 318 struct bcmemmc_softc * const sc = arg; 319 320 mutex_enter(&sc->sc_lock); 321 KASSERT(sc->sc_state == EMMC_DMA_STATE_BUSY); 322 sc->sc_state = EMMC_DMA_STATE_IDLE; 323 cv_broadcast(&sc->sc_cv); 324 mutex_exit(&sc->sc_lock); 325 326 } 327 #endif 328
Indexes created Tue Sep 30 10:09:55 GMT 2025