Home | History | Annotate | Line # | Download | only in sdmmc
sdmmc_io.c revision 1.9
      1  1.8   mlelstv /*	$NetBSD: sdmmc_io.c,v 1.9 2015/08/03 05:32:50 mlelstv 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.8   mlelstv __KERNEL_RCSID(0, "$NetBSD: sdmmc_io.c,v 1.9 2015/08/03 05:32:50 mlelstv 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.3  kiyohara 		    sdmmc_chip_bus_clock(sc->sc_sct, sc->sc_sch, sc->sc_busclk);
    235  1.3  kiyohara 		if (error)
    236  1.3  kiyohara 			aprint_error_dev(sc->sc_dev,
    237  1.3  kiyohara 			    "can't change bus clock\n");
    238  1.5  kiyohara 	} else {
    239  1.5  kiyohara 		reg = sdmmc_io_read_1(sf0, SD_IO_FBR(sf->number) + 0x000);
    240  1.5  kiyohara 		sf->interface = FBR_STD_FUNC_IF_CODE(reg);
    241  1.5  kiyohara 		if (sf->interface == 0x0f)
    242  1.5  kiyohara 			sf->interface =
    243  1.5  kiyohara 			    sdmmc_io_read_1(sf0, SD_IO_FBR(sf->number) + 0x001);
    244  1.5  kiyohara 		error = sdmmc_read_cis(sf, &sf->cis);
    245  1.5  kiyohara 		if (error) {
    246  1.5  kiyohara 			aprint_error_dev(sc->sc_dev, "couldn't read CIS\n");
    247  1.5  kiyohara 			SET(sf->flags, SFF_ERROR);
    248  1.5  kiyohara 			goto out;
    249  1.5  kiyohara 		}
    250  1.5  kiyohara 
    251  1.5  kiyohara 		sdmmc_check_cis_quirks(sf);
    252  1.5  kiyohara 
    253  1.5  kiyohara #ifdef SDMMC_DEBUG
    254  1.5  kiyohara 		if (sdmmcdebug)
    255  1.5  kiyohara 			sdmmc_print_cis(sf);
    256  1.5  kiyohara #endif
    257  1.1    nonaka 	}
    258  1.1    nonaka 
    259  1.1    nonaka out:
    260  1.1    nonaka 	SDMMC_UNLOCK(sc);
    261  1.1    nonaka 
    262  1.1    nonaka 	return error;
    263  1.1    nonaka }
    264  1.1    nonaka 
    265  1.1    nonaka /*
    266  1.1    nonaka  * Indicate whether the function is ready to operate.
    267  1.1    nonaka  */
    268  1.1    nonaka static int
    269  1.1    nonaka sdmmc_io_function_ready(struct sdmmc_function *sf)
    270  1.1    nonaka {
    271  1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    272  1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    273  1.1    nonaka 	uint8_t reg;
    274  1.1    nonaka 
    275  1.1    nonaka 	if (sf->number == 0)
    276  1.1    nonaka 		return 1;	/* FN0 is always ready */
    277  1.1    nonaka 
    278  1.1    nonaka 	SDMMC_LOCK(sc);
    279  1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_IOREADY);
    280  1.1    nonaka 	SDMMC_UNLOCK(sc);
    281  1.1    nonaka 	return (reg & (1 << sf->number)) != 0;
    282  1.1    nonaka }
    283  1.1    nonaka 
    284  1.1    nonaka int
    285  1.1    nonaka sdmmc_io_function_enable(struct sdmmc_function *sf)
    286  1.1    nonaka {
    287  1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    288  1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    289  1.1    nonaka 	uint8_t reg;
    290  1.1    nonaka 	int retry;
    291  1.1    nonaka 
    292  1.1    nonaka 	if (sf->number == 0)
    293  1.1    nonaka 		return 0;	/* FN0 is always enabled */
    294  1.1    nonaka 
    295  1.1    nonaka 	SDMMC_LOCK(sc);
    296  1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_ENABLE);
    297  1.1    nonaka 	SET(reg, (1U << sf->number));
    298  1.1    nonaka 	sdmmc_io_write_1(sf0, SD_IO_CCCR_FN_ENABLE, reg);
    299  1.1    nonaka 	SDMMC_UNLOCK(sc);
    300  1.4  kiyohara 
    301  1.1    nonaka 	retry = 5;
    302  1.1    nonaka 	while (!sdmmc_io_function_ready(sf) && retry-- > 0)
    303  1.2     pooka 		kpause("pause", false, hz, NULL);
    304  1.1    nonaka 	return (retry >= 0) ? 0 : ETIMEDOUT;
    305  1.1    nonaka }
    306  1.1    nonaka 
    307  1.1    nonaka /*
    308  1.1    nonaka  * Disable the I/O function.  Return zero if the function was
    309  1.1    nonaka  * disabled successfully.
    310  1.1    nonaka  */
    311  1.1    nonaka void
    312  1.1    nonaka sdmmc_io_function_disable(struct sdmmc_function *sf)
    313  1.1    nonaka {
    314  1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    315  1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    316  1.1    nonaka 	uint8_t reg;
    317  1.1    nonaka 
    318  1.1    nonaka 	if (sf->number == 0)
    319  1.1    nonaka 		return;		/* FN0 is always enabled */
    320  1.1    nonaka 
    321  1.1    nonaka 	SDMMC_LOCK(sc);
    322  1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_ENABLE);
    323  1.1    nonaka 	CLR(reg, (1U << sf->number));
    324  1.1    nonaka 	sdmmc_io_write_1(sf0, SD_IO_CCCR_FN_ENABLE, reg);
    325  1.1    nonaka 	SDMMC_UNLOCK(sc);
    326  1.1    nonaka }
    327  1.1    nonaka 
    328  1.1    nonaka static int
    329  1.1    nonaka sdmmc_io_rw_direct(struct sdmmc_softc *sc, struct sdmmc_function *sf,
    330  1.1    nonaka     int reg, u_char *datap, int arg)
    331  1.1    nonaka {
    332  1.1    nonaka 	struct sdmmc_command cmd;
    333  1.1    nonaka 	int error;
    334  1.1    nonaka 
    335  1.1    nonaka 	/* Don't lock */
    336  1.1    nonaka 
    337  1.1    nonaka 	/* Make sure the card is selected. */
    338  1.1    nonaka 	error = sdmmc_select_card(sc, sf);
    339  1.1    nonaka 	if (error)
    340  1.1    nonaka 		return error;
    341  1.1    nonaka 
    342  1.1    nonaka 	arg |= ((sf == NULL ? 0 : sf->number) & SD_ARG_CMD52_FUNC_MASK) <<
    343  1.1    nonaka 	    SD_ARG_CMD52_FUNC_SHIFT;
    344  1.1    nonaka 	arg |= (reg & SD_ARG_CMD52_REG_MASK) <<
    345  1.1    nonaka 	    SD_ARG_CMD52_REG_SHIFT;
    346  1.1    nonaka 	arg |= (*datap & SD_ARG_CMD52_DATA_MASK) <<
    347  1.1    nonaka 	    SD_ARG_CMD52_DATA_SHIFT;
    348  1.1    nonaka 
    349  1.1    nonaka 	memset(&cmd, 0, sizeof cmd);
    350  1.1    nonaka 	cmd.c_opcode = SD_IO_RW_DIRECT;
    351  1.1    nonaka 	cmd.c_arg = arg;
    352  1.1    nonaka 	cmd.c_flags = SCF_CMD_AC | SCF_RSP_R5;
    353  1.1    nonaka 
    354  1.1    nonaka 	error = sdmmc_mmc_command(sc, &cmd);
    355  1.1    nonaka 	*datap = SD_R5_DATA(cmd.c_resp);
    356  1.1    nonaka 
    357  1.1    nonaka 	return error;
    358  1.1    nonaka }
    359  1.1    nonaka 
    360  1.1    nonaka /*
    361  1.1    nonaka  * Useful values of `arg' to pass in are either SD_ARG_CMD53_READ or
    362  1.1    nonaka  * SD_ARG_CMD53_WRITE.  SD_ARG_CMD53_INCREMENT may be ORed into `arg'
    363  1.1    nonaka  * to access successive register locations instead of accessing the
    364  1.1    nonaka  * same register many times.
    365  1.1    nonaka  */
    366  1.1    nonaka static int
    367  1.1    nonaka sdmmc_io_rw_extended(struct sdmmc_softc *sc, struct sdmmc_function *sf,
    368  1.1    nonaka     int reg, u_char *datap, int datalen, int arg)
    369  1.1    nonaka {
    370  1.1    nonaka 	struct sdmmc_command cmd;
    371  1.1    nonaka 	int error;
    372  1.1    nonaka 
    373  1.1    nonaka 	/* Don't lock */
    374  1.1    nonaka 
    375  1.1    nonaka #if 0
    376  1.1    nonaka 	/* Make sure the card is selected. */
    377  1.1    nonaka 	error = sdmmc_select_card(sc, sf);
    378  1.1    nonaka 	if (error)
    379  1.1    nonaka 		return error;
    380  1.1    nonaka #endif
    381  1.1    nonaka 
    382  1.1    nonaka 	arg |= (((sf == NULL) ? 0 : sf->number) & SD_ARG_CMD53_FUNC_MASK) <<
    383  1.1    nonaka 	    SD_ARG_CMD53_FUNC_SHIFT;
    384  1.1    nonaka 	arg |= (reg & SD_ARG_CMD53_REG_MASK) <<
    385  1.1    nonaka 	    SD_ARG_CMD53_REG_SHIFT;
    386  1.1    nonaka 	arg |= (datalen & SD_ARG_CMD53_LENGTH_MASK) <<
    387  1.1    nonaka 	    SD_ARG_CMD53_LENGTH_SHIFT;
    388  1.1    nonaka 
    389  1.1    nonaka 	memset(&cmd, 0, sizeof cmd);
    390  1.1    nonaka 	cmd.c_opcode = SD_IO_RW_EXTENDED;
    391  1.1    nonaka 	cmd.c_arg = arg;
    392  1.1    nonaka 	cmd.c_flags = SCF_CMD_AC | SCF_RSP_R5;
    393  1.1    nonaka 	cmd.c_data = datap;
    394  1.1    nonaka 	cmd.c_datalen = datalen;
    395  1.1    nonaka 	cmd.c_blklen = MIN(datalen,
    396  1.1    nonaka 	    sdmmc_chip_host_maxblklen(sc->sc_sct,sc->sc_sch));
    397  1.1    nonaka 	if (!ISSET(arg, SD_ARG_CMD53_WRITE))
    398  1.1    nonaka 		cmd.c_flags |= SCF_CMD_READ;
    399  1.1    nonaka 
    400  1.1    nonaka 	error = sdmmc_mmc_command(sc, &cmd);
    401  1.1    nonaka 
    402  1.1    nonaka 	return error;
    403  1.1    nonaka }
    404  1.1    nonaka 
    405  1.1    nonaka uint8_t
    406  1.1    nonaka sdmmc_io_read_1(struct sdmmc_function *sf, int reg)
    407  1.1    nonaka {
    408  1.1    nonaka 	uint8_t data = 0;
    409  1.1    nonaka 
    410  1.1    nonaka 	/* Don't lock */
    411  1.4  kiyohara 
    412  1.1    nonaka 	(void)sdmmc_io_rw_direct(sf->sc, sf, reg, (u_char *)&data,
    413  1.1    nonaka 	    SD_ARG_CMD52_READ);
    414  1.1    nonaka 	return data;
    415  1.1    nonaka }
    416  1.1    nonaka 
    417  1.1    nonaka void
    418  1.1    nonaka sdmmc_io_write_1(struct sdmmc_function *sf, int reg, uint8_t data)
    419  1.1    nonaka {
    420  1.1    nonaka 
    421  1.1    nonaka 	/* Don't lock */
    422  1.1    nonaka 
    423  1.1    nonaka 	(void)sdmmc_io_rw_direct(sf->sc, sf, reg, (u_char *)&data,
    424  1.1    nonaka 	    SD_ARG_CMD52_WRITE);
    425  1.1    nonaka }
    426  1.1    nonaka 
    427  1.1    nonaka uint16_t
    428  1.1    nonaka sdmmc_io_read_2(struct sdmmc_function *sf, int reg)
    429  1.1    nonaka {
    430  1.1    nonaka 	uint16_t data = 0;
    431  1.1    nonaka 
    432  1.1    nonaka 	/* Don't lock */
    433  1.1    nonaka 
    434  1.1    nonaka 	(void)sdmmc_io_rw_extended(sf->sc, sf, reg, (u_char *)&data, 2,
    435  1.1    nonaka 	    SD_ARG_CMD53_READ | SD_ARG_CMD53_INCREMENT);
    436  1.1    nonaka 	return data;
    437  1.1    nonaka }
    438  1.1    nonaka 
    439  1.1    nonaka void
    440  1.1    nonaka sdmmc_io_write_2(struct sdmmc_function *sf, int reg, uint16_t data)
    441  1.1    nonaka {
    442  1.1    nonaka 
    443  1.1    nonaka 	/* Don't lock */
    444  1.1    nonaka 
    445  1.1    nonaka 	(void)sdmmc_io_rw_extended(sf->sc, sf, reg, (u_char *)&data, 2,
    446  1.1    nonaka 	    SD_ARG_CMD53_WRITE | SD_ARG_CMD53_INCREMENT);
    447  1.1    nonaka }
    448  1.1    nonaka 
    449  1.1    nonaka uint32_t
    450  1.1    nonaka sdmmc_io_read_4(struct sdmmc_function *sf, int reg)
    451  1.1    nonaka {
    452  1.1    nonaka 	uint32_t data = 0;
    453  1.1    nonaka 
    454  1.1    nonaka 	/* Don't lock */
    455  1.4  kiyohara 
    456  1.1    nonaka 	(void)sdmmc_io_rw_extended(sf->sc, sf, reg, (u_char *)&data, 4,
    457  1.1    nonaka 	    SD_ARG_CMD53_READ | SD_ARG_CMD53_INCREMENT);
    458  1.1    nonaka 	return data;
    459  1.1    nonaka }
    460  1.1    nonaka 
    461  1.1    nonaka void
    462  1.1    nonaka sdmmc_io_write_4(struct sdmmc_function *sf, int reg, uint32_t data)
    463  1.1    nonaka {
    464  1.1    nonaka 
    465  1.1    nonaka 	/* Don't lock */
    466  1.1    nonaka 
    467  1.1    nonaka 	(void)sdmmc_io_rw_extended(sf->sc, sf, reg, (u_char *)&data, 4,
    468  1.1    nonaka 	    SD_ARG_CMD53_WRITE | SD_ARG_CMD53_INCREMENT);
    469  1.1    nonaka }
    470  1.1    nonaka 
    471  1.1    nonaka 
    472  1.1    nonaka int
    473  1.1    nonaka sdmmc_io_read_multi_1(struct sdmmc_function *sf, int reg, u_char *data,
    474  1.1    nonaka     int datalen)
    475  1.1    nonaka {
    476  1.1    nonaka 	int error;
    477  1.1    nonaka 
    478  1.1    nonaka 	/* Don't lock */
    479  1.1    nonaka 
    480  1.1    nonaka 	while (datalen > SD_ARG_CMD53_LENGTH_MAX) {
    481  1.1    nonaka 		error = sdmmc_io_rw_extended(sf->sc, sf, reg, data,
    482  1.1    nonaka 		    SD_ARG_CMD53_LENGTH_MAX, SD_ARG_CMD53_READ);
    483  1.1    nonaka 		if (error)
    484  1.1    nonaka 			goto error;
    485  1.1    nonaka 		data += SD_ARG_CMD53_LENGTH_MAX;
    486  1.1    nonaka 		datalen -= SD_ARG_CMD53_LENGTH_MAX;
    487  1.1    nonaka 	}
    488  1.1    nonaka 
    489  1.1    nonaka 	error = sdmmc_io_rw_extended(sf->sc, sf, reg, data, datalen,
    490  1.1    nonaka 	    SD_ARG_CMD53_READ);
    491  1.1    nonaka error:
    492  1.1    nonaka 	return error;
    493  1.1    nonaka }
    494  1.1    nonaka 
    495  1.1    nonaka int
    496  1.1    nonaka sdmmc_io_write_multi_1(struct sdmmc_function *sf, int reg, u_char *data,
    497  1.1    nonaka     int datalen)
    498  1.1    nonaka {
    499  1.1    nonaka 	int error;
    500  1.1    nonaka 
    501  1.1    nonaka 	/* Don't lock */
    502  1.1    nonaka 
    503  1.1    nonaka 	while (datalen > SD_ARG_CMD53_LENGTH_MAX) {
    504  1.1    nonaka 		error = sdmmc_io_rw_extended(sf->sc, sf, reg, data,
    505  1.1    nonaka 		    SD_ARG_CMD53_LENGTH_MAX, SD_ARG_CMD53_WRITE);
    506  1.1    nonaka 		if (error)
    507  1.1    nonaka 			goto error;
    508  1.1    nonaka 		data += SD_ARG_CMD53_LENGTH_MAX;
    509  1.1    nonaka 		datalen -= SD_ARG_CMD53_LENGTH_MAX;
    510  1.1    nonaka 	}
    511  1.1    nonaka 
    512  1.1    nonaka 	error = sdmmc_io_rw_extended(sf->sc, sf, reg, data, datalen,
    513  1.1    nonaka 	    SD_ARG_CMD53_WRITE);
    514  1.1    nonaka error:
    515  1.1    nonaka 	return error;
    516  1.1    nonaka }
    517  1.1    nonaka 
    518  1.1    nonaka #if 0
    519  1.1    nonaka static int
    520  1.1    nonaka sdmmc_io_xchg(struct sdmmc_softc *sc, struct sdmmc_function *sf,
    521  1.1    nonaka     int reg, u_char *datap)
    522  1.1    nonaka {
    523  1.1    nonaka 
    524  1.1    nonaka 	/* Don't lock */
    525  1.1    nonaka 
    526  1.1    nonaka 	return sdmmc_io_rw_direct(sc, sf, reg, datap,
    527  1.1    nonaka 	    SD_ARG_CMD52_WRITE|SD_ARG_CMD52_EXCHANGE);
    528  1.1    nonaka }
    529  1.1    nonaka #endif
    530  1.1    nonaka 
    531  1.1    nonaka /*
    532  1.1    nonaka  * Reset the I/O functions of the card.
    533  1.1    nonaka  */
    534  1.1    nonaka static void
    535  1.1    nonaka sdmmc_io_reset(struct sdmmc_softc *sc)
    536  1.1    nonaka {
    537  1.1    nonaka 
    538  1.1    nonaka 	/* Don't lock */
    539  1.1    nonaka #if 0 /* XXX command fails */
    540  1.1    nonaka 	(void)sdmmc_io_write(sc, NULL, SD_IO_REG_CCCR_CTL, CCCR_CTL_RES);
    541  1.1    nonaka 	sdmmc_delay(100000);
    542  1.1    nonaka #endif
    543  1.1    nonaka }
    544  1.1    nonaka 
    545  1.1    nonaka /*
    546  1.1    nonaka  * Get or set the card's I/O OCR value (SDIO).
    547  1.1    nonaka  */
    548  1.1    nonaka static int
    549  1.1    nonaka sdmmc_io_send_op_cond(struct sdmmc_softc *sc, u_int32_t ocr, u_int32_t *ocrp)
    550  1.1    nonaka {
    551  1.1    nonaka 	struct sdmmc_command cmd;
    552  1.1    nonaka 	int error;
    553  1.1    nonaka 	int retry;
    554  1.1    nonaka 
    555  1.1    nonaka 	DPRINTF(("sdmmc_io_send_op_cond: ocr = %#x\n", ocr));
    556  1.1    nonaka 
    557  1.1    nonaka 	/* Don't lock */
    558  1.1    nonaka 
    559  1.1    nonaka 	/*
    560  1.1    nonaka 	 * If we change the OCR value, retry the command until the OCR
    561  1.1    nonaka 	 * we receive in response has the "CARD BUSY" bit set, meaning
    562  1.1    nonaka 	 * that all cards are ready for identification.
    563  1.1    nonaka 	 */
    564  1.1    nonaka 	for (retry = 0; retry < 100; retry++) {
    565  1.1    nonaka 		memset(&cmd, 0, sizeof cmd);
    566  1.1    nonaka 		cmd.c_opcode = SD_IO_SEND_OP_COND;
    567  1.1    nonaka 		cmd.c_arg = ocr;
    568  1.1    nonaka 		cmd.c_flags = SCF_CMD_BCR | SCF_RSP_R4;
    569  1.1    nonaka 
    570  1.1    nonaka 		error = sdmmc_mmc_command(sc, &cmd);
    571  1.1    nonaka 		if (error)
    572  1.1    nonaka 			break;
    573  1.1    nonaka 		if (ISSET(MMC_R4(cmd.c_resp), SD_IO_OCR_MEM_READY) || ocr == 0)
    574  1.1    nonaka 			break;
    575  1.1    nonaka 
    576  1.1    nonaka 		error = ETIMEDOUT;
    577  1.1    nonaka 		sdmmc_delay(10000);
    578  1.1    nonaka 	}
    579  1.1    nonaka 	if (error == 0 && ocrp != NULL)
    580  1.1    nonaka 		*ocrp = MMC_R4(cmd.c_resp);
    581  1.1    nonaka 
    582  1.1    nonaka 	DPRINTF(("sdmmc_io_send_op_cond: error = %d\n", error));
    583  1.1    nonaka 
    584  1.1    nonaka 	return error;
    585  1.1    nonaka }
    586  1.1    nonaka 
    587  1.1    nonaka /*
    588  1.1    nonaka  * Card interrupt handling
    589  1.1    nonaka  */
    590  1.1    nonaka 
    591  1.1    nonaka void
    592  1.1    nonaka sdmmc_intr_enable(struct sdmmc_function *sf)
    593  1.1    nonaka {
    594  1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    595  1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    596  1.1    nonaka 	uint8_t reg;
    597  1.1    nonaka 
    598  1.1    nonaka 	SDMMC_LOCK(sc);
    599  1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_INTEN);
    600  1.1    nonaka 	reg |= 1 << sf->number;
    601  1.1    nonaka 	sdmmc_io_write_1(sf0, SD_IO_CCCR_FN_INTEN, reg);
    602  1.1    nonaka 	SDMMC_UNLOCK(sc);
    603  1.1    nonaka }
    604  1.1    nonaka 
    605  1.1    nonaka void
    606  1.1    nonaka sdmmc_intr_disable(struct sdmmc_function *sf)
    607  1.1    nonaka {
    608  1.1    nonaka 	struct sdmmc_softc *sc = sf->sc;
    609  1.1    nonaka 	struct sdmmc_function *sf0 = sc->sc_fn0;
    610  1.1    nonaka 	uint8_t reg;
    611  1.1    nonaka 
    612  1.1    nonaka 	SDMMC_LOCK(sc);
    613  1.1    nonaka 	reg = sdmmc_io_read_1(sf0, SD_IO_CCCR_FN_INTEN);
    614  1.1    nonaka 	reg &= ~(1 << sf->number);
    615  1.1    nonaka 	sdmmc_io_write_1(sf0, SD_IO_CCCR_FN_INTEN, reg);
    616  1.1    nonaka 	SDMMC_UNLOCK(sc);
    617  1.1    nonaka }
    618  1.1    nonaka 
    619  1.1    nonaka /*
    620  1.1    nonaka  * Establish a handler for the SDIO card interrupt.  Because the
    621  1.1    nonaka  * interrupt may be shared with different SDIO functions, multiple
    622  1.1    nonaka  * handlers can be established.
    623  1.1    nonaka  */
    624  1.1    nonaka void *
    625  1.1    nonaka sdmmc_intr_establish(device_t dev, int (*fun)(void *), void *arg,
    626  1.1    nonaka     const char *name)
    627  1.1    nonaka {
    628  1.1    nonaka 	struct sdmmc_softc *sc = device_private(dev);
    629  1.1    nonaka 	struct sdmmc_intr_handler *ih;
    630  1.1    nonaka 
    631  1.1    nonaka 	if (sc->sc_sct->card_enable_intr == NULL)
    632  1.1    nonaka 		return NULL;
    633  1.1    nonaka 
    634  1.1    nonaka 	ih = malloc(sizeof *ih, M_DEVBUF, M_WAITOK|M_CANFAIL|M_ZERO);
    635  1.1    nonaka 	if (ih == NULL)
    636  1.1    nonaka 		return NULL;
    637  1.1    nonaka 
    638  1.1    nonaka 	ih->ih_name = malloc(strlen(name) + 1, M_DEVBUF,
    639  1.1    nonaka 	    M_WAITOK|M_CANFAIL|M_ZERO);
    640  1.1    nonaka 	if (ih->ih_name == NULL) {
    641  1.1    nonaka 		free(ih, M_DEVBUF);
    642  1.1    nonaka 		return NULL;
    643  1.1    nonaka 	}
    644  1.1    nonaka 	strlcpy(ih->ih_name, name, strlen(name));
    645  1.1    nonaka 	ih->ih_softc = sc;
    646  1.1    nonaka 	ih->ih_fun = fun;
    647  1.1    nonaka 	ih->ih_arg = arg;
    648  1.1    nonaka 
    649  1.9   mlelstv 	mutex_enter(&sc->sc_mtx);
    650  1.1    nonaka 	if (TAILQ_EMPTY(&sc->sc_intrq)) {
    651  1.1    nonaka 		sdmmc_intr_enable(sc->sc_fn0);
    652  1.1    nonaka 		sdmmc_chip_card_enable_intr(sc->sc_sct, sc->sc_sch, 1);
    653  1.1    nonaka 	}
    654  1.1    nonaka 	TAILQ_INSERT_TAIL(&sc->sc_intrq, ih, entry);
    655  1.9   mlelstv 	mutex_exit(&sc->sc_mtx);
    656  1.1    nonaka 
    657  1.1    nonaka 	return ih;
    658  1.1    nonaka }
    659  1.1    nonaka 
    660  1.1    nonaka /*
    661  1.1    nonaka  * Disestablish the given handler.
    662  1.1    nonaka  */
    663  1.1    nonaka void
    664  1.1    nonaka sdmmc_intr_disestablish(void *cookie)
    665  1.1    nonaka {
    666  1.1    nonaka 	struct sdmmc_intr_handler *ih = cookie;
    667  1.1    nonaka 	struct sdmmc_softc *sc = ih->ih_softc;
    668  1.1    nonaka 
    669  1.1    nonaka 	if (sc->sc_sct->card_enable_intr == NULL)
    670  1.1    nonaka 		return;
    671  1.1    nonaka 
    672  1.9   mlelstv 	mutex_enter(&sc->sc_mtx);
    673  1.1    nonaka 	TAILQ_REMOVE(&sc->sc_intrq, ih, entry);
    674  1.1    nonaka 	if (TAILQ_EMPTY(&sc->sc_intrq)) {
    675  1.1    nonaka 		sdmmc_chip_card_enable_intr(sc->sc_sct, sc->sc_sch, 0);
    676  1.1    nonaka 		sdmmc_intr_disable(sc->sc_fn0);
    677  1.1    nonaka 	}
    678  1.9   mlelstv 	mutex_exit(&sc->sc_mtx);
    679  1.1    nonaka 
    680  1.1    nonaka 	free(ih->ih_name, M_DEVBUF);
    681  1.1    nonaka 	free(ih, M_DEVBUF);
    682  1.1    nonaka }
    683  1.1    nonaka 
    684  1.1    nonaka /*
    685  1.1    nonaka  * Call established SDIO card interrupt handlers.  The host controller
    686  1.1    nonaka  * must call this function from its own interrupt handler to handle an
    687  1.1    nonaka  * SDIO interrupt from the card.
    688  1.1    nonaka  */
    689  1.1    nonaka void
    690  1.1    nonaka sdmmc_card_intr(device_t dev)
    691  1.1    nonaka {
    692  1.1    nonaka 	struct sdmmc_softc *sc = device_private(dev);
    693  1.1    nonaka 
    694  1.8   mlelstv 	if (sc->sc_sct->card_enable_intr == NULL)
    695  1.8   mlelstv 		return;
    696  1.8   mlelstv 
    697  1.8   mlelstv 	mutex_enter(&sc->sc_intr_task_mtx);
    698  1.8   mlelstv 	if (!sdmmc_task_pending(&sc->sc_intr_task))
    699  1.8   mlelstv 		sdmmc_add_task(sc, &sc->sc_intr_task);
    700  1.8   mlelstv 	mutex_exit(&sc->sc_intr_task_mtx);
    701  1.1    nonaka }
    702  1.1    nonaka 
    703  1.1    nonaka void
    704  1.1    nonaka sdmmc_intr_task(void *arg)
    705  1.1    nonaka {
    706  1.1    nonaka 	struct sdmmc_softc *sc = (struct sdmmc_softc *)arg;
    707  1.1    nonaka 	struct sdmmc_intr_handler *ih;
    708  1.1    nonaka 
    709  1.9   mlelstv 	mutex_enter(&sc->sc_mtx);
    710  1.1    nonaka 	TAILQ_FOREACH(ih, &sc->sc_intrq, entry) {
    711  1.9   mlelstv 		mutex_exit(&sc->sc_mtx);
    712  1.1    nonaka 		/* XXX examine return value and do evcount stuff*/
    713  1.1    nonaka 		(void)(*ih->ih_fun)(ih->ih_arg);
    714  1.9   mlelstv 		mutex_enter(&sc->sc_mtx);
    715  1.1    nonaka 	}
    716  1.1    nonaka 	sdmmc_chip_card_intr_ack(sc->sc_sct, sc->sc_sch);
    717  1.9   mlelstv 	mutex_exit(&sc->sc_mtx);
    718  1.1    nonaka }
    719