Home | History | Annotate | Line # | Download | only in sdmmc
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