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