Home | History | Annotate | Line # | Download | only in sdmmc
sdmmc_io.c revision 1.10
      1  1.10  jmcneill /*	$NetBSD: sdmmc_io.c,v 1.10 2015/08/03 10:08:51 jmcneill Exp $	*/
      2   1.1    nonaka /*	$OpenBSD: sdmmc_io.c,v 1.10 2007/09/17 01:33:33 krw 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 /* Routines for SD I/O cards. */
     21   1.1    nonaka 
     22   1.1    nonaka #include <sys/cdefs.h>
     23  1.10  jmcneill __KERNEL_RCSID(0, "$NetBSD: sdmmc_io.c,v 1.10 2015/08/03 10:08:51 jmcneill Exp $");
     24   1.7      matt 
     25   1.7      matt #ifdef _KERNEL_OPT
     26   1.7      matt #include "opt_sdmmc.h"
     27   1.7      matt #endif
     28   1.1    nonaka 
     29   1.1    nonaka #include <sys/param.h>
     30   1.1    nonaka #include <sys/kernel.h>
     31   1.1    nonaka #include <sys/malloc.h>
     32   1.1    nonaka #include <sys/proc.h>
     33   1.1    nonaka #include <sys/systm.h>
     34   1.1    nonaka 
     35   1.1    nonaka #include <dev/sdmmc/sdmmc_ioreg.h>
     36   1.1    nonaka #include <dev/sdmmc/sdmmcchip.h>
     37   1.1    nonaka #include <dev/sdmmc/sdmmcreg.h>
     38   1.1    nonaka #include <dev/sdmmc/sdmmcvar.h>
     39   1.1    nonaka 
     40   1.1    nonaka #ifdef SDMMC_DEBUG
     41   1.1    nonaka #define DPRINTF(s)	do { printf s; } while (0)
     42   1.1    nonaka #else
     43   1.1    nonaka #define DPRINTF(s)	do {} while (0)
     44   1.1    nonaka #endif
     45   1.1    nonaka 
     46   1.1    nonaka struct sdmmc_intr_handler {
     47   1.1    nonaka 	struct sdmmc_softc *ih_softc;
     48   1.1    nonaka 	char *ih_name;
     49   1.1    nonaka 	int (*ih_fun)(void *);
     50   1.1    nonaka 	void *ih_arg;
     51   1.1    nonaka 	TAILQ_ENTRY(sdmmc_intr_handler) entry;
     52   1.1    nonaka };
     53   1.1    nonaka 
     54   1.1    nonaka static int	sdmmc_io_rw_direct(struct sdmmc_softc *,
     55   1.1    nonaka 		    struct sdmmc_function *, int, u_char *, int);
     56   1.1    nonaka static int	sdmmc_io_rw_extended(struct sdmmc_softc *,
     57   1.1    nonaka 		    struct sdmmc_function *, int, u_char *, int, int);
     58   1.1    nonaka #if 0
     59   1.1    nonaka static int	sdmmc_io_xchg(struct sdmmc_softc *, struct sdmmc_function *,
     60   1.1    nonaka 		    int, u_char *);
     61   1.1    nonaka #endif
     62   1.1    nonaka static void	sdmmc_io_reset(struct sdmmc_softc *);
     63   1.1    nonaka static int	sdmmc_io_send_op_cond(struct sdmmc_softc *, uint32_t,
     64   1.1    nonaka 		    uint32_t *);
     65   1.1    nonaka 
     66   1.1    nonaka /*
     67   1.1    nonaka  * Initialize SD I/O card functions (before memory cards).  The host
     68   1.1    nonaka  * system and controller must support card interrupts in order to use
     69   1.1    nonaka  * I/O functions.
     70   1.1    nonaka  */
     71   1.1    nonaka int
     72   1.1    nonaka sdmmc_io_enable(struct sdmmc_softc *sc)
     73   1.1    nonaka {
     74   1.1    nonaka 	uint32_t host_ocr;
     75   1.1    nonaka 	uint32_t card_ocr;
     76   1.1    nonaka 	int error;
     77   1.1    nonaka 
     78   1.1    nonaka 	SDMMC_LOCK(sc);
     79   1.1    nonaka 
     80   1.1    nonaka 	/* Set host mode to SD "combo" card. */
     81   1.1    nonaka 	SET(sc->sc_flags, SMF_SD_MODE|SMF_IO_MODE|SMF_MEM_MODE);
     82   1.1    nonaka 
     83   1.1    nonaka 	/* Reset I/O functions. */
     84   1.1    nonaka 	sdmmc_io_reset(sc);
     85   1.1    nonaka 
     86   1.1    nonaka 	/*
     87   1.1    nonaka 	 * Read the I/O OCR value, determine the number of I/O
     88   1.1    nonaka 	 * functions and whether memory is also present (a "combo
     89   1.1    nonaka 	 * card") by issuing CMD5.  SD memory-only and MMC cards
     90   1.1    nonaka 	 * do not respond to CMD5.
     91   1.1    nonaka 	 */
     92   1.1    nonaka 	error = sdmmc_io_send_op_cond(sc, 0, &card_ocr);
     93   1.1    nonaka 	if (error) {
     94   1.1    nonaka 		/* No SDIO card; switch to SD memory-only mode. */
     95   1.1    nonaka 		CLR(sc->sc_flags, SMF_IO_MODE);
     96   1.1    nonaka 		error = 0;
     97   1.1    nonaka 		goto out;
     98   1.1    nonaka 	}
     99   1.1    nonaka 
    100   1.1    nonaka 	/* Parse the additional bits in the I/O OCR value. */
    101   1.1    nonaka 	if (!ISSET(card_ocr, SD_IO_OCR_MEM_PRESENT)) {
    102   1.1    nonaka 		/* SDIO card without memory (not a "combo card"). */
    103   1.1    nonaka 		DPRINTF(("%s: no memory present\n", SDMMCDEVNAME(sc)));
    104   1.1    nonaka 		CLR(sc->sc_flags, SMF_MEM_MODE);
    105   1.1    nonaka 	}
    106   1.1    nonaka 	sc->sc_function_count = SD_IO_OCR_NUM_FUNCTIONS(card_ocr);
    107   1.1    nonaka 	if (sc->sc_function_count == 0) {
    108   1.1    nonaka 		/* Useless SDIO card without any I/O functions. */
    109   1.1    nonaka 		DPRINTF(("%s: no I/O functions\n", SDMMCDEVNAME(sc)));
    110   1.1    nonaka 		CLR(sc->sc_flags, SMF_IO_MODE);
    111   1.1    nonaka 		error = 0;
    112   1.1    nonaka 		goto out;
    113   1.1    nonaka 	}
    114   1.1    nonaka 	card_ocr &= SD_IO_OCR_MASK;
    115   1.1    nonaka 
    116   1.1    nonaka 	/* Set the lowest voltage supported by the card and host. */
    117   1.1    nonaka 	host_ocr = sdmmc_chip_host_ocr(sc->sc_sct, sc->sc_sch);
    118   1.1    nonaka 	error = sdmmc_set_bus_power(sc, host_ocr, card_ocr);
    119   1.1    nonaka 	if (error) {
    120   1.1    nonaka 		aprint_error_dev(sc->sc_dev,
    121   1.1    nonaka 		    "couldn't supply voltage requested by card\n");
    122   1.1    nonaka 		goto out;
    123   1.1    nonaka 	}
    124   1.1    nonaka 
    125   1.1    nonaka 	/* Reset I/O functions (again). */
    126   1.1    nonaka 	sdmmc_io_reset(sc);
    127   1.1    nonaka 
    128   1.1    nonaka 	/* Send the new OCR value until all cards are ready. */
    129   1.1    nonaka 	error = sdmmc_io_send_op_cond(sc, host_ocr, NULL);
    130   1.1    nonaka 	if (error) {
    131   1.1    nonaka 		aprint_error_dev(sc->sc_dev, "couldn't send I/O OCR\n");
    132   1.1    nonaka 		goto out;
    133   1.1    nonaka 	}
    134   1.1    nonaka 
    135   1.1    nonaka out:
    136   1.1    nonaka 	SDMMC_UNLOCK(sc);
    137   1.1    nonaka 
    138   1.1    nonaka 	return error;
    139   1.1    nonaka }
    140   1.1    nonaka 
    141   1.1    nonaka /*
    142   1.1    nonaka  * Allocate sdmmc_function structures for SD card I/O function
    143   1.1    nonaka  * (including function 0).
    144   1.1    nonaka  */
    145   1.1    nonaka void
    146   1.1    nonaka sdmmc_io_scan(struct sdmmc_softc *sc)
    147   1.1    nonaka {
    148   1.1    nonaka 	struct sdmmc_function *sf0, *sf;
    149   1.1    nonaka 	int error;
    150   1.1    nonaka 	int i;
    151   1.1    nonaka 
    152   1.1    nonaka 	SDMMC_LOCK(sc);
    153   1.1    nonaka 
    154   1.1    nonaka 	sf0 = sdmmc_function_alloc(sc);
    155   1.1    nonaka 	sf0->number = 0;
    156   1.1    nonaka 	error = sdmmc_set_relative_addr(sc, sf0);
    157   1.1    nonaka 	if (error) {
    158   1.1    nonaka 		aprint_error_dev(sc->sc_dev, "couldn't set I/O RCA\n");
    159   1.1    nonaka 		SET(sf0->flags, SFF_ERROR);
    160   1.1    nonaka 		goto out;
    161   1.1    nonaka 	}
    162   1.1    nonaka 	sc->sc_fn0 = sf0;
    163   1.1    nonaka 	SIMPLEQ_INSERT_TAIL(&sc->sf_head, sf0, sf_list);
    164   1.1    nonaka 
    165   1.3  kiyohara 	/* Go to Data Transfer Mode, if possible. */
    166   1.3  kiyohara 	sdmmc_chip_bus_rod(sc->sc_sct, sc->sc_sch, 0);
    167   1.3  kiyohara 
    168   1.1    nonaka 	/* Verify that the RCA has been set by selecting the card. */
    169   1.1    nonaka 	error = sdmmc_select_card(sc, sf0);
    170   1.1    nonaka 	if (error) {
    171   1.1    nonaka 		aprint_error_dev(sc->sc_dev, "couldn't select I/O RCA %d\n",
    172   1.1    nonaka 		    sf0->rca);
    173   1.1    nonaka 		SET(sf0->flags, SFF_ERROR);
    174   1.1    nonaka 		goto out;
    175   1.1    nonaka 	}
    176   1.1    nonaka 
    177   1.1    nonaka 	for (i = 1; i <= sc->sc_function_count; i++) {
    178   1.1    nonaka 		sf = sdmmc_function_alloc(sc);
    179   1.1    nonaka 		sf->number = i;
    180   1.1    nonaka 		sf->rca = sf0->rca;
    181   1.1    nonaka 		SIMPLEQ_INSERT_TAIL(&sc->sf_head, sf, sf_list);
    182   1.1    nonaka 	}
    183   1.1    nonaka 
    184   1.1    nonaka out:
    185   1.1    nonaka 	SDMMC_UNLOCK(sc);
    186   1.1    nonaka }
    187   1.1    nonaka 
    188   1.1    nonaka /*
    189   1.1    nonaka  * Initialize SDIO card functions.
    190   1.1    nonaka  */
    191   1.1    nonaka int
    192   1.1    nonaka sdmmc_io_init(struct sdmmc_softc *sc, struct sdmmc_function *sf)
    193   1.1    nonaka {
    194   1.5  kiyohara 	struct sdmmc_function *sf0 = sc->sc_fn0;
    195   1.1    nonaka 	int error = 0;
    196   1.5  kiyohara 	uint8_t reg;
    197   1.1    nonaka 
    198   1.1    nonaka 	SDMMC_LOCK(sc);
    199   1.1    nonaka 
    200   1.1    nonaka 	if (sf->number == 0) {
    201   1.5  kiyohara 		reg = sdmmc_io_read_1(sf, SD_IO_CCCR_CAPABILITY);
    202   1.5  kiyohara 		if (!(reg & CCCR_CAPS_LSC) || (reg & CCCR_CAPS_4BLS)) {
    203   1.5  kiyohara 			sdmmc_io_write_1(sf, SD_IO_CCCR_BUS_WIDTH,
    204   1.5  kiyohara 			    CCCR_BUS_WIDTH_4);
    205   1.5  kiyohara 			sf->width = 4;
    206   1.5  kiyohara 		}
    207   1.1    nonaka 
    208   1.1    nonaka 		error = sdmmc_read_cis(sf, &sf->cis);
    209   1.1    nonaka 		if (error) {
    210   1.1    nonaka 			aprint_error_dev(sc->sc_dev, "couldn't read CIS\n");
    211   1.1    nonaka 			SET(sf->flags, SFF_ERROR);
    212   1.1    nonaka 			goto out;
    213   1.1    nonaka 		}
    214   1.1    nonaka 
    215   1.1    nonaka 		sdmmc_check_cis_quirks(sf);
    216   1.1    nonaka 
    217   1.1    nonaka #ifdef SDMMC_DEBUG
    218   1.1    nonaka 		if (sdmmcdebug)
    219   1.1    nonaka 			sdmmc_print_cis(sf);
    220   1.1    nonaka #endif
    221   1.3  kiyohara 
    222   1.5  kiyohara 		reg = sdmmc_io_read_1(sf, SD_IO_CCCR_HIGH_SPEED);
    223   1.5  kiyohara 		if (reg & CCCR_HIGH_SPEED_SHS) {
    224   1.5  kiyohara 			reg |= CCCR_HIGH_SPEED_EHS;
    225   1.5  kiyohara 			sdmmc_io_write_1(sf, SD_IO_CCCR_HIGH_SPEED, reg);
    226   1.5  kiyohara 			sf->csd.tran_speed = 50000;	/* 50MHz */
    227   1.5  kiyohara 
    228   1.5  kiyohara 			/* Wait 400KHz x 8 clock */
    229   1.5  kiyohara 			delay(1);
    230   1.5  kiyohara 		}
    231   1.3  kiyohara 		if (sc->sc_busclk > sf->csd.tran_speed)
    232   1.3  kiyohara 			sc->sc_busclk = sf->csd.tran_speed;
    233   1.3  kiyohara 		error =
    234  1.10  jmcneill 		    sdmmc_chip_bus_clock(sc->sc_sct, sc->sc_sch, sc->sc_busclk,
    235  1.10  jmcneill 			false);
    236   1.3  kiyohara 		if (error)
    237   1.3  kiyohara 			aprint_error_dev(sc->sc_dev,
    238   1.3  kiyohara 			    "can't change bus clock\n");
    239   1.5  kiyohara 	} else {
    240   1.5  kiyohara 		reg = sdmmc_io_read_1(sf0, SD_IO_FBR(sf->number) + 0x000);
    241   1.5  kiyohara 		sf->interface = FBR_STD_FUNC_IF_CODE(reg);
    242   1.5  kiyohara 		if (sf->interface == 0x0f)
    243   1.5  kiyohara 			sf->interface =
    244   1.5  kiyohara 			    sdmmc_io_read_1(sf0, SD_IO_FBR(sf->number) + 0x001);
    245   1.5  kiyohara 		error = sdmmc_read_cis(sf, &sf->cis);
    246   1.5  kiyohara 		if (error) {
    247   1.5  kiyohara 			aprint_error_dev(sc->sc_dev, "couldn't read CIS\n");
    248   1.5  kiyohara 			SET(sf->flags, SFF_ERROR);
    249   1.5  kiyohara 			goto out;
    250   1.5  kiyohara 		}
    251   1.5  kiyohara 
    252   1.5  kiyohara 		sdmmc_check_cis_quirks(sf);
    253   1.5  kiyohara 
    254   1.5  kiyohara #ifdef SDMMC_DEBUG
    255   1.5  kiyohara 		if (sdmmcdebug)
    256   1.5  kiyohara 			sdmmc_print_cis(sf);
    257   1.5  kiyohara #endif
    258   1.1    nonaka 	}
    259   1.1    nonaka 
    260   1.1    nonaka out:
    261   1.1    nonaka 	SDMMC_UNLOCK(sc);
    262   1.1    nonaka 
    263   1.1    nonaka 	return error;
    264   1.1    nonaka }
    265   1.1    nonaka 
    266   1.1    nonaka /*
    267   1.1    nonaka  * Indicate whether the function is ready to operate.
    268   1.1    nonaka  */
    269   1.1    nonaka static int
    270   1.1    nonaka sdmmc_io_function_ready(struct sdmmc_function *sf)
    271   1.1    nonaka {
    272   1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    273   1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    274   1.1    nonaka 	uint8_t reg;
    275   1.1    nonaka 
    276   1.1    nonaka 	if (sf->number == 0)
    277   1.1    nonaka 		return 1;	/* FN0 is always ready */
    278   1.1    nonaka 
    279   1.1    nonaka 	SDMMC_LOCK(sc);
    280   1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_IOREADY);
    281   1.1    nonaka 	SDMMC_UNLOCK(sc);
    282   1.1    nonaka 	return (reg & (1 << sf->number)) != 0;
    283   1.1    nonaka }
    284   1.1    nonaka 
    285   1.1    nonaka int
    286   1.1    nonaka sdmmc_io_function_enable(struct sdmmc_function *sf)
    287   1.1    nonaka {
    288   1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    289   1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    290   1.1    nonaka 	uint8_t reg;
    291   1.1    nonaka 	int retry;
    292   1.1    nonaka 
    293   1.1    nonaka 	if (sf->number == 0)
    294   1.1    nonaka 		return 0;	/* FN0 is always enabled */
    295   1.1    nonaka 
    296   1.1    nonaka 	SDMMC_LOCK(sc);
    297   1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_ENABLE);
    298   1.1    nonaka 	SET(reg, (1U << sf->number));
    299   1.1    nonaka 	sdmmc_io_write_1(sf0, SD_IO_CCCR_FN_ENABLE, reg);
    300   1.1    nonaka 	SDMMC_UNLOCK(sc);
    301   1.4  kiyohara 
    302   1.1    nonaka 	retry = 5;
    303   1.1    nonaka 	while (!sdmmc_io_function_ready(sf) && retry-- > 0)
    304   1.2     pooka 		kpause("pause", false, hz, NULL);
    305   1.1    nonaka 	return (retry >= 0) ? 0 : ETIMEDOUT;
    306   1.1    nonaka }
    307   1.1    nonaka 
    308   1.1    nonaka /*
    309   1.1    nonaka  * Disable the I/O function.  Return zero if the function was
    310   1.1    nonaka  * disabled successfully.
    311   1.1    nonaka  */
    312   1.1    nonaka void
    313   1.1    nonaka sdmmc_io_function_disable(struct sdmmc_function *sf)
    314   1.1    nonaka {
    315   1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    316   1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    317   1.1    nonaka 	uint8_t reg;
    318   1.1    nonaka 
    319   1.1    nonaka 	if (sf->number == 0)
    320   1.1    nonaka 		return;		/* FN0 is always enabled */
    321   1.1    nonaka 
    322   1.1    nonaka 	SDMMC_LOCK(sc);
    323   1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_ENABLE);
    324   1.1    nonaka 	CLR(reg, (1U << sf->number));
    325   1.1    nonaka 	sdmmc_io_write_1(sf0, SD_IO_CCCR_FN_ENABLE, reg);
    326   1.1    nonaka 	SDMMC_UNLOCK(sc);
    327   1.1    nonaka }
    328   1.1    nonaka 
    329   1.1    nonaka static int
    330   1.1    nonaka sdmmc_io_rw_direct(struct sdmmc_softc *sc, struct sdmmc_function *sf,
    331   1.1    nonaka     int reg, u_char *datap, int arg)
    332   1.1    nonaka {
    333   1.1    nonaka 	struct sdmmc_command cmd;
    334   1.1    nonaka 	int error;
    335   1.1    nonaka 
    336   1.1    nonaka 	/* Don't lock */
    337   1.1    nonaka 
    338   1.1    nonaka 	/* Make sure the card is selected. */
    339   1.1    nonaka 	error = sdmmc_select_card(sc, sf);
    340   1.1    nonaka 	if (error)
    341   1.1    nonaka 		return error;
    342   1.1    nonaka 
    343   1.1    nonaka 	arg |= ((sf == NULL ? 0 : sf->number) & SD_ARG_CMD52_FUNC_MASK) <<
    344   1.1    nonaka 	    SD_ARG_CMD52_FUNC_SHIFT;
    345   1.1    nonaka 	arg |= (reg & SD_ARG_CMD52_REG_MASK) <<
    346   1.1    nonaka 	    SD_ARG_CMD52_REG_SHIFT;
    347   1.1    nonaka 	arg |= (*datap & SD_ARG_CMD52_DATA_MASK) <<
    348   1.1    nonaka 	    SD_ARG_CMD52_DATA_SHIFT;
    349   1.1    nonaka 
    350   1.1    nonaka 	memset(&cmd, 0, sizeof cmd);
    351   1.1    nonaka 	cmd.c_opcode = SD_IO_RW_DIRECT;
    352   1.1    nonaka 	cmd.c_arg = arg;
    353   1.1    nonaka 	cmd.c_flags = SCF_CMD_AC | SCF_RSP_R5;
    354   1.1    nonaka 
    355   1.1    nonaka 	error = sdmmc_mmc_command(sc, &cmd);
    356   1.1    nonaka 	*datap = SD_R5_DATA(cmd.c_resp);
    357   1.1    nonaka 
    358   1.1    nonaka 	return error;
    359   1.1    nonaka }
    360   1.1    nonaka 
    361   1.1    nonaka /*
    362   1.1    nonaka  * Useful values of `arg' to pass in are either SD_ARG_CMD53_READ or
    363   1.1    nonaka  * SD_ARG_CMD53_WRITE.  SD_ARG_CMD53_INCREMENT may be ORed into `arg'
    364   1.1    nonaka  * to access successive register locations instead of accessing the
    365   1.1    nonaka  * same register many times.
    366   1.1    nonaka  */
    367   1.1    nonaka static int
    368   1.1    nonaka sdmmc_io_rw_extended(struct sdmmc_softc *sc, struct sdmmc_function *sf,
    369   1.1    nonaka     int reg, u_char *datap, int datalen, int arg)
    370   1.1    nonaka {
    371   1.1    nonaka 	struct sdmmc_command cmd;
    372   1.1    nonaka 	int error;
    373   1.1    nonaka 
    374   1.1    nonaka 	/* Don't lock */
    375   1.1    nonaka 
    376   1.1    nonaka #if 0
    377   1.1    nonaka 	/* Make sure the card is selected. */
    378   1.1    nonaka 	error = sdmmc_select_card(sc, sf);
    379   1.1    nonaka 	if (error)
    380   1.1    nonaka 		return error;
    381   1.1    nonaka #endif
    382   1.1    nonaka 
    383   1.1    nonaka 	arg |= (((sf == NULL) ? 0 : sf->number) & SD_ARG_CMD53_FUNC_MASK) <<
    384   1.1    nonaka 	    SD_ARG_CMD53_FUNC_SHIFT;
    385   1.1    nonaka 	arg |= (reg & SD_ARG_CMD53_REG_MASK) <<
    386   1.1    nonaka 	    SD_ARG_CMD53_REG_SHIFT;
    387   1.1    nonaka 	arg |= (datalen & SD_ARG_CMD53_LENGTH_MASK) <<
    388   1.1    nonaka 	    SD_ARG_CMD53_LENGTH_SHIFT;
    389   1.1    nonaka 
    390   1.1    nonaka 	memset(&cmd, 0, sizeof cmd);
    391   1.1    nonaka 	cmd.c_opcode = SD_IO_RW_EXTENDED;
    392   1.1    nonaka 	cmd.c_arg = arg;
    393   1.1    nonaka 	cmd.c_flags = SCF_CMD_AC | SCF_RSP_R5;
    394   1.1    nonaka 	cmd.c_data = datap;
    395   1.1    nonaka 	cmd.c_datalen = datalen;
    396   1.1    nonaka 	cmd.c_blklen = MIN(datalen,
    397   1.1    nonaka 	    sdmmc_chip_host_maxblklen(sc->sc_sct,sc->sc_sch));
    398   1.1    nonaka 	if (!ISSET(arg, SD_ARG_CMD53_WRITE))
    399   1.1    nonaka 		cmd.c_flags |= SCF_CMD_READ;
    400   1.1    nonaka 
    401   1.1    nonaka 	error = sdmmc_mmc_command(sc, &cmd);
    402   1.1    nonaka 
    403   1.1    nonaka 	return error;
    404   1.1    nonaka }
    405   1.1    nonaka 
    406   1.1    nonaka uint8_t
    407   1.1    nonaka sdmmc_io_read_1(struct sdmmc_function *sf, int reg)
    408   1.1    nonaka {
    409   1.1    nonaka 	uint8_t data = 0;
    410   1.1    nonaka 
    411   1.1    nonaka 	/* Don't lock */
    412   1.4  kiyohara 
    413   1.1    nonaka 	(void)sdmmc_io_rw_direct(sf->sc, sf, reg, (u_char *)&data,
    414   1.1    nonaka 	    SD_ARG_CMD52_READ);
    415   1.1    nonaka 	return data;
    416   1.1    nonaka }
    417   1.1    nonaka 
    418   1.1    nonaka void
    419   1.1    nonaka sdmmc_io_write_1(struct sdmmc_function *sf, int reg, uint8_t data)
    420   1.1    nonaka {
    421   1.1    nonaka 
    422   1.1    nonaka 	/* Don't lock */
    423   1.1    nonaka 
    424   1.1    nonaka 	(void)sdmmc_io_rw_direct(sf->sc, sf, reg, (u_char *)&data,
    425   1.1    nonaka 	    SD_ARG_CMD52_WRITE);
    426   1.1    nonaka }
    427   1.1    nonaka 
    428   1.1    nonaka uint16_t
    429   1.1    nonaka sdmmc_io_read_2(struct sdmmc_function *sf, int reg)
    430   1.1    nonaka {
    431   1.1    nonaka 	uint16_t data = 0;
    432   1.1    nonaka 
    433   1.1    nonaka 	/* Don't lock */
    434   1.1    nonaka 
    435   1.1    nonaka 	(void)sdmmc_io_rw_extended(sf->sc, sf, reg, (u_char *)&data, 2,
    436   1.1    nonaka 	    SD_ARG_CMD53_READ | SD_ARG_CMD53_INCREMENT);
    437   1.1    nonaka 	return data;
    438   1.1    nonaka }
    439   1.1    nonaka 
    440   1.1    nonaka void
    441   1.1    nonaka sdmmc_io_write_2(struct sdmmc_function *sf, int reg, uint16_t data)
    442   1.1    nonaka {
    443   1.1    nonaka 
    444   1.1    nonaka 	/* Don't lock */
    445   1.1    nonaka 
    446   1.1    nonaka 	(void)sdmmc_io_rw_extended(sf->sc, sf, reg, (u_char *)&data, 2,
    447   1.1    nonaka 	    SD_ARG_CMD53_WRITE | SD_ARG_CMD53_INCREMENT);
    448   1.1    nonaka }
    449   1.1    nonaka 
    450   1.1    nonaka uint32_t
    451   1.1    nonaka sdmmc_io_read_4(struct sdmmc_function *sf, int reg)
    452   1.1    nonaka {
    453   1.1    nonaka 	uint32_t data = 0;
    454   1.1    nonaka 
    455   1.1    nonaka 	/* Don't lock */
    456   1.4  kiyohara 
    457   1.1    nonaka 	(void)sdmmc_io_rw_extended(sf->sc, sf, reg, (u_char *)&data, 4,
    458   1.1    nonaka 	    SD_ARG_CMD53_READ | SD_ARG_CMD53_INCREMENT);
    459   1.1    nonaka 	return data;
    460   1.1    nonaka }
    461   1.1    nonaka 
    462   1.1    nonaka void
    463   1.1    nonaka sdmmc_io_write_4(struct sdmmc_function *sf, int reg, uint32_t data)
    464   1.1    nonaka {
    465   1.1    nonaka 
    466   1.1    nonaka 	/* Don't lock */
    467   1.1    nonaka 
    468   1.1    nonaka 	(void)sdmmc_io_rw_extended(sf->sc, sf, reg, (u_char *)&data, 4,
    469   1.1    nonaka 	    SD_ARG_CMD53_WRITE | SD_ARG_CMD53_INCREMENT);
    470   1.1    nonaka }
    471   1.1    nonaka 
    472   1.1    nonaka 
    473   1.1    nonaka int
    474   1.1    nonaka sdmmc_io_read_multi_1(struct sdmmc_function *sf, int reg, u_char *data,
    475   1.1    nonaka     int datalen)
    476   1.1    nonaka {
    477   1.1    nonaka 	int error;
    478   1.1    nonaka 
    479   1.1    nonaka 	/* Don't lock */
    480   1.1    nonaka 
    481   1.1    nonaka 	while (datalen > SD_ARG_CMD53_LENGTH_MAX) {
    482   1.1    nonaka 		error = sdmmc_io_rw_extended(sf->sc, sf, reg, data,
    483   1.1    nonaka 		    SD_ARG_CMD53_LENGTH_MAX, SD_ARG_CMD53_READ);
    484   1.1    nonaka 		if (error)
    485   1.1    nonaka 			goto error;
    486   1.1    nonaka 		data += SD_ARG_CMD53_LENGTH_MAX;
    487   1.1    nonaka 		datalen -= SD_ARG_CMD53_LENGTH_MAX;
    488   1.1    nonaka 	}
    489   1.1    nonaka 
    490   1.1    nonaka 	error = sdmmc_io_rw_extended(sf->sc, sf, reg, data, datalen,
    491   1.1    nonaka 	    SD_ARG_CMD53_READ);
    492   1.1    nonaka error:
    493   1.1    nonaka 	return error;
    494   1.1    nonaka }
    495   1.1    nonaka 
    496   1.1    nonaka int
    497   1.1    nonaka sdmmc_io_write_multi_1(struct sdmmc_function *sf, int reg, u_char *data,
    498   1.1    nonaka     int datalen)
    499   1.1    nonaka {
    500   1.1    nonaka 	int error;
    501   1.1    nonaka 
    502   1.1    nonaka 	/* Don't lock */
    503   1.1    nonaka 
    504   1.1    nonaka 	while (datalen > SD_ARG_CMD53_LENGTH_MAX) {
    505   1.1    nonaka 		error = sdmmc_io_rw_extended(sf->sc, sf, reg, data,
    506   1.1    nonaka 		    SD_ARG_CMD53_LENGTH_MAX, SD_ARG_CMD53_WRITE);
    507   1.1    nonaka 		if (error)
    508   1.1    nonaka 			goto error;
    509   1.1    nonaka 		data += SD_ARG_CMD53_LENGTH_MAX;
    510   1.1    nonaka 		datalen -= SD_ARG_CMD53_LENGTH_MAX;
    511   1.1    nonaka 	}
    512   1.1    nonaka 
    513   1.1    nonaka 	error = sdmmc_io_rw_extended(sf->sc, sf, reg, data, datalen,
    514   1.1    nonaka 	    SD_ARG_CMD53_WRITE);
    515   1.1    nonaka error:
    516   1.1    nonaka 	return error;
    517   1.1    nonaka }
    518   1.1    nonaka 
    519   1.1    nonaka #if 0
    520   1.1    nonaka static int
    521   1.1    nonaka sdmmc_io_xchg(struct sdmmc_softc *sc, struct sdmmc_function *sf,
    522   1.1    nonaka     int reg, u_char *datap)
    523   1.1    nonaka {
    524   1.1    nonaka 
    525   1.1    nonaka 	/* Don't lock */
    526   1.1    nonaka 
    527   1.1    nonaka 	return sdmmc_io_rw_direct(sc, sf, reg, datap,
    528   1.1    nonaka 	    SD_ARG_CMD52_WRITE|SD_ARG_CMD52_EXCHANGE);
    529   1.1    nonaka }
    530   1.1    nonaka #endif
    531   1.1    nonaka 
    532   1.1    nonaka /*
    533   1.1    nonaka  * Reset the I/O functions of the card.
    534   1.1    nonaka  */
    535   1.1    nonaka static void
    536   1.1    nonaka sdmmc_io_reset(struct sdmmc_softc *sc)
    537   1.1    nonaka {
    538   1.1    nonaka 
    539   1.1    nonaka 	/* Don't lock */
    540   1.1    nonaka #if 0 /* XXX command fails */
    541   1.1    nonaka 	(void)sdmmc_io_write(sc, NULL, SD_IO_REG_CCCR_CTL, CCCR_CTL_RES);
    542   1.1    nonaka 	sdmmc_delay(100000);
    543   1.1    nonaka #endif
    544   1.1    nonaka }
    545   1.1    nonaka 
    546   1.1    nonaka /*
    547   1.1    nonaka  * Get or set the card's I/O OCR value (SDIO).
    548   1.1    nonaka  */
    549   1.1    nonaka static int
    550   1.1    nonaka sdmmc_io_send_op_cond(struct sdmmc_softc *sc, u_int32_t ocr, u_int32_t *ocrp)
    551   1.1    nonaka {
    552   1.1    nonaka 	struct sdmmc_command cmd;
    553   1.1    nonaka 	int error;
    554   1.1    nonaka 	int retry;
    555   1.1    nonaka 
    556   1.1    nonaka 	DPRINTF(("sdmmc_io_send_op_cond: ocr = %#x\n", ocr));
    557   1.1    nonaka 
    558   1.1    nonaka 	/* Don't lock */
    559   1.1    nonaka 
    560   1.1    nonaka 	/*
    561   1.1    nonaka 	 * If we change the OCR value, retry the command until the OCR
    562   1.1    nonaka 	 * we receive in response has the "CARD BUSY" bit set, meaning
    563   1.1    nonaka 	 * that all cards are ready for identification.
    564   1.1    nonaka 	 */
    565   1.1    nonaka 	for (retry = 0; retry < 100; retry++) {
    566   1.1    nonaka 		memset(&cmd, 0, sizeof cmd);
    567   1.1    nonaka 		cmd.c_opcode = SD_IO_SEND_OP_COND;
    568   1.1    nonaka 		cmd.c_arg = ocr;
    569   1.1    nonaka 		cmd.c_flags = SCF_CMD_BCR | SCF_RSP_R4;
    570   1.1    nonaka 
    571   1.1    nonaka 		error = sdmmc_mmc_command(sc, &cmd);
    572   1.1    nonaka 		if (error)
    573   1.1    nonaka 			break;
    574   1.1    nonaka 		if (ISSET(MMC_R4(cmd.c_resp), SD_IO_OCR_MEM_READY) || ocr == 0)
    575   1.1    nonaka 			break;
    576   1.1    nonaka 
    577   1.1    nonaka 		error = ETIMEDOUT;
    578   1.1    nonaka 		sdmmc_delay(10000);
    579   1.1    nonaka 	}
    580   1.1    nonaka 	if (error == 0 && ocrp != NULL)
    581   1.1    nonaka 		*ocrp = MMC_R4(cmd.c_resp);
    582   1.1    nonaka 
    583   1.1    nonaka 	DPRINTF(("sdmmc_io_send_op_cond: error = %d\n", error));
    584   1.1    nonaka 
    585   1.1    nonaka 	return error;
    586   1.1    nonaka }
    587   1.1    nonaka 
    588   1.1    nonaka /*
    589   1.1    nonaka  * Card interrupt handling
    590   1.1    nonaka  */
    591   1.1    nonaka 
    592   1.1    nonaka void
    593   1.1    nonaka sdmmc_intr_enable(struct sdmmc_function *sf)
    594   1.1    nonaka {
    595   1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    596   1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    597   1.1    nonaka 	uint8_t reg;
    598   1.1    nonaka 
    599   1.1    nonaka 	SDMMC_LOCK(sc);
    600   1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_INTEN);
    601   1.1    nonaka 	reg |= 1 << sf->number;
    602   1.1    nonaka 	sdmmc_io_write_1(sf0, SD_IO_CCCR_FN_INTEN, reg);
    603   1.1    nonaka 	SDMMC_UNLOCK(sc);
    604   1.1    nonaka }
    605   1.1    nonaka 
    606   1.1    nonaka void
    607   1.1    nonaka sdmmc_intr_disable(struct sdmmc_function *sf)
    608   1.1    nonaka {
    609   1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    610   1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    611   1.1    nonaka 	uint8_t reg;
    612   1.1    nonaka 
    613   1.1    nonaka 	SDMMC_LOCK(sc);
    614   1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_INTEN);
    615   1.1    nonaka 	reg &= ~(1 << sf->number);
    616   1.1    nonaka 	sdmmc_io_write_1(sf0, SD_IO_CCCR_FN_INTEN, reg);
    617   1.1    nonaka 	SDMMC_UNLOCK(sc);
    618   1.1    nonaka }
    619   1.1    nonaka 
    620   1.1    nonaka /*
    621   1.1    nonaka  * Establish a handler for the SDIO card interrupt.  Because the
    622   1.1    nonaka  * interrupt may be shared with different SDIO functions, multiple
    623   1.1    nonaka  * handlers can be established.
    624   1.1    nonaka  */
    625   1.1    nonaka void *
    626   1.1    nonaka sdmmc_intr_establish(device_t dev, int (*fun)(void *), void *arg,
    627   1.1    nonaka     const char *name)
    628   1.1    nonaka {
    629   1.1    nonaka 	struct sdmmc_softc *sc = device_private(dev);
    630   1.1    nonaka 	struct sdmmc_intr_handler *ih;
    631   1.1    nonaka 
    632   1.1    nonaka 	if (sc->sc_sct->card_enable_intr == NULL)
    633   1.1    nonaka 		return NULL;
    634   1.1    nonaka 
    635   1.1    nonaka 	ih = malloc(sizeof *ih, M_DEVBUF, M_WAITOK|M_CANFAIL|M_ZERO);
    636   1.1    nonaka 	if (ih == NULL)
    637   1.1    nonaka 		return NULL;
    638   1.1    nonaka 
    639   1.1    nonaka 	ih->ih_name = malloc(strlen(name) + 1, M_DEVBUF,
    640   1.1    nonaka 	    M_WAITOK|M_CANFAIL|M_ZERO);
    641   1.1    nonaka 	if (ih->ih_name == NULL) {
    642   1.1    nonaka 		free(ih, M_DEVBUF);
    643   1.1    nonaka 		return NULL;
    644   1.1    nonaka 	}
    645   1.1    nonaka 	strlcpy(ih->ih_name, name, strlen(name));
    646   1.1    nonaka 	ih->ih_softc = sc;
    647   1.1    nonaka 	ih->ih_fun = fun;
    648   1.1    nonaka 	ih->ih_arg = arg;
    649   1.1    nonaka 
    650   1.9   mlelstv 	mutex_enter(&sc->sc_mtx);
    651   1.1    nonaka 	if (TAILQ_EMPTY(&sc->sc_intrq)) {
    652   1.1    nonaka 		sdmmc_intr_enable(sc->sc_fn0);
    653   1.1    nonaka 		sdmmc_chip_card_enable_intr(sc->sc_sct, sc->sc_sch, 1);
    654   1.1    nonaka 	}
    655   1.1    nonaka 	TAILQ_INSERT_TAIL(&sc->sc_intrq, ih, entry);
    656   1.9   mlelstv 	mutex_exit(&sc->sc_mtx);
    657   1.1    nonaka 
    658   1.1    nonaka 	return ih;
    659   1.1    nonaka }
    660   1.1    nonaka 
    661   1.1    nonaka /*
    662   1.1    nonaka  * Disestablish the given handler.
    663   1.1    nonaka  */
    664   1.1    nonaka void
    665   1.1    nonaka sdmmc_intr_disestablish(void *cookie)
    666   1.1    nonaka {
    667   1.1    nonaka 	struct sdmmc_intr_handler *ih = cookie;
    668   1.1    nonaka 	struct sdmmc_softc *sc = ih->ih_softc;
    669   1.1    nonaka 
    670   1.1    nonaka 	if (sc->sc_sct->card_enable_intr == NULL)
    671   1.1    nonaka 		return;
    672   1.1    nonaka 
    673   1.9   mlelstv 	mutex_enter(&sc->sc_mtx);
    674   1.1    nonaka 	TAILQ_REMOVE(&sc->sc_intrq, ih, entry);
    675   1.1    nonaka 	if (TAILQ_EMPTY(&sc->sc_intrq)) {
    676   1.1    nonaka 		sdmmc_chip_card_enable_intr(sc->sc_sct, sc->sc_sch, 0);
    677   1.1    nonaka 		sdmmc_intr_disable(sc->sc_fn0);
    678   1.1    nonaka 	}
    679   1.9   mlelstv 	mutex_exit(&sc->sc_mtx);
    680   1.1    nonaka 
    681   1.1    nonaka 	free(ih->ih_name, M_DEVBUF);
    682   1.1    nonaka 	free(ih, M_DEVBUF);
    683   1.1    nonaka }
    684   1.1    nonaka 
    685   1.1    nonaka /*
    686   1.1    nonaka  * Call established SDIO card interrupt handlers.  The host controller
    687   1.1    nonaka  * must call this function from its own interrupt handler to handle an
    688   1.1    nonaka  * SDIO interrupt from the card.
    689   1.1    nonaka  */
    690   1.1    nonaka void
    691   1.1    nonaka sdmmc_card_intr(device_t dev)
    692   1.1    nonaka {
    693   1.1    nonaka 	struct sdmmc_softc *sc = device_private(dev);
    694   1.1    nonaka 
    695   1.8   mlelstv 	if (sc->sc_sct->card_enable_intr == NULL)
    696   1.8   mlelstv 		return;
    697   1.8   mlelstv 
    698   1.8   mlelstv 	mutex_enter(&sc->sc_intr_task_mtx);
    699   1.8   mlelstv 	if (!sdmmc_task_pending(&sc->sc_intr_task))
    700   1.8   mlelstv 		sdmmc_add_task(sc, &sc->sc_intr_task);
    701   1.8   mlelstv 	mutex_exit(&sc->sc_intr_task_mtx);
    702   1.1    nonaka }
    703   1.1    nonaka 
    704   1.1    nonaka void
    705   1.1    nonaka sdmmc_intr_task(void *arg)
    706   1.1    nonaka {
    707   1.1    nonaka 	struct sdmmc_softc *sc = (struct sdmmc_softc *)arg;
    708   1.1    nonaka 	struct sdmmc_intr_handler *ih;
    709   1.1    nonaka 
    710   1.9   mlelstv 	mutex_enter(&sc->sc_mtx);
    711   1.1    nonaka 	TAILQ_FOREACH(ih, &sc->sc_intrq, entry) {
    712   1.9   mlelstv 		mutex_exit(&sc->sc_mtx);
    713   1.1    nonaka 		/* XXX examine return value and do evcount stuff*/
    714   1.1    nonaka 		(void)(*ih->ih_fun)(ih->ih_arg);
    715   1.9   mlelstv 		mutex_enter(&sc->sc_mtx);
    716   1.1    nonaka 	}
    717   1.1    nonaka 	sdmmc_chip_card_intr_ack(sc->sc_sct, sc->sc_sch);
    718   1.9   mlelstv 	mutex_exit(&sc->sc_mtx);
    719   1.1    nonaka }
    720