ld_sdmmc.c revision 1.3.2.2
1 1.3.2.2 sborrill /* $NetBSD: ld_sdmmc.c,v 1.3.2.2 2009/10/07 15:41:13 sborrill Exp $ */ 2 1.3.2.2 sborrill 3 1.3.2.2 sborrill /* 4 1.3.2.2 sborrill * Copyright (c) 2008 KIYOHARA Takashi 5 1.3.2.2 sborrill * All rights reserved. 6 1.3.2.2 sborrill * 7 1.3.2.2 sborrill * Redistribution and use in source and binary forms, with or without 8 1.3.2.2 sborrill * modification, are permitted provided that the following conditions 9 1.3.2.2 sborrill * are met: 10 1.3.2.2 sborrill * 1. Redistributions of source code must retain the above copyright 11 1.3.2.2 sborrill * notice, this list of conditions and the following disclaimer. 12 1.3.2.2 sborrill * 2. Redistributions in binary form must reproduce the above copyright 13 1.3.2.2 sborrill * notice, this list of conditions and the following disclaimer in the 14 1.3.2.2 sborrill * documentation and/or other materials provided with the distribution. 15 1.3.2.2 sborrill * 16 1.3.2.2 sborrill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.3.2.2 sborrill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 18 1.3.2.2 sborrill * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 19 1.3.2.2 sborrill * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 20 1.3.2.2 sborrill * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 21 1.3.2.2 sborrill * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 22 1.3.2.2 sborrill * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 1.3.2.2 sborrill * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 24 1.3.2.2 sborrill * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 25 1.3.2.2 sborrill * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 1.3.2.2 sborrill * POSSIBILITY OF SUCH DAMAGE. 27 1.3.2.2 sborrill * 28 1.3.2.2 sborrill */ 29 1.3.2.2 sborrill 30 1.3.2.2 sborrill #include <sys/cdefs.h> 31 1.3.2.2 sborrill __KERNEL_RCSID(0, "$NetBSD: ld_sdmmc.c,v 1.3.2.2 2009/10/07 15:41:13 sborrill Exp $"); 32 1.3.2.2 sborrill 33 1.3.2.2 sborrill #include "rnd.h" 34 1.3.2.2 sborrill 35 1.3.2.2 sborrill #include <sys/param.h> 36 1.3.2.2 sborrill #include <sys/systm.h> 37 1.3.2.2 sborrill #include <sys/kernel.h> 38 1.3.2.2 sborrill #include <sys/device.h> 39 1.3.2.2 sborrill #include <sys/buf.h> 40 1.3.2.2 sborrill #include <sys/bufq.h> 41 1.3.2.2 sborrill #include <sys/bus.h> 42 1.3.2.2 sborrill #include <sys/callout.h> 43 1.3.2.2 sborrill #include <sys/endian.h> 44 1.3.2.2 sborrill #include <sys/dkio.h> 45 1.3.2.2 sborrill #include <sys/disk.h> 46 1.3.2.2 sborrill #include <sys/kthread.h> 47 1.3.2.2 sborrill #if NRND > 0 48 1.3.2.2 sborrill #include <sys/rnd.h> 49 1.3.2.2 sborrill #endif 50 1.3.2.2 sborrill 51 1.3.2.2 sborrill #include <uvm/uvm_extern.h> 52 1.3.2.2 sborrill 53 1.3.2.2 sborrill #include <dev/ldvar.h> 54 1.3.2.2 sborrill 55 1.3.2.2 sborrill #include <dev/sdmmc/sdmmcvar.h> 56 1.3.2.2 sborrill 57 1.3.2.2 sborrill #ifdef SDMMC_DEBUG 58 1.3.2.2 sborrill #define DPRINTF(s) printf s 59 1.3.2.2 sborrill #else 60 1.3.2.2 sborrill #define DPRINTF(s) /**/ 61 1.3.2.2 sborrill #endif 62 1.3.2.2 sborrill 63 1.3.2.2 sborrill struct ld_sdmmc_softc; 64 1.3.2.2 sborrill 65 1.3.2.2 sborrill struct ld_sdmmc_task { 66 1.3.2.2 sborrill struct sdmmc_task task; 67 1.3.2.2 sborrill 68 1.3.2.2 sborrill struct ld_sdmmc_softc *task_sc; 69 1.3.2.2 sborrill struct buf *task_bp; 70 1.3.2.2 sborrill callout_t task_callout; 71 1.3.2.2 sborrill }; 72 1.3.2.2 sborrill 73 1.3.2.2 sborrill struct ld_sdmmc_softc { 74 1.3.2.2 sborrill struct ld_softc sc_ld; 75 1.3.2.2 sborrill int sc_hwunit; 76 1.3.2.2 sborrill 77 1.3.2.2 sborrill struct sdmmc_function *sc_sf; 78 1.3.2.2 sborrill struct ld_sdmmc_task sc_task; 79 1.3.2.2 sborrill }; 80 1.3.2.2 sborrill 81 1.3.2.2 sborrill static int ld_sdmmc_match(device_t, cfdata_t, void *); 82 1.3.2.2 sborrill static void ld_sdmmc_attach(device_t, device_t, void *); 83 1.3.2.2 sborrill static int ld_sdmmc_detach(device_t, int); 84 1.3.2.2 sborrill 85 1.3.2.2 sborrill static int ld_sdmmc_dump(struct ld_softc *, void *, int, int); 86 1.3.2.2 sborrill static int ld_sdmmc_start(struct ld_softc *, struct buf *); 87 1.3.2.2 sborrill 88 1.3.2.2 sborrill static void ld_sdmmc_doattach(void *); 89 1.3.2.2 sborrill static void ld_sdmmc_dobio(void *); 90 1.3.2.2 sborrill static void ld_sdmmc_timeout(void *); 91 1.3.2.2 sborrill 92 1.3.2.2 sborrill CFATTACH_DECL_NEW(ld_sdmmc, sizeof(struct ld_sdmmc_softc), 93 1.3.2.2 sborrill ld_sdmmc_match, ld_sdmmc_attach, ld_sdmmc_detach, NULL); 94 1.3.2.2 sborrill 95 1.3.2.2 sborrill 96 1.3.2.2 sborrill /* ARGSUSED */ 97 1.3.2.2 sborrill static int 98 1.3.2.2 sborrill ld_sdmmc_match(device_t parent, cfdata_t match, void *aux) 99 1.3.2.2 sborrill { 100 1.3.2.2 sborrill struct sdmmc_softc *sdmsc = device_private(parent); 101 1.3.2.2 sborrill 102 1.3.2.2 sborrill if (ISSET(sdmsc->sc_flags, SMF_MEM_MODE)) 103 1.3.2.2 sborrill return 1; 104 1.3.2.2 sborrill return 0; 105 1.3.2.2 sborrill } 106 1.3.2.2 sborrill 107 1.3.2.2 sborrill /* ARGSUSED */ 108 1.3.2.2 sborrill static void 109 1.3.2.2 sborrill ld_sdmmc_attach(device_t parent, device_t self, void *aux) 110 1.3.2.2 sborrill { 111 1.3.2.2 sborrill struct ld_sdmmc_softc *sc = device_private(self); 112 1.3.2.2 sborrill struct sdmmc_attach_args *sa = aux; 113 1.3.2.2 sborrill struct ld_softc *ld = &sc->sc_ld; 114 1.3.2.2 sborrill struct lwp *lwp; 115 1.3.2.2 sborrill 116 1.3.2.2 sborrill ld->sc_dv = self; 117 1.3.2.2 sborrill 118 1.3.2.2 sborrill aprint_normal("\n"); 119 1.3.2.2 sborrill aprint_naive("\n"); 120 1.3.2.2 sborrill 121 1.3.2.2 sborrill callout_init(&sc->sc_task.task_callout, CALLOUT_MPSAFE); 122 1.3.2.2 sborrill 123 1.3.2.2 sborrill sc->sc_hwunit = 0; /* always 0? */ 124 1.3.2.2 sborrill sc->sc_sf = sa->sf; 125 1.3.2.2 sborrill 126 1.3.2.2 sborrill ld->sc_flags = LDF_ENABLED; 127 1.3.2.2 sborrill ld->sc_secperunit = sc->sc_sf->csd.capacity; 128 1.3.2.2 sborrill ld->sc_secsize = sc->sc_sf->csd.sector_size; 129 1.3.2.2 sborrill ld->sc_maxxfer = MAXPHYS; 130 1.3.2.2 sborrill ld->sc_maxqueuecnt = 1; 131 1.3.2.2 sborrill ld->sc_dump = ld_sdmmc_dump; 132 1.3.2.2 sborrill ld->sc_start = ld_sdmmc_start; 133 1.3.2.2 sborrill 134 1.3.2.2 sborrill /* 135 1.3.2.2 sborrill * It is avoided that the error occurs when the card attaches it, 136 1.3.2.2 sborrill * when wedge is supported. 137 1.3.2.2 sborrill */ 138 1.3.2.2 sborrill if (kthread_create(PRI_NONE, KTHREAD_MPSAFE, NULL, 139 1.3.2.2 sborrill ld_sdmmc_doattach, sc, &lwp, "%sattach", device_xname(self))) { 140 1.3.2.2 sborrill aprint_error_dev(self, "couldn't create thread\n"); 141 1.3.2.2 sborrill } 142 1.3.2.2 sborrill } 143 1.3.2.2 sborrill 144 1.3.2.2 sborrill static void 145 1.3.2.2 sborrill ld_sdmmc_doattach(void *arg) 146 1.3.2.2 sborrill { 147 1.3.2.2 sborrill struct ld_sdmmc_softc *sc = (struct ld_sdmmc_softc *)arg; 148 1.3.2.2 sborrill struct ld_softc *ld = &sc->sc_ld; 149 1.3.2.2 sborrill 150 1.3.2.2 sborrill ldattach(ld); 151 1.3.2.2 sborrill kthread_exit(0); 152 1.3.2.2 sborrill } 153 1.3.2.2 sborrill 154 1.3.2.2 sborrill static int 155 1.3.2.2 sborrill ld_sdmmc_detach(device_t dev, int flags) 156 1.3.2.2 sborrill { 157 1.3.2.2 sborrill struct ld_sdmmc_softc *sc = device_private(dev); 158 1.3.2.2 sborrill struct ld_softc *ld = &sc->sc_ld; 159 1.3.2.2 sborrill int rv; 160 1.3.2.2 sborrill 161 1.3.2.2 sborrill if ((rv = ldbegindetach(ld, flags)) != 0) 162 1.3.2.2 sborrill return rv; 163 1.3.2.2 sborrill ldenddetach(ld); 164 1.3.2.2 sborrill 165 1.3.2.2 sborrill return 0; 166 1.3.2.2 sborrill } 167 1.3.2.2 sborrill 168 1.3.2.2 sborrill static int 169 1.3.2.2 sborrill ld_sdmmc_start(struct ld_softc *ld, struct buf *bp) 170 1.3.2.2 sborrill { 171 1.3.2.2 sborrill struct ld_sdmmc_softc *sc = device_private(ld->sc_dv); 172 1.3.2.2 sborrill struct ld_sdmmc_task *task = &sc->sc_task; 173 1.3.2.2 sborrill 174 1.3.2.2 sborrill task->task_sc = sc; 175 1.3.2.2 sborrill task->task_bp = bp; 176 1.3.2.2 sborrill sdmmc_init_task(&task->task, ld_sdmmc_dobio, task); 177 1.3.2.2 sborrill 178 1.3.2.2 sborrill callout_reset(&task->task_callout, hz, ld_sdmmc_timeout, task); 179 1.3.2.2 sborrill sdmmc_add_task(sc->sc_sf->sc, &task->task); 180 1.3.2.2 sborrill 181 1.3.2.2 sborrill return 0; 182 1.3.2.2 sborrill } 183 1.3.2.2 sborrill 184 1.3.2.2 sborrill static void 185 1.3.2.2 sborrill ld_sdmmc_dobio(void *arg) 186 1.3.2.2 sborrill { 187 1.3.2.2 sborrill struct ld_sdmmc_task *task = (struct ld_sdmmc_task *)arg; 188 1.3.2.2 sborrill struct ld_sdmmc_softc *sc = task->task_sc; 189 1.3.2.2 sborrill struct buf *bp = task->task_bp; 190 1.3.2.2 sborrill int error, s; 191 1.3.2.2 sborrill 192 1.3.2.2 sborrill callout_stop(&task->task_callout); 193 1.3.2.2 sborrill 194 1.3.2.2 sborrill /* 195 1.3.2.2 sborrill * I/O operation 196 1.3.2.2 sborrill */ 197 1.3.2.2 sborrill DPRINTF(("%s: I/O operation (dir=%s, blkno=0x%jx, bcnt=0x%x)\n", 198 1.3.2.2 sborrill device_xname(sc->sc_ld.sc_dv), bp->b_flags & B_READ ? "IN" : "OUT", 199 1.3.2.2 sborrill bp->b_rawblkno, bp->b_bcount)); 200 1.3.2.2 sborrill 201 1.3.2.2 sborrill /* is everything done in terms of blocks? */ 202 1.3.2.2 sborrill if (bp->b_rawblkno >= sc->sc_sf->csd.capacity) { 203 1.3.2.2 sborrill /* trying to read or write past end of device */ 204 1.3.2.2 sborrill DPRINTF(("%s: blkno exceeds capacity 0x%x\n", 205 1.3.2.2 sborrill device_xname(sc->sc_ld.sc_dv), sc->sc_sf->csd.capacity)); 206 1.3.2.2 sborrill bp->b_error = EIO; /* XXX */ 207 1.3.2.2 sborrill bp->b_resid = bp->b_bcount; 208 1.3.2.2 sborrill lddone(&sc->sc_ld, bp); 209 1.3.2.2 sborrill return; 210 1.3.2.2 sborrill } 211 1.3.2.2 sborrill 212 1.3.2.2 sborrill s = splbio(); 213 1.3.2.2 sborrill if (bp->b_flags & B_READ) 214 1.3.2.2 sborrill error = sdmmc_mem_read_block(sc->sc_sf, bp->b_rawblkno, 215 1.3.2.2 sborrill bp->b_data, bp->b_bcount); 216 1.3.2.2 sborrill else 217 1.3.2.2 sborrill error = sdmmc_mem_write_block(sc->sc_sf, bp->b_rawblkno, 218 1.3.2.2 sborrill bp->b_data, bp->b_bcount); 219 1.3.2.2 sborrill if (error) { 220 1.3.2.2 sborrill DPRINTF(("%s: error %d\n", device_xname(sc->sc_ld.sc_dv), 221 1.3.2.2 sborrill error)); 222 1.3.2.2 sborrill bp->b_error = EIO; /* XXXX */ 223 1.3.2.2 sborrill bp->b_resid = bp->b_bcount; 224 1.3.2.2 sborrill } else { 225 1.3.2.2 sborrill bp->b_resid = 0; 226 1.3.2.2 sborrill } 227 1.3.2.2 sborrill splx(s); 228 1.3.2.2 sborrill 229 1.3.2.2 sborrill lddone(&sc->sc_ld, bp); 230 1.3.2.2 sborrill } 231 1.3.2.2 sborrill 232 1.3.2.2 sborrill static void 233 1.3.2.2 sborrill ld_sdmmc_timeout(void *arg) 234 1.3.2.2 sborrill { 235 1.3.2.2 sborrill struct ld_sdmmc_task *task = (struct ld_sdmmc_task *)arg; 236 1.3.2.2 sborrill struct ld_sdmmc_softc *sc = task->task_sc; 237 1.3.2.2 sborrill struct buf *bp = task->task_bp; 238 1.3.2.2 sborrill int s; 239 1.3.2.2 sborrill 240 1.3.2.2 sborrill s = splbio(); 241 1.3.2.2 sborrill if (!sdmmc_task_pending(&task->task)) { 242 1.3.2.2 sborrill splx(s); 243 1.3.2.2 sborrill return; 244 1.3.2.2 sborrill } 245 1.3.2.2 sborrill bp->b_error = EIO; /* XXXX */ 246 1.3.2.2 sborrill bp->b_resid = bp->b_bcount; 247 1.3.2.2 sborrill sdmmc_del_task(&task->task); 248 1.3.2.2 sborrill splx(s); 249 1.3.2.2 sborrill 250 1.3.2.2 sborrill lddone(&sc->sc_ld, bp); 251 1.3.2.2 sborrill } 252 1.3.2.2 sborrill 253 1.3.2.2 sborrill static int 254 1.3.2.2 sborrill ld_sdmmc_dump(struct ld_softc *ld, void *data, int blkno, int blkcnt) 255 1.3.2.2 sborrill { 256 1.3.2.2 sborrill struct ld_sdmmc_softc *sc = device_private(ld->sc_dv); 257 1.3.2.2 sborrill 258 1.3.2.2 sborrill return sdmmc_mem_write_block(sc->sc_sf, blkno, data, 259 1.3.2.2 sborrill blkcnt * ld->sc_secsize); 260 1.3.2.2 sborrill } 261
Indexes created Wed Oct 22 13:09:56 GMT 2025