sdmmc.c revision 1.10 1 1.10 nonaka /* $NetBSD: sdmmc.c,v 1.10 2012/01/21 19:44:31 nonaka Exp $ */
2 1.1 nonaka /* $OpenBSD: sdmmc.c,v 1.18 2009/01/09 10:58:38 jsg Exp $ */
3 1.1 nonaka
4 1.1 nonaka /*
5 1.1 nonaka * Copyright (c) 2006 Uwe Stuehler <uwe (at) openbsd.org>
6 1.1 nonaka *
7 1.1 nonaka * Permission to use, copy, modify, and distribute this software for any
8 1.1 nonaka * purpose with or without fee is hereby granted, provided that the above
9 1.1 nonaka * copyright notice and this permission notice appear in all copies.
10 1.1 nonaka *
11 1.1 nonaka * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12 1.1 nonaka * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13 1.1 nonaka * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14 1.1 nonaka * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15 1.1 nonaka * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16 1.1 nonaka * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17 1.1 nonaka * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 1.1 nonaka */
19 1.1 nonaka
20 1.1 nonaka /*-
21 1.10 nonaka * Copyright (C) 2007, 2008, 2009 NONAKA Kimihiro <nonaka (at) netbsd.org>
22 1.1 nonaka * All rights reserved.
23 1.1 nonaka *
24 1.1 nonaka * Redistribution and use in source and binary forms, with or without
25 1.1 nonaka * modification, are permitted provided that the following conditions
26 1.1 nonaka * are met:
27 1.1 nonaka * 1. Redistributions of source code must retain the above copyright
28 1.1 nonaka * notice, this list of conditions and the following disclaimer.
29 1.1 nonaka * 2. Redistributions in binary form must reproduce the above copyright
30 1.1 nonaka * notice, this list of conditions and the following disclaimer in the
31 1.1 nonaka * documentation and/or other materials provided with the distribution.
32 1.1 nonaka *
33 1.10 nonaka * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
34 1.10 nonaka * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
35 1.10 nonaka * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
36 1.10 nonaka * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
37 1.10 nonaka * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
38 1.10 nonaka * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
39 1.10 nonaka * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
40 1.10 nonaka * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
41 1.10 nonaka * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
42 1.10 nonaka * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
43 1.1 nonaka */
44 1.1 nonaka
45 1.1 nonaka /*
46 1.1 nonaka * Host controller independent SD/MMC bus driver based on information
47 1.1 nonaka * from SanDisk SD Card Product Manual Revision 2.2 (SanDisk), SDIO
48 1.1 nonaka * Simple Specification Version 1.0 (SDIO) and the Linux "mmc" driver.
49 1.1 nonaka */
50 1.1 nonaka
51 1.1 nonaka #include <sys/cdefs.h>
52 1.10 nonaka __KERNEL_RCSID(0, "$NetBSD: sdmmc.c,v 1.10 2012/01/21 19:44:31 nonaka Exp $");
53 1.1 nonaka
54 1.1 nonaka #include <sys/param.h>
55 1.1 nonaka #include <sys/device.h>
56 1.1 nonaka #include <sys/kernel.h>
57 1.1 nonaka #include <sys/kthread.h>
58 1.1 nonaka #include <sys/malloc.h>
59 1.1 nonaka #include <sys/proc.h>
60 1.1 nonaka #include <sys/systm.h>
61 1.2 nonaka #include <sys/callout.h>
62 1.1 nonaka
63 1.4 kiyohara #include <machine/vmparam.h>
64 1.4 kiyohara
65 1.1 nonaka #include <dev/sdmmc/sdmmc_ioreg.h>
66 1.1 nonaka #include <dev/sdmmc/sdmmcchip.h>
67 1.1 nonaka #include <dev/sdmmc/sdmmcreg.h>
68 1.1 nonaka #include <dev/sdmmc/sdmmcvar.h>
69 1.1 nonaka
70 1.1 nonaka #ifdef SDMMC_DEBUG
71 1.1 nonaka int sdmmcdebug = 1;
72 1.1 nonaka static void sdmmc_dump_command(struct sdmmc_softc *, struct sdmmc_command *);
73 1.1 nonaka #define DPRINTF(n,s) do { if ((n) <= sdmmcdebug) printf s; } while (0)
74 1.1 nonaka #else
75 1.1 nonaka #define DPRINTF(n,s) do {} while (0)
76 1.1 nonaka #endif
77 1.1 nonaka
78 1.1 nonaka #define DEVNAME(sc) SDMMCDEVNAME(sc)
79 1.1 nonaka
80 1.1 nonaka static int sdmmc_match(device_t, cfdata_t, void *);
81 1.1 nonaka static void sdmmc_attach(device_t, device_t, void *);
82 1.1 nonaka static int sdmmc_detach(device_t, int);
83 1.1 nonaka
84 1.1 nonaka CFATTACH_DECL_NEW(sdmmc, sizeof(struct sdmmc_softc),
85 1.1 nonaka sdmmc_match, sdmmc_attach, sdmmc_detach, NULL);
86 1.1 nonaka
87 1.1 nonaka static void sdmmc_doattach(device_t);
88 1.1 nonaka static void sdmmc_task_thread(void *);
89 1.1 nonaka static void sdmmc_discover_task(void *);
90 1.2 nonaka static void sdmmc_polling_card(void *);
91 1.1 nonaka static void sdmmc_card_attach(struct sdmmc_softc *);
92 1.1 nonaka static void sdmmc_card_detach(struct sdmmc_softc *, int);
93 1.1 nonaka static int sdmmc_print(void *, const char *);
94 1.1 nonaka static int sdmmc_enable(struct sdmmc_softc *);
95 1.1 nonaka static void sdmmc_disable(struct sdmmc_softc *);
96 1.1 nonaka static int sdmmc_scan(struct sdmmc_softc *);
97 1.1 nonaka static int sdmmc_init(struct sdmmc_softc *);
98 1.1 nonaka
99 1.1 nonaka static int
100 1.1 nonaka sdmmc_match(device_t parent, cfdata_t cf, void *aux)
101 1.1 nonaka {
102 1.1 nonaka struct sdmmcbus_attach_args *saa = (struct sdmmcbus_attach_args *)aux;
103 1.1 nonaka
104 1.1 nonaka if (strcmp(saa->saa_busname, cf->cf_name) == 0)
105 1.1 nonaka return 1;
106 1.1 nonaka return 0;
107 1.1 nonaka }
108 1.1 nonaka
109 1.1 nonaka static void
110 1.1 nonaka sdmmc_attach(device_t parent, device_t self, void *aux)
111 1.1 nonaka {
112 1.1 nonaka struct sdmmc_softc *sc = device_private(self);
113 1.1 nonaka struct sdmmcbus_attach_args *saa = (struct sdmmcbus_attach_args *)aux;
114 1.1 nonaka int error;
115 1.1 nonaka
116 1.1 nonaka aprint_normal("\n");
117 1.1 nonaka aprint_naive("\n");
118 1.1 nonaka
119 1.1 nonaka sc->sc_dev = self;
120 1.1 nonaka sc->sc_sct = saa->saa_sct;
121 1.2 nonaka sc->sc_spi_sct = saa->saa_spi_sct;
122 1.1 nonaka sc->sc_sch = saa->saa_sch;
123 1.1 nonaka sc->sc_dmat = saa->saa_dmat;
124 1.1 nonaka sc->sc_clkmin = saa->saa_clkmin;
125 1.1 nonaka sc->sc_clkmax = saa->saa_clkmax;
126 1.1 nonaka sc->sc_busclk = sc->sc_clkmax;
127 1.1 nonaka sc->sc_buswidth = 1;
128 1.1 nonaka sc->sc_caps = saa->saa_caps;
129 1.1 nonaka
130 1.1 nonaka if (ISSET(sc->sc_caps, SMC_CAPS_DMA)) {
131 1.1 nonaka error = bus_dmamap_create(sc->sc_dmat, MAXPHYS, SDMMC_MAXNSEGS,
132 1.1 nonaka MAXPHYS, 0, BUS_DMA_NOWAIT|BUS_DMA_ALLOCNOW, &sc->sc_dmap);
133 1.1 nonaka if (error) {
134 1.1 nonaka aprint_error_dev(sc->sc_dev,
135 1.1 nonaka "couldn't create dma map. (error=%d)\n", error);
136 1.1 nonaka return;
137 1.1 nonaka }
138 1.1 nonaka }
139 1.1 nonaka
140 1.2 nonaka if (ISSET(sc->sc_caps, SMC_CAPS_POLL_CARD_DET)) {
141 1.2 nonaka callout_init(&sc->sc_card_detect_ch, 0);
142 1.2 nonaka callout_reset(&sc->sc_card_detect_ch, hz,
143 1.2 nonaka sdmmc_polling_card, sc);
144 1.2 nonaka }
145 1.2 nonaka
146 1.1 nonaka SIMPLEQ_INIT(&sc->sf_head);
147 1.1 nonaka TAILQ_INIT(&sc->sc_tskq);
148 1.1 nonaka TAILQ_INIT(&sc->sc_intrq);
149 1.1 nonaka
150 1.1 nonaka sdmmc_init_task(&sc->sc_discover_task, sdmmc_discover_task, sc);
151 1.1 nonaka sdmmc_init_task(&sc->sc_intr_task, sdmmc_intr_task, sc);
152 1.1 nonaka
153 1.1 nonaka mutex_init(&sc->sc_mtx, MUTEX_DEFAULT, IPL_SDMMC);
154 1.1 nonaka mutex_init(&sc->sc_tskq_mtx, MUTEX_DEFAULT, IPL_SDMMC);
155 1.1 nonaka mutex_init(&sc->sc_discover_task_mtx, MUTEX_DEFAULT, IPL_SDMMC);
156 1.1 nonaka mutex_init(&sc->sc_intr_task_mtx, MUTEX_DEFAULT, IPL_SDMMC);
157 1.1 nonaka cv_init(&sc->sc_tskq_cv, "mmctaskq");
158 1.1 nonaka
159 1.1 nonaka if (!pmf_device_register(self, NULL, NULL)) {
160 1.1 nonaka aprint_error_dev(self, "couldn't establish power handler\n");
161 1.1 nonaka }
162 1.1 nonaka
163 1.1 nonaka SET(sc->sc_flags, SMF_INITED);
164 1.1 nonaka
165 1.1 nonaka /*
166 1.1 nonaka * Create the event thread that will attach and detach cards
167 1.1 nonaka * and perform other lengthy operations.
168 1.1 nonaka */
169 1.1 nonaka config_pending_incr();
170 1.1 nonaka config_interrupts(self, sdmmc_doattach);
171 1.1 nonaka }
172 1.1 nonaka
173 1.1 nonaka static int
174 1.1 nonaka sdmmc_detach(device_t self, int flags)
175 1.1 nonaka {
176 1.1 nonaka struct sdmmc_softc *sc = device_private(self);
177 1.1 nonaka int error;
178 1.1 nonaka
179 1.1 nonaka mutex_enter(&sc->sc_tskq_mtx);
180 1.1 nonaka sc->sc_dying = 1;
181 1.1 nonaka cv_signal(&sc->sc_tskq_cv);
182 1.1 nonaka while (sc->sc_tskq_lwp != NULL)
183 1.1 nonaka cv_wait(&sc->sc_tskq_cv, &sc->sc_tskq_mtx);
184 1.1 nonaka mutex_exit(&sc->sc_tskq_mtx);
185 1.1 nonaka
186 1.1 nonaka pmf_device_deregister(self);
187 1.1 nonaka
188 1.1 nonaka error = config_detach_children(self, flags);
189 1.1 nonaka if (error)
190 1.1 nonaka return error;
191 1.1 nonaka return 0;
192 1.1 nonaka }
193 1.1 nonaka
194 1.1 nonaka static void
195 1.1 nonaka sdmmc_doattach(device_t dev)
196 1.1 nonaka {
197 1.1 nonaka struct sdmmc_softc *sc = device_private(dev);
198 1.1 nonaka
199 1.1 nonaka if (kthread_create(PRI_NONE, KTHREAD_MPSAFE, NULL,
200 1.1 nonaka sdmmc_task_thread, sc, &sc->sc_tskq_lwp, "%s", device_xname(dev))) {
201 1.1 nonaka aprint_error_dev(dev, "couldn't create task thread\n");
202 1.1 nonaka }
203 1.1 nonaka }
204 1.1 nonaka
205 1.1 nonaka void
206 1.1 nonaka sdmmc_add_task(struct sdmmc_softc *sc, struct sdmmc_task *task)
207 1.1 nonaka {
208 1.1 nonaka
209 1.1 nonaka mutex_enter(&sc->sc_tskq_mtx);
210 1.1 nonaka task->onqueue = 1;
211 1.1 nonaka task->sc = sc;
212 1.1 nonaka TAILQ_INSERT_TAIL(&sc->sc_tskq, task, next);
213 1.1 nonaka cv_broadcast(&sc->sc_tskq_cv);
214 1.1 nonaka mutex_exit(&sc->sc_tskq_mtx);
215 1.1 nonaka }
216 1.1 nonaka
217 1.1 nonaka static inline void
218 1.1 nonaka sdmmc_del_task1(struct sdmmc_softc *sc, struct sdmmc_task *task)
219 1.1 nonaka {
220 1.1 nonaka
221 1.1 nonaka TAILQ_REMOVE(&sc->sc_tskq, task, next);
222 1.1 nonaka task->sc = NULL;
223 1.1 nonaka task->onqueue = 0;
224 1.1 nonaka }
225 1.1 nonaka
226 1.1 nonaka void
227 1.1 nonaka sdmmc_del_task(struct sdmmc_task *task)
228 1.1 nonaka {
229 1.1 nonaka struct sdmmc_softc *sc = (struct sdmmc_softc *)task->sc;
230 1.1 nonaka
231 1.1 nonaka if (sc != NULL) {
232 1.1 nonaka mutex_enter(&sc->sc_tskq_mtx);
233 1.1 nonaka sdmmc_del_task1(sc, task);
234 1.1 nonaka mutex_exit(&sc->sc_tskq_mtx);
235 1.1 nonaka }
236 1.1 nonaka }
237 1.1 nonaka
238 1.1 nonaka static void
239 1.1 nonaka sdmmc_task_thread(void *arg)
240 1.1 nonaka {
241 1.1 nonaka struct sdmmc_softc *sc = (struct sdmmc_softc *)arg;
242 1.1 nonaka struct sdmmc_task *task;
243 1.1 nonaka
244 1.1 nonaka sdmmc_discover_task(sc);
245 1.1 nonaka config_pending_decr();
246 1.1 nonaka
247 1.1 nonaka mutex_enter(&sc->sc_tskq_mtx);
248 1.1 nonaka for (;;) {
249 1.1 nonaka task = TAILQ_FIRST(&sc->sc_tskq);
250 1.1 nonaka if (task != NULL) {
251 1.1 nonaka sdmmc_del_task1(sc, task);
252 1.1 nonaka mutex_exit(&sc->sc_tskq_mtx);
253 1.1 nonaka (*task->func)(task->arg);
254 1.1 nonaka mutex_enter(&sc->sc_tskq_mtx);
255 1.1 nonaka } else {
256 1.1 nonaka /* Check for the exit condition. */
257 1.1 nonaka if (sc->sc_dying)
258 1.1 nonaka break;
259 1.1 nonaka cv_wait(&sc->sc_tskq_cv, &sc->sc_tskq_mtx);
260 1.1 nonaka }
261 1.1 nonaka }
262 1.1 nonaka /* time to die. */
263 1.1 nonaka sc->sc_dying = 0;
264 1.1 nonaka if (ISSET(sc->sc_flags, SMF_CARD_PRESENT))
265 1.1 nonaka sdmmc_card_detach(sc, DETACH_FORCE);
266 1.1 nonaka sc->sc_tskq_lwp = NULL;
267 1.1 nonaka cv_broadcast(&sc->sc_tskq_cv);
268 1.1 nonaka mutex_exit(&sc->sc_tskq_mtx);
269 1.1 nonaka kthread_exit(0);
270 1.1 nonaka }
271 1.1 nonaka
272 1.1 nonaka void
273 1.1 nonaka sdmmc_needs_discover(device_t dev)
274 1.1 nonaka {
275 1.1 nonaka struct sdmmc_softc *sc = device_private(dev);
276 1.1 nonaka
277 1.1 nonaka if (!ISSET(sc->sc_flags, SMF_INITED))
278 1.1 nonaka return;
279 1.1 nonaka
280 1.1 nonaka mutex_enter(&sc->sc_discover_task_mtx);
281 1.1 nonaka if (!sdmmc_task_pending(&sc->sc_discover_task))
282 1.1 nonaka sdmmc_add_task(sc, &sc->sc_discover_task);
283 1.1 nonaka mutex_exit(&sc->sc_discover_task_mtx);
284 1.1 nonaka }
285 1.1 nonaka
286 1.1 nonaka static void
287 1.1 nonaka sdmmc_discover_task(void *arg)
288 1.1 nonaka {
289 1.1 nonaka struct sdmmc_softc *sc = (struct sdmmc_softc *)arg;
290 1.1 nonaka
291 1.1 nonaka if (sdmmc_chip_card_detect(sc->sc_sct, sc->sc_sch)) {
292 1.1 nonaka if (!ISSET(sc->sc_flags, SMF_CARD_PRESENT)) {
293 1.1 nonaka SET(sc->sc_flags, SMF_CARD_PRESENT);
294 1.1 nonaka sdmmc_card_attach(sc);
295 1.3 kiyohara if (!ISSET(sc->sc_flags, SMF_CARD_ATTACHED))
296 1.3 kiyohara CLR(sc->sc_flags, SMF_CARD_PRESENT);
297 1.1 nonaka }
298 1.1 nonaka } else {
299 1.1 nonaka if (ISSET(sc->sc_flags, SMF_CARD_PRESENT)) {
300 1.1 nonaka CLR(sc->sc_flags, SMF_CARD_PRESENT);
301 1.1 nonaka sdmmc_card_detach(sc, DETACH_FORCE);
302 1.1 nonaka }
303 1.1 nonaka }
304 1.1 nonaka }
305 1.1 nonaka
306 1.2 nonaka static void
307 1.2 nonaka sdmmc_polling_card(void *arg)
308 1.2 nonaka {
309 1.2 nonaka struct sdmmc_softc *sc = (struct sdmmc_softc *)arg;
310 1.2 nonaka int card_detect;
311 1.2 nonaka int s;
312 1.2 nonaka
313 1.2 nonaka s = splsdmmc();
314 1.2 nonaka card_detect = sdmmc_chip_card_detect(sc->sc_sct, sc->sc_sch);
315 1.2 nonaka if (card_detect) {
316 1.2 nonaka if (!ISSET(sc->sc_flags, SMF_CARD_PRESENT)) {
317 1.2 nonaka sdmmc_needs_discover(sc->sc_dev);
318 1.2 nonaka }
319 1.2 nonaka } else {
320 1.2 nonaka if (ISSET(sc->sc_flags, SMF_CARD_PRESENT)) {
321 1.2 nonaka sdmmc_needs_discover(sc->sc_dev);
322 1.2 nonaka }
323 1.2 nonaka }
324 1.2 nonaka splx(s);
325 1.2 nonaka
326 1.2 nonaka callout_schedule(&sc->sc_card_detect_ch, hz);
327 1.2 nonaka }
328 1.2 nonaka
329 1.1 nonaka /*
330 1.1 nonaka * Called from process context when a card is present.
331 1.1 nonaka */
332 1.1 nonaka static void
333 1.1 nonaka sdmmc_card_attach(struct sdmmc_softc *sc)
334 1.1 nonaka {
335 1.1 nonaka struct sdmmc_function *sf;
336 1.1 nonaka struct sdmmc_attach_args saa;
337 1.1 nonaka int error;
338 1.1 nonaka
339 1.1 nonaka DPRINTF(1,("%s: attach card\n", DEVNAME(sc)));
340 1.1 nonaka
341 1.1 nonaka CLR(sc->sc_flags, SMF_CARD_ATTACHED);
342 1.1 nonaka
343 1.1 nonaka /*
344 1.1 nonaka * Power up the card (or card stack).
345 1.1 nonaka */
346 1.1 nonaka error = sdmmc_enable(sc);
347 1.1 nonaka if (error) {
348 1.9 nonaka if (!ISSET(sc->sc_caps, SMC_CAPS_POLL_CARD_DET)) {
349 1.9 nonaka aprint_error_dev(sc->sc_dev, "couldn't enable card\n");
350 1.9 nonaka }
351 1.1 nonaka goto err;
352 1.1 nonaka }
353 1.1 nonaka
354 1.1 nonaka /*
355 1.1 nonaka * Scan for I/O functions and memory cards on the bus,
356 1.1 nonaka * allocating a sdmmc_function structure for each.
357 1.1 nonaka */
358 1.1 nonaka error = sdmmc_scan(sc);
359 1.1 nonaka if (error) {
360 1.1 nonaka aprint_error_dev(sc->sc_dev, "no functions\n");
361 1.1 nonaka goto err;
362 1.1 nonaka }
363 1.1 nonaka
364 1.1 nonaka /*
365 1.2 nonaka * Initialize the I/O functions and memory cards.
366 1.2 nonaka */
367 1.2 nonaka error = sdmmc_init(sc);
368 1.2 nonaka if (error) {
369 1.2 nonaka aprint_error_dev(sc->sc_dev, "init failed\n");
370 1.2 nonaka goto err;
371 1.2 nonaka }
372 1.2 nonaka
373 1.1 nonaka SIMPLEQ_FOREACH(sf, &sc->sf_head, sf_list) {
374 1.1 nonaka if (ISSET(sc->sc_flags, SMF_IO_MODE) && sf->number < 1)
375 1.1 nonaka continue;
376 1.1 nonaka
377 1.1 nonaka memset(&saa, 0, sizeof saa);
378 1.1 nonaka saa.manufacturer = sf->cis.manufacturer;
379 1.1 nonaka saa.product = sf->cis.product;
380 1.6 kiyohara saa.interface = sf->interface;
381 1.1 nonaka saa.sf = sf;
382 1.1 nonaka
383 1.1 nonaka sf->child =
384 1.1 nonaka config_found_ia(sc->sc_dev, "sdmmc", &saa, sdmmc_print);
385 1.1 nonaka }
386 1.1 nonaka
387 1.1 nonaka SET(sc->sc_flags, SMF_CARD_ATTACHED);
388 1.1 nonaka return;
389 1.1 nonaka
390 1.1 nonaka err:
391 1.1 nonaka sdmmc_card_detach(sc, DETACH_FORCE);
392 1.1 nonaka }
393 1.1 nonaka
394 1.1 nonaka /*
395 1.1 nonaka * Called from process context with DETACH_* flags from <sys/device.h>
396 1.1 nonaka * when cards are gone.
397 1.1 nonaka */
398 1.1 nonaka static void
399 1.1 nonaka sdmmc_card_detach(struct sdmmc_softc *sc, int flags)
400 1.1 nonaka {
401 1.1 nonaka struct sdmmc_function *sf, *sfnext;
402 1.1 nonaka
403 1.1 nonaka DPRINTF(1,("%s: detach card\n", DEVNAME(sc)));
404 1.1 nonaka
405 1.1 nonaka if (ISSET(sc->sc_flags, SMF_CARD_ATTACHED)) {
406 1.1 nonaka SIMPLEQ_FOREACH(sf, &sc->sf_head, sf_list) {
407 1.1 nonaka if (sf->child != NULL) {
408 1.1 nonaka config_detach(sf->child, DETACH_FORCE);
409 1.1 nonaka sf->child = NULL;
410 1.1 nonaka }
411 1.1 nonaka }
412 1.1 nonaka
413 1.1 nonaka KASSERT(TAILQ_EMPTY(&sc->sc_intrq));
414 1.1 nonaka
415 1.1 nonaka CLR(sc->sc_flags, SMF_CARD_ATTACHED);
416 1.1 nonaka }
417 1.1 nonaka
418 1.1 nonaka /* Power down. */
419 1.1 nonaka sdmmc_disable(sc);
420 1.1 nonaka
421 1.1 nonaka /* Free all sdmmc_function structures. */
422 1.1 nonaka for (sf = SIMPLEQ_FIRST(&sc->sf_head); sf != NULL; sf = sfnext) {
423 1.1 nonaka sfnext = SIMPLEQ_NEXT(sf, sf_list);
424 1.1 nonaka sdmmc_function_free(sf);
425 1.1 nonaka }
426 1.1 nonaka SIMPLEQ_INIT(&sc->sf_head);
427 1.1 nonaka sc->sc_function_count = 0;
428 1.1 nonaka sc->sc_fn0 = NULL;
429 1.1 nonaka }
430 1.1 nonaka
431 1.1 nonaka static int
432 1.1 nonaka sdmmc_print(void *aux, const char *pnp)
433 1.1 nonaka {
434 1.1 nonaka struct sdmmc_attach_args *sa = aux;
435 1.1 nonaka struct sdmmc_function *sf = sa->sf;
436 1.1 nonaka struct sdmmc_cis *cis = &sf->sc->sc_fn0->cis;
437 1.1 nonaka int i;
438 1.1 nonaka
439 1.1 nonaka if (pnp) {
440 1.1 nonaka if (sf->number == 0)
441 1.1 nonaka return QUIET;
442 1.1 nonaka
443 1.1 nonaka for (i = 0; i < 4 && cis->cis1_info[i]; i++)
444 1.1 nonaka printf("%s%s", i ? ", " : "\"", cis->cis1_info[i]);
445 1.1 nonaka if (i != 0)
446 1.1 nonaka printf("\"");
447 1.1 nonaka
448 1.1 nonaka if (cis->manufacturer != SDMMC_VENDOR_INVALID &&
449 1.1 nonaka cis->product != SDMMC_PRODUCT_INVALID) {
450 1.1 nonaka printf("%s(", i ? " " : "");
451 1.1 nonaka if (cis->manufacturer != SDMMC_VENDOR_INVALID)
452 1.1 nonaka printf("manufacturer 0x%x%s",
453 1.1 nonaka cis->manufacturer,
454 1.1 nonaka cis->product == SDMMC_PRODUCT_INVALID ?
455 1.1 nonaka "" : ", ");
456 1.1 nonaka if (cis->product != SDMMC_PRODUCT_INVALID)
457 1.1 nonaka printf("product 0x%x", cis->product);
458 1.1 nonaka printf(")");
459 1.1 nonaka }
460 1.1 nonaka printf("%sat %s", i ? " " : "", pnp);
461 1.1 nonaka }
462 1.1 nonaka if (sf->number > 0)
463 1.1 nonaka printf(" function %d", sf->number);
464 1.1 nonaka
465 1.1 nonaka if (!pnp) {
466 1.1 nonaka for (i = 0; i < 3 && cis->cis1_info[i]; i++)
467 1.1 nonaka printf("%s%s", i ? ", " : " \"", cis->cis1_info[i]);
468 1.1 nonaka if (i != 0)
469 1.1 nonaka printf("\"");
470 1.1 nonaka }
471 1.1 nonaka return UNCONF;
472 1.1 nonaka }
473 1.1 nonaka
474 1.1 nonaka static int
475 1.1 nonaka sdmmc_enable(struct sdmmc_softc *sc)
476 1.1 nonaka {
477 1.1 nonaka int error;
478 1.1 nonaka
479 1.1 nonaka /*
480 1.1 nonaka * Calculate the equivalent of the card OCR from the host
481 1.1 nonaka * capabilities and select the maximum supported bus voltage.
482 1.1 nonaka */
483 1.1 nonaka error = sdmmc_chip_bus_power(sc->sc_sct, sc->sc_sch,
484 1.1 nonaka sdmmc_chip_host_ocr(sc->sc_sct, sc->sc_sch));
485 1.1 nonaka if (error) {
486 1.1 nonaka aprint_error_dev(sc->sc_dev, "couldn't supply bus power\n");
487 1.1 nonaka goto out;
488 1.1 nonaka }
489 1.1 nonaka
490 1.1 nonaka /*
491 1.1 nonaka * Select the minimum clock frequency.
492 1.1 nonaka */
493 1.1 nonaka error = sdmmc_chip_bus_clock(sc->sc_sct, sc->sc_sch, SDMMC_SDCLK_400K);
494 1.1 nonaka if (error) {
495 1.1 nonaka aprint_error_dev(sc->sc_dev, "couldn't supply clock\n");
496 1.1 nonaka goto out;
497 1.1 nonaka }
498 1.1 nonaka
499 1.1 nonaka /* XXX wait for card to power up */
500 1.1 nonaka sdmmc_delay(100000);
501 1.1 nonaka
502 1.2 nonaka if (!ISSET(sc->sc_caps, SMC_CAPS_SPI_MODE)) {
503 1.2 nonaka /* Initialize SD I/O card function(s). */
504 1.2 nonaka error = sdmmc_io_enable(sc);
505 1.2 nonaka if (error)
506 1.2 nonaka goto out;
507 1.2 nonaka }
508 1.1 nonaka
509 1.2 nonaka /* Initialize SD/MMC memory card(s). */
510 1.2 nonaka if (ISSET(sc->sc_caps, SMC_CAPS_SPI_MODE) ||
511 1.2 nonaka ISSET(sc->sc_flags, SMF_MEM_MODE))
512 1.1 nonaka error = sdmmc_mem_enable(sc);
513 1.1 nonaka
514 1.1 nonaka out:
515 1.1 nonaka if (error)
516 1.1 nonaka sdmmc_disable(sc);
517 1.1 nonaka return error;
518 1.1 nonaka }
519 1.1 nonaka
520 1.1 nonaka static void
521 1.1 nonaka sdmmc_disable(struct sdmmc_softc *sc)
522 1.1 nonaka {
523 1.1 nonaka /* XXX complete commands if card is still present. */
524 1.1 nonaka
525 1.2 nonaka if (!ISSET(sc->sc_caps, SMC_CAPS_SPI_MODE)) {
526 1.2 nonaka /* Make sure no card is still selected. */
527 1.2 nonaka (void)sdmmc_select_card(sc, NULL);
528 1.2 nonaka }
529 1.1 nonaka
530 1.1 nonaka /* Turn off bus power and clock. */
531 1.1 nonaka (void)sdmmc_chip_bus_width(sc->sc_sct, sc->sc_sch, 1);
532 1.1 nonaka (void)sdmmc_chip_bus_clock(sc->sc_sct, sc->sc_sch, SDMMC_SDCLK_OFF);
533 1.1 nonaka (void)sdmmc_chip_bus_power(sc->sc_sct, sc->sc_sch, 0);
534 1.7 nonaka sc->sc_busclk = sc->sc_clkmax;
535 1.1 nonaka }
536 1.1 nonaka
537 1.1 nonaka /*
538 1.1 nonaka * Set the lowest bus voltage supported by the card and the host.
539 1.1 nonaka */
540 1.1 nonaka int
541 1.1 nonaka sdmmc_set_bus_power(struct sdmmc_softc *sc, uint32_t host_ocr,
542 1.1 nonaka uint32_t card_ocr)
543 1.1 nonaka {
544 1.1 nonaka uint32_t bit;
545 1.1 nonaka
546 1.1 nonaka /* Mask off unsupported voltage levels and select the lowest. */
547 1.1 nonaka DPRINTF(1,("%s: host_ocr=%x ", DEVNAME(sc), host_ocr));
548 1.1 nonaka host_ocr &= card_ocr;
549 1.1 nonaka for (bit = 4; bit < 23; bit++) {
550 1.1 nonaka if (ISSET(host_ocr, (1 << bit))) {
551 1.1 nonaka host_ocr &= (3 << bit);
552 1.1 nonaka break;
553 1.1 nonaka }
554 1.1 nonaka }
555 1.1 nonaka DPRINTF(1,("card_ocr=%x new_ocr=%x\n", card_ocr, host_ocr));
556 1.1 nonaka
557 1.1 nonaka if (host_ocr == 0 ||
558 1.1 nonaka sdmmc_chip_bus_power(sc->sc_sct, sc->sc_sch, host_ocr) != 0)
559 1.1 nonaka return 1;
560 1.1 nonaka return 0;
561 1.1 nonaka }
562 1.1 nonaka
563 1.1 nonaka struct sdmmc_function *
564 1.1 nonaka sdmmc_function_alloc(struct sdmmc_softc *sc)
565 1.1 nonaka {
566 1.1 nonaka struct sdmmc_function *sf;
567 1.1 nonaka
568 1.1 nonaka sf = malloc(sizeof *sf, M_DEVBUF, M_WAITOK|M_ZERO);
569 1.1 nonaka if (sf == NULL) {
570 1.1 nonaka aprint_error_dev(sc->sc_dev,
571 1.1 nonaka "couldn't alloc memory (sdmmc function)\n");
572 1.1 nonaka return NULL;
573 1.1 nonaka }
574 1.1 nonaka
575 1.1 nonaka sf->sc = sc;
576 1.1 nonaka sf->number = -1;
577 1.1 nonaka sf->cis.manufacturer = SDMMC_VENDOR_INVALID;
578 1.1 nonaka sf->cis.product = SDMMC_PRODUCT_INVALID;
579 1.1 nonaka sf->cis.function = SDMMC_FUNCTION_INVALID;
580 1.8 nonaka sf->width = 1;
581 1.1 nonaka
582 1.4 kiyohara if (ISSET(sc->sc_flags, SMF_MEM_MODE) &&
583 1.4 kiyohara ISSET(sc->sc_caps, SMC_CAPS_DMA) &&
584 1.4 kiyohara !ISSET(sc->sc_caps, SMC_CAPS_MULTI_SEG_DMA)) {
585 1.4 kiyohara bus_dma_segment_t ds;
586 1.4 kiyohara int rseg, error;
587 1.4 kiyohara
588 1.4 kiyohara error = bus_dmamap_create(sc->sc_dmat, SDMMC_SECTOR_SIZE, 1,
589 1.4 kiyohara SDMMC_SECTOR_SIZE, 0, BUS_DMA_WAITOK, &sf->bbuf_dmap);
590 1.4 kiyohara if (error)
591 1.4 kiyohara goto fail1;
592 1.4 kiyohara error = bus_dmamem_alloc(sc->sc_dmat, SDMMC_SECTOR_SIZE,
593 1.4 kiyohara PAGE_SIZE, 0, &ds, 1, &rseg, BUS_DMA_WAITOK);
594 1.4 kiyohara if (error)
595 1.4 kiyohara goto fail2;
596 1.4 kiyohara error = bus_dmamem_map(sc->sc_dmat, &ds, 1, SDMMC_SECTOR_SIZE,
597 1.4 kiyohara &sf->bbuf, BUS_DMA_WAITOK);
598 1.4 kiyohara if (error)
599 1.4 kiyohara goto fail3;
600 1.4 kiyohara error = bus_dmamap_load(sc->sc_dmat, sf->bbuf_dmap,
601 1.4 kiyohara sf->bbuf, SDMMC_SECTOR_SIZE, NULL,
602 1.4 kiyohara BUS_DMA_WAITOK|BUS_DMA_READ|BUS_DMA_WRITE);
603 1.4 kiyohara if (!error)
604 1.4 kiyohara goto out;
605 1.4 kiyohara
606 1.4 kiyohara bus_dmamem_unmap(sc->sc_dmat, sf->bbuf, SDMMC_SECTOR_SIZE);
607 1.4 kiyohara fail3:
608 1.4 kiyohara bus_dmamem_free(sc->sc_dmat, &ds, 1);
609 1.4 kiyohara fail2:
610 1.4 kiyohara bus_dmamap_destroy(sc->sc_dmat, sf->bbuf_dmap);
611 1.4 kiyohara fail1:
612 1.4 kiyohara free(sf, M_DEVBUF);
613 1.4 kiyohara sf = NULL;
614 1.4 kiyohara }
615 1.4 kiyohara out:
616 1.4 kiyohara
617 1.1 nonaka return sf;
618 1.1 nonaka }
619 1.1 nonaka
620 1.1 nonaka void
621 1.1 nonaka sdmmc_function_free(struct sdmmc_function *sf)
622 1.1 nonaka {
623 1.4 kiyohara struct sdmmc_softc *sc = sf->sc;
624 1.4 kiyohara
625 1.4 kiyohara if (ISSET(sc->sc_flags, SMF_MEM_MODE) &&
626 1.4 kiyohara ISSET(sc->sc_caps, SMC_CAPS_DMA) &&
627 1.4 kiyohara !ISSET(sc->sc_caps, SMC_CAPS_MULTI_SEG_DMA)) {
628 1.4 kiyohara bus_dmamap_unload(sc->sc_dmat, sf->bbuf_dmap);
629 1.4 kiyohara bus_dmamem_unmap(sc->sc_dmat, sf->bbuf, SDMMC_SECTOR_SIZE);
630 1.4 kiyohara bus_dmamem_free(sc->sc_dmat,
631 1.4 kiyohara sf->bbuf_dmap->dm_segs, sf->bbuf_dmap->dm_nsegs);
632 1.4 kiyohara bus_dmamap_destroy(sc->sc_dmat, sf->bbuf_dmap);
633 1.4 kiyohara }
634 1.1 nonaka
635 1.1 nonaka free(sf, M_DEVBUF);
636 1.1 nonaka }
637 1.1 nonaka
638 1.1 nonaka /*
639 1.1 nonaka * Scan for I/O functions and memory cards on the bus, allocating a
640 1.1 nonaka * sdmmc_function structure for each.
641 1.1 nonaka */
642 1.1 nonaka static int
643 1.1 nonaka sdmmc_scan(struct sdmmc_softc *sc)
644 1.1 nonaka {
645 1.1 nonaka
646 1.2 nonaka if (!ISSET(sc->sc_caps, SMC_CAPS_SPI_MODE)) {
647 1.2 nonaka /* Scan for I/O functions. */
648 1.2 nonaka if (ISSET(sc->sc_flags, SMF_IO_MODE))
649 1.2 nonaka sdmmc_io_scan(sc);
650 1.2 nonaka }
651 1.1 nonaka
652 1.1 nonaka /* Scan for memory cards on the bus. */
653 1.1 nonaka if (ISSET(sc->sc_flags, SMF_MEM_MODE))
654 1.1 nonaka sdmmc_mem_scan(sc);
655 1.1 nonaka
656 1.1 nonaka /* There should be at least one function now. */
657 1.1 nonaka if (SIMPLEQ_EMPTY(&sc->sf_head)) {
658 1.1 nonaka aprint_error_dev(sc->sc_dev, "couldn't identify card\n");
659 1.1 nonaka return 1;
660 1.1 nonaka }
661 1.1 nonaka return 0;
662 1.1 nonaka }
663 1.1 nonaka
664 1.1 nonaka /*
665 1.1 nonaka * Initialize all the distinguished functions of the card, be it I/O
666 1.1 nonaka * or memory functions.
667 1.1 nonaka */
668 1.1 nonaka static int
669 1.1 nonaka sdmmc_init(struct sdmmc_softc *sc)
670 1.1 nonaka {
671 1.1 nonaka struct sdmmc_function *sf;
672 1.1 nonaka
673 1.1 nonaka /* Initialize all identified card functions. */
674 1.1 nonaka SIMPLEQ_FOREACH(sf, &sc->sf_head, sf_list) {
675 1.2 nonaka if (!ISSET(sc->sc_caps, SMC_CAPS_SPI_MODE)) {
676 1.2 nonaka if (ISSET(sc->sc_flags, SMF_IO_MODE) &&
677 1.2 nonaka sdmmc_io_init(sc, sf) != 0) {
678 1.2 nonaka aprint_error_dev(sc->sc_dev,
679 1.2 nonaka "i/o init failed\n");
680 1.2 nonaka }
681 1.1 nonaka }
682 1.1 nonaka
683 1.1 nonaka if (ISSET(sc->sc_flags, SMF_MEM_MODE) &&
684 1.1 nonaka sdmmc_mem_init(sc, sf) != 0) {
685 1.1 nonaka aprint_error_dev(sc->sc_dev, "mem init failed\n");
686 1.1 nonaka }
687 1.1 nonaka }
688 1.1 nonaka
689 1.1 nonaka /* Any good functions left after initialization? */
690 1.1 nonaka SIMPLEQ_FOREACH(sf, &sc->sf_head, sf_list) {
691 1.1 nonaka if (!ISSET(sf->flags, SFF_ERROR))
692 1.1 nonaka return 0;
693 1.1 nonaka }
694 1.1 nonaka
695 1.1 nonaka /* No, we should probably power down the card. */
696 1.1 nonaka return 1;
697 1.1 nonaka }
698 1.1 nonaka
699 1.1 nonaka void
700 1.1 nonaka sdmmc_delay(u_int usecs)
701 1.1 nonaka {
702 1.1 nonaka
703 1.1 nonaka delay(usecs);
704 1.1 nonaka }
705 1.1 nonaka
706 1.1 nonaka int
707 1.2 nonaka sdmmc_app_command(struct sdmmc_softc *sc, struct sdmmc_function *sf, struct sdmmc_command *cmd)
708 1.1 nonaka {
709 1.1 nonaka struct sdmmc_command acmd;
710 1.1 nonaka int error;
711 1.1 nonaka
712 1.1 nonaka DPRINTF(1,("sdmmc_app_command: start\n"));
713 1.1 nonaka
714 1.1 nonaka /* Don't lock */
715 1.1 nonaka
716 1.1 nonaka memset(&acmd, 0, sizeof(acmd));
717 1.1 nonaka acmd.c_opcode = MMC_APP_CMD;
718 1.2 nonaka if (sf != NULL) {
719 1.2 nonaka acmd.c_arg = sf->rca << 16;
720 1.2 nonaka acmd.c_flags = SCF_CMD_AC | SCF_RSP_R1 | SCF_RSP_SPI_R1;
721 1.2 nonaka } else {
722 1.2 nonaka acmd.c_arg = 0;
723 1.2 nonaka acmd.c_flags = SCF_CMD_BCR | SCF_RSP_R1 | SCF_RSP_SPI_R1;
724 1.2 nonaka }
725 1.1 nonaka
726 1.1 nonaka error = sdmmc_mmc_command(sc, &acmd);
727 1.1 nonaka if (error == 0) {
728 1.2 nonaka if (!ISSET(sc->sc_caps, SMC_CAPS_SPI_MODE) &&
729 1.2 nonaka !ISSET(MMC_R1(acmd.c_resp), MMC_R1_APP_CMD)) {
730 1.1 nonaka /* Card does not support application commands. */
731 1.1 nonaka error = ENODEV;
732 1.1 nonaka } else {
733 1.1 nonaka error = sdmmc_mmc_command(sc, cmd);
734 1.1 nonaka }
735 1.1 nonaka }
736 1.1 nonaka DPRINTF(1,("sdmmc_app_command: done (error=%d)\n", error));
737 1.1 nonaka return error;
738 1.1 nonaka }
739 1.1 nonaka
740 1.1 nonaka /*
741 1.1 nonaka * Execute MMC command and data transfers. All interactions with the
742 1.1 nonaka * host controller to complete the command happen in the context of
743 1.1 nonaka * the current process.
744 1.1 nonaka */
745 1.1 nonaka int
746 1.1 nonaka sdmmc_mmc_command(struct sdmmc_softc *sc, struct sdmmc_command *cmd)
747 1.1 nonaka {
748 1.1 nonaka int error;
749 1.1 nonaka
750 1.2 nonaka DPRINTF(1,("sdmmc_mmc_command: cmd=%d, arg=%#x, flags=%#x\n",
751 1.1 nonaka cmd->c_opcode, cmd->c_arg, cmd->c_flags));
752 1.1 nonaka
753 1.1 nonaka /* Don't lock */
754 1.1 nonaka
755 1.1 nonaka #if defined(DIAGNOSTIC) || defined(SDMMC_DEBUG)
756 1.2 nonaka if (cmd->c_data && !ISSET(sc->sc_caps, SMC_CAPS_SPI_MODE)) {
757 1.1 nonaka if (sc->sc_card == NULL)
758 1.1 nonaka panic("%s: deselected card\n", DEVNAME(sc));
759 1.1 nonaka }
760 1.1 nonaka #endif
761 1.1 nonaka
762 1.1 nonaka sdmmc_chip_exec_command(sc->sc_sct, sc->sc_sch, cmd);
763 1.1 nonaka
764 1.1 nonaka #ifdef SDMMC_DEBUG
765 1.1 nonaka sdmmc_dump_command(sc, cmd);
766 1.1 nonaka #endif
767 1.1 nonaka
768 1.1 nonaka error = cmd->c_error;
769 1.1 nonaka
770 1.1 nonaka DPRINTF(1,("sdmmc_mmc_command: error=%d\n", error));
771 1.1 nonaka
772 1.1 nonaka return error;
773 1.1 nonaka }
774 1.1 nonaka
775 1.1 nonaka /*
776 1.1 nonaka * Send the "GO IDLE STATE" command.
777 1.1 nonaka */
778 1.1 nonaka void
779 1.1 nonaka sdmmc_go_idle_state(struct sdmmc_softc *sc)
780 1.1 nonaka {
781 1.1 nonaka struct sdmmc_command cmd;
782 1.1 nonaka
783 1.1 nonaka DPRINTF(1,("sdmmc_go_idle_state\n"));
784 1.1 nonaka
785 1.1 nonaka /* Don't lock */
786 1.1 nonaka
787 1.1 nonaka memset(&cmd, 0, sizeof(cmd));
788 1.1 nonaka cmd.c_opcode = MMC_GO_IDLE_STATE;
789 1.2 nonaka cmd.c_flags = SCF_CMD_BC | SCF_RSP_R0 | SCF_RSP_SPI_R1;
790 1.1 nonaka
791 1.1 nonaka (void)sdmmc_mmc_command(sc, &cmd);
792 1.1 nonaka }
793 1.1 nonaka
794 1.1 nonaka /*
795 1.1 nonaka * Retrieve (SD) or set (MMC) the relative card address (RCA).
796 1.1 nonaka */
797 1.1 nonaka int
798 1.1 nonaka sdmmc_set_relative_addr(struct sdmmc_softc *sc, struct sdmmc_function *sf)
799 1.1 nonaka {
800 1.1 nonaka struct sdmmc_command cmd;
801 1.1 nonaka int error;
802 1.1 nonaka
803 1.1 nonaka /* Don't lock */
804 1.1 nonaka
805 1.2 nonaka if (ISSET(sc->sc_caps, SMC_CAPS_SPI_MODE))
806 1.2 nonaka return EIO;
807 1.2 nonaka
808 1.1 nonaka memset(&cmd, 0, sizeof(cmd));
809 1.1 nonaka if (ISSET(sc->sc_flags, SMF_SD_MODE)) {
810 1.1 nonaka cmd.c_opcode = SD_SEND_RELATIVE_ADDR;
811 1.1 nonaka cmd.c_flags = SCF_CMD_BCR | SCF_RSP_R6;
812 1.1 nonaka } else {
813 1.1 nonaka cmd.c_opcode = MMC_SET_RELATIVE_ADDR;
814 1.1 nonaka cmd.c_arg = MMC_ARG_RCA(sf->rca);
815 1.1 nonaka cmd.c_flags = SCF_CMD_AC | SCF_RSP_R1;
816 1.1 nonaka }
817 1.1 nonaka error = sdmmc_mmc_command(sc, &cmd);
818 1.1 nonaka if (error)
819 1.1 nonaka return error;
820 1.1 nonaka
821 1.1 nonaka if (ISSET(sc->sc_flags, SMF_SD_MODE))
822 1.1 nonaka sf->rca = SD_R6_RCA(cmd.c_resp);
823 1.1 nonaka
824 1.1 nonaka return 0;
825 1.1 nonaka }
826 1.1 nonaka
827 1.1 nonaka int
828 1.1 nonaka sdmmc_select_card(struct sdmmc_softc *sc, struct sdmmc_function *sf)
829 1.1 nonaka {
830 1.1 nonaka struct sdmmc_command cmd;
831 1.1 nonaka int error;
832 1.1 nonaka
833 1.1 nonaka /* Don't lock */
834 1.1 nonaka
835 1.2 nonaka if (ISSET(sc->sc_caps, SMC_CAPS_SPI_MODE))
836 1.2 nonaka return EIO;
837 1.2 nonaka
838 1.1 nonaka if (sc->sc_card == sf
839 1.1 nonaka || (sf && sc->sc_card && sc->sc_card->rca == sf->rca)) {
840 1.1 nonaka sc->sc_card = sf;
841 1.1 nonaka return 0;
842 1.1 nonaka }
843 1.1 nonaka
844 1.1 nonaka memset(&cmd, 0, sizeof(cmd));
845 1.1 nonaka cmd.c_opcode = MMC_SELECT_CARD;
846 1.1 nonaka cmd.c_arg = (sf == NULL) ? 0 : MMC_ARG_RCA(sf->rca);
847 1.1 nonaka cmd.c_flags = SCF_CMD_AC | ((sf == NULL) ? SCF_RSP_R0 : SCF_RSP_R1);
848 1.1 nonaka error = sdmmc_mmc_command(sc, &cmd);
849 1.1 nonaka if (error == 0 || sf == NULL)
850 1.1 nonaka sc->sc_card = sf;
851 1.1 nonaka
852 1.1 nonaka return error;
853 1.1 nonaka }
854 1.1 nonaka
855 1.1 nonaka #ifdef SDMMC_DEBUG
856 1.1 nonaka static void
857 1.1 nonaka sdmmc_dump_command(struct sdmmc_softc *sc, struct sdmmc_command *cmd)
858 1.1 nonaka {
859 1.1 nonaka int i;
860 1.1 nonaka
861 1.2 nonaka DPRINTF(1,("%s: cmd %u arg=%#x data=%p dlen=%d flags=%#x (error %d)\n",
862 1.1 nonaka DEVNAME(sc), cmd->c_opcode, cmd->c_arg, cmd->c_data,
863 1.2 nonaka cmd->c_datalen, cmd->c_flags, cmd->c_error));
864 1.1 nonaka
865 1.1 nonaka if (cmd->c_error || sdmmcdebug < 1)
866 1.1 nonaka return;
867 1.1 nonaka
868 1.1 nonaka aprint_normal_dev(sc->sc_dev, "resp=");
869 1.1 nonaka if (ISSET(cmd->c_flags, SCF_RSP_136))
870 1.1 nonaka for (i = 0; i < sizeof cmd->c_resp; i++)
871 1.1 nonaka aprint_normal("%02x ", ((uint8_t *)cmd->c_resp)[i]);
872 1.1 nonaka else if (ISSET(cmd->c_flags, SCF_RSP_PRESENT))
873 1.1 nonaka for (i = 0; i < 4; i++)
874 1.1 nonaka aprint_normal("%02x ", ((uint8_t *)cmd->c_resp)[i]);
875 1.2 nonaka else
876 1.2 nonaka aprint_normal("none");
877 1.1 nonaka aprint_normal("\n");
878 1.1 nonaka }
879 1.2 nonaka
880 1.2 nonaka void
881 1.2 nonaka sdmmc_dump_data(const char *title, void *ptr, size_t size)
882 1.2 nonaka {
883 1.2 nonaka char buf[16];
884 1.2 nonaka uint8_t *p = ptr;
885 1.2 nonaka int i, j;
886 1.2 nonaka
887 1.2 nonaka printf("sdmmc_dump_data: %s\n", title ? title : "");
888 1.2 nonaka printf("--------+--------------------------------------------------+------------------+\n");
889 1.2 nonaka printf("offset | +0 +1 +2 +3 +4 +5 +6 +7 +8 +9 +a +b +c +d +e +f | data |\n");
890 1.2 nonaka printf("--------+--------------------------------------------------+------------------+\n");
891 1.2 nonaka for (i = 0; i < (int)size; i++) {
892 1.2 nonaka if ((i % 16) == 0) {
893 1.2 nonaka printf("%08x| ", i);
894 1.2 nonaka } else if ((i % 16) == 8) {
895 1.2 nonaka printf(" ");
896 1.2 nonaka }
897 1.2 nonaka
898 1.2 nonaka printf("%02x ", p[i]);
899 1.2 nonaka buf[i % 16] = p[i];
900 1.2 nonaka
901 1.2 nonaka if ((i % 16) == 15) {
902 1.2 nonaka printf("| ");
903 1.2 nonaka for (j = 0; j < 16; j++) {
904 1.2 nonaka if (buf[j] >= 0x20 && buf[j] <= 0x7e) {
905 1.2 nonaka printf("%c", buf[j]);
906 1.2 nonaka } else {
907 1.2 nonaka printf(".");
908 1.2 nonaka }
909 1.2 nonaka }
910 1.2 nonaka printf(" |\n");
911 1.2 nonaka }
912 1.2 nonaka }
913 1.2 nonaka if ((i % 16) != 0) {
914 1.2 nonaka j = (i % 16);
915 1.2 nonaka for (; j < 16; j++) {
916 1.2 nonaka printf(" ");
917 1.2 nonaka if ((j % 16) == 8) {
918 1.2 nonaka printf(" ");
919 1.2 nonaka }
920 1.2 nonaka }
921 1.2 nonaka
922 1.2 nonaka printf("| ");
923 1.2 nonaka for (j = 0; j < (i % 16); j++) {
924 1.2 nonaka if (buf[j] >= 0x20 && buf[j] <= 0x7e) {
925 1.2 nonaka printf("%c", buf[j]);
926 1.2 nonaka } else {
927 1.2 nonaka printf(".");
928 1.2 nonaka }
929 1.2 nonaka }
930 1.2 nonaka for (; j < 16; j++) {
931 1.2 nonaka printf(" ");
932 1.2 nonaka }
933 1.2 nonaka printf(" |\n");
934 1.2 nonaka }
935 1.2 nonaka printf("--------+--------------------------------------------------+------------------+\n");
936 1.2 nonaka }
937 1.1 nonaka #endif
938