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