Home | History | Annotate | Line # | Download | only in t_sh7706lan
ssumci.c revision 1.3.44.1
      1  1.3.44.1  thorpej /*	$NetBSD: ssumci.c,v 1.3.44.1 2021/03/21 21:08:59 thorpej Exp $	*/
      2       1.1   nonaka 
      3       1.1   nonaka /*-
      4       1.2   nonaka  * Copyright (C) 2010 NONAKA Kimihiro <nonaka (at) netbsd.org>
      5       1.1   nonaka  * All rights reserved.
      6       1.1   nonaka  *
      7       1.1   nonaka  * Redistribution and use in source and binary forms, with or without
      8       1.1   nonaka  * modification, are permitted provided that the following conditions
      9       1.1   nonaka  * are met:
     10       1.1   nonaka  * 1. Redistributions of source code must retain the above copyright
     11       1.1   nonaka  *    notice, this list of conditions and the following disclaimer.
     12       1.1   nonaka  * 2. Redistributions in binary form must reproduce the above copyright
     13       1.1   nonaka  *    notice, this list of conditions and the following disclaimer in the
     14       1.1   nonaka  *    documentation and/or other materials provided with the distribution.
     15       1.1   nonaka  *
     16       1.2   nonaka  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17       1.2   nonaka  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18       1.2   nonaka  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19       1.2   nonaka  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20       1.2   nonaka  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     21       1.2   nonaka  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     22       1.2   nonaka  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     23       1.2   nonaka  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     24       1.2   nonaka  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     25       1.2   nonaka  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     26       1.1   nonaka  */
     27       1.1   nonaka 
     28       1.1   nonaka /*
     29       1.1   nonaka  * driver to access MMC/SD card
     30       1.1   nonaka  */
     31       1.1   nonaka 
     32       1.1   nonaka #include <sys/cdefs.h>
     33  1.3.44.1  thorpej __KERNEL_RCSID(0, "$NetBSD: ssumci.c,v 1.3.44.1 2021/03/21 21:08:59 thorpej Exp $");
     34       1.1   nonaka 
     35       1.1   nonaka #include <sys/param.h>
     36       1.1   nonaka #include <sys/device.h>
     37       1.1   nonaka #include <sys/systm.h>
     38       1.1   nonaka #include <sys/malloc.h>
     39       1.1   nonaka #include <sys/kernel.h>
     40       1.1   nonaka #include <sys/proc.h>
     41       1.1   nonaka #include <sys/bus.h>
     42       1.1   nonaka #include <sys/intr.h>
     43       1.1   nonaka 
     44       1.1   nonaka #include <sh3/devreg.h>
     45       1.1   nonaka #include <sh3/pfcreg.h>
     46       1.1   nonaka #include <sh3/scireg.h>
     47       1.1   nonaka 
     48       1.1   nonaka #include <dev/sdmmc/sdmmcvar.h>
     49       1.1   nonaka #include <dev/sdmmc/sdmmcchip.h>
     50       1.1   nonaka 
     51       1.1   nonaka #include <machine/autoconf.h>
     52       1.1   nonaka 
     53       1.1   nonaka #include <evbsh3/t_sh7706lan/t_sh7706lanvar.h>
     54       1.1   nonaka 
     55       1.1   nonaka #ifdef SSUMCI_DEBUG
     56       1.1   nonaka int ssumci_debug = 1;
     57       1.1   nonaka #define DPRINTF(n,s)	do { if ((n) <= ssumci_debug) printf s; } while (0)
     58       1.1   nonaka #else
     59       1.1   nonaka #define DPRINTF(n,s)	do {} while (0)
     60       1.1   nonaka #endif
     61       1.1   nonaka 
     62       1.1   nonaka static int	ssumci_host_reset(sdmmc_chipset_handle_t);
     63       1.1   nonaka static uint32_t	ssumci_host_ocr(sdmmc_chipset_handle_t);
     64       1.1   nonaka static int	ssumci_host_maxblklen(sdmmc_chipset_handle_t);
     65       1.1   nonaka static int	ssumci_card_detect(sdmmc_chipset_handle_t);
     66       1.1   nonaka static int	ssumci_write_protect(sdmmc_chipset_handle_t);
     67       1.1   nonaka static int	ssumci_bus_power(sdmmc_chipset_handle_t, uint32_t);
     68       1.1   nonaka static int	ssumci_bus_clock(sdmmc_chipset_handle_t, int);
     69       1.1   nonaka static int	ssumci_bus_width(sdmmc_chipset_handle_t, int);
     70       1.1   nonaka static void	ssumci_exec_command(sdmmc_chipset_handle_t,
     71       1.1   nonaka 		    struct sdmmc_command *);
     72       1.1   nonaka 
     73       1.1   nonaka static struct sdmmc_chip_functions ssumci_chip_functions = {
     74       1.1   nonaka 	/* host controller reset */
     75       1.1   nonaka 	.host_reset		= ssumci_host_reset,
     76       1.1   nonaka 
     77       1.1   nonaka 	/* host controller capabilities */
     78       1.1   nonaka 	.host_ocr		= ssumci_host_ocr,
     79       1.1   nonaka 	.host_maxblklen		= ssumci_host_maxblklen,
     80       1.1   nonaka 
     81       1.1   nonaka 	/* card detection */
     82       1.1   nonaka 	.card_detect		= ssumci_card_detect,
     83       1.1   nonaka 
     84       1.1   nonaka 	/* write protect */
     85       1.1   nonaka 	.write_protect		= ssumci_write_protect,
     86       1.1   nonaka 
     87       1.1   nonaka 	/* bus power, clock frequency, width */
     88       1.1   nonaka 	.bus_power		= ssumci_bus_power,
     89       1.1   nonaka 	.bus_clock		= ssumci_bus_clock,
     90       1.1   nonaka 	.bus_width		= ssumci_bus_width,
     91       1.1   nonaka 
     92       1.1   nonaka 	/* command execution */
     93       1.1   nonaka 	.exec_command		= ssumci_exec_command,
     94       1.1   nonaka 
     95       1.1   nonaka 	/* card interrupt */
     96       1.1   nonaka 	.card_enable_intr	= NULL,
     97       1.1   nonaka 	.card_intr_ack		= NULL,
     98       1.1   nonaka };
     99       1.1   nonaka 
    100       1.1   nonaka static void	ssumci_spi_initialize(sdmmc_chipset_handle_t);
    101       1.1   nonaka 
    102       1.1   nonaka static struct sdmmc_spi_chip_functions ssumci_spi_chip_functions = {
    103       1.1   nonaka 	.initialize		= ssumci_spi_initialize,
    104       1.1   nonaka };
    105       1.1   nonaka 
    106       1.1   nonaka #define	CSR_SET_1(reg,set,mask) 					\
    107       1.1   nonaka do {									\
    108       1.1   nonaka 	uint8_t _r;							\
    109       1.1   nonaka 	_r = _reg_read_1((reg));					\
    110       1.1   nonaka 	_r &= ~(mask);							\
    111       1.1   nonaka 	_r |= (set);							\
    112       1.1   nonaka 	_reg_write_1((reg), _r);					\
    113       1.1   nonaka } while (/*CONSTCOND*/0)
    114       1.1   nonaka 
    115       1.1   nonaka #define	CSR_SET_2(reg,set,mask) 					\
    116       1.1   nonaka do {									\
    117       1.1   nonaka 	uint16_t _r;							\
    118       1.1   nonaka 	_r = _reg_read_2((reg));					\
    119       1.1   nonaka 	_r &= ~(mask);							\
    120       1.1   nonaka 	_r |= (set);							\
    121       1.1   nonaka 	_reg_write_2((reg), _r);					\
    122       1.1   nonaka } while (/*CONSTCOND*/0)
    123       1.1   nonaka 
    124       1.1   nonaka #define	CSR_CLR_1(reg,clr)	 					\
    125       1.1   nonaka do {									\
    126       1.1   nonaka 	uint8_t _r;							\
    127       1.1   nonaka 	_r = _reg_read_1((reg));					\
    128       1.1   nonaka 	_r &= ~(clr);							\
    129       1.1   nonaka 	_reg_write_1((reg), _r);					\
    130       1.1   nonaka } while (/*CONSTCOND*/0)
    131       1.1   nonaka 
    132       1.1   nonaka #define	CSR_CLR_2(reg,clr)	 					\
    133       1.1   nonaka do {									\
    134       1.1   nonaka 	uint16_t _r;							\
    135       1.1   nonaka 	_r = _reg_read_2((reg));					\
    136       1.1   nonaka 	_r &= ~(clr);							\
    137       1.1   nonaka 	_reg_write_2((reg), _r);					\
    138       1.1   nonaka } while (/*CONSTCOND*/0)
    139       1.1   nonaka 
    140       1.1   nonaka #define SCPCR_CLK_MASK	0x000C
    141       1.1   nonaka #define SCPCR_CLK_IN	0x000C
    142       1.1   nonaka #define SCPCR_CLK_OUT	0x0004
    143       1.1   nonaka #define SCPDR_CLK	0x02
    144       1.1   nonaka #define SCPCR_DAT_MASK	0x0003
    145       1.1   nonaka #define SCPCR_DAT_IN	0x0003
    146       1.1   nonaka #define SCPCR_DAT_OUT	0x0001
    147       1.1   nonaka #define SCPDR_DAT	0x01
    148       1.1   nonaka #define SCPCR_CMD_MASK	0x0030
    149       1.1   nonaka #define SCPCR_CMD_IN	0x0030
    150       1.1   nonaka #define SCPCR_CMD_OUT	0x0010
    151       1.1   nonaka #define SCPDR_CMD	0x04
    152       1.1   nonaka #define	SCPCR_CS_MASK	0x000C
    153       1.1   nonaka #define	SCPCR_CS_OUT	0x0004
    154       1.3   nonaka #define	SCPDR_CS	0x02
    155       1.1   nonaka #define	SCPCR_EJECT	0x00C0
    156       1.1   nonaka #define	SCPDR_EJECT	0x08
    157       1.1   nonaka 
    158       1.1   nonaka #define MMC_TIME_OVER	20000
    159       1.1   nonaka 
    160       1.1   nonaka struct ssumci_softc {
    161       1.1   nonaka 	device_t sc_dev;
    162       1.1   nonaka 	device_t sc_sdmmc;
    163       1.1   nonaka };
    164       1.1   nonaka 
    165       1.1   nonaka static int ssumci_match(device_t, cfdata_t, void *);
    166       1.1   nonaka static void ssumci_attach(device_t, device_t, void *);
    167       1.1   nonaka 
    168       1.1   nonaka CFATTACH_DECL_NEW(ssumci, sizeof(struct ssumci_softc),
    169       1.1   nonaka     ssumci_match, ssumci_attach, NULL, NULL);
    170       1.1   nonaka 
    171       1.1   nonaka static void ssumci_cmd_cfgread(struct ssumci_softc *, struct sdmmc_command *);
    172       1.1   nonaka static void ssumci_cmd_read(struct ssumci_softc *, struct sdmmc_command *);
    173       1.1   nonaka static void ssumci_cmd_write(struct ssumci_softc *, struct sdmmc_command *);
    174       1.1   nonaka 
    175       1.1   nonaka #define	SSUMCI_SPIDR	0xb0008000
    176       1.1   nonaka #define	SSUMCI_SPISR	0xb0008002
    177       1.1   nonaka #define	SSUMCI_SPIBR	0xb0008004
    178       1.1   nonaka 
    179       1.1   nonaka static inline void
    180       1.1   nonaka ssumci_wait(void)
    181       1.1   nonaka {
    182       1.1   nonaka 
    183       1.1   nonaka 	while (_reg_read_1(SSUMCI_SPISR) == 0x00)
    184       1.1   nonaka 		continue;
    185       1.1   nonaka }
    186       1.1   nonaka 
    187       1.1   nonaka static inline uint8_t
    188       1.1   nonaka ssumci_getc(void)
    189       1.1   nonaka {
    190       1.1   nonaka 
    191       1.1   nonaka 	ssumci_wait();
    192       1.1   nonaka 	return _reg_read_1(SSUMCI_SPIBR);
    193       1.1   nonaka }
    194       1.1   nonaka 
    195       1.1   nonaka static inline void
    196       1.1   nonaka ssumci_putc(uint8_t v)
    197       1.1   nonaka {
    198       1.1   nonaka 
    199       1.1   nonaka 	_reg_write_1(SSUMCI_SPIDR, v);
    200       1.1   nonaka 	ssumci_wait();
    201       1.1   nonaka }
    202       1.1   nonaka 
    203       1.1   nonaka /*ARGSUSED*/
    204       1.1   nonaka static int
    205       1.1   nonaka ssumci_match(device_t parent, cfdata_t cf, void *aux)
    206       1.1   nonaka {
    207       1.1   nonaka 	struct mainbus_attach_args *maa = (struct mainbus_attach_args *)aux;
    208       1.1   nonaka 
    209       1.1   nonaka 	if (strcmp(maa->ma_name, "ssumci") != 0)
    210       1.1   nonaka 		return 0;
    211       1.1   nonaka 	if (!IS_SH7706LSR)
    212       1.1   nonaka 		return 0;
    213       1.1   nonaka 	return 1;
    214       1.1   nonaka }
    215       1.1   nonaka 
    216       1.1   nonaka /*ARGSUSED*/
    217       1.1   nonaka static void
    218       1.1   nonaka ssumci_attach(device_t parent, device_t self, void *aux)
    219       1.1   nonaka {
    220       1.1   nonaka 	struct ssumci_softc *sc = device_private(self);
    221       1.1   nonaka 	struct sdmmcbus_attach_args saa;
    222       1.1   nonaka 
    223       1.1   nonaka 	sc->sc_dev = self;
    224       1.1   nonaka 
    225       1.1   nonaka 	aprint_naive("\n");
    226       1.1   nonaka 	aprint_normal(": SPI MMC controller\n");
    227       1.1   nonaka 
    228       1.1   nonaka 	/* setup */
    229       1.1   nonaka 	CSR_SET_2(SH7709_SCPCR, SCPCR_CS_OUT, SCPCR_CS_MASK);
    230       1.1   nonaka 
    231       1.1   nonaka 	/*
    232       1.1   nonaka 	 * Attach the generic SD/MMC bus driver.  (The bus driver must
    233       1.1   nonaka 	 * not invoke any chipset functions before it is attached.)
    234       1.1   nonaka 	 */
    235       1.1   nonaka 	memset(&saa, 0, sizeof(saa));
    236       1.1   nonaka 	saa.saa_busname = "sdmmc";
    237       1.1   nonaka 	saa.saa_sct = &ssumci_chip_functions;
    238       1.1   nonaka 	saa.saa_spi_sct = &ssumci_spi_chip_functions;
    239       1.1   nonaka 	saa.saa_sch = sc;
    240       1.1   nonaka 	saa.saa_clkmin = 400;
    241       1.1   nonaka 	saa.saa_clkmax = 400;
    242       1.1   nonaka 	saa.saa_caps = SMC_CAPS_SPI_MODE
    243       1.1   nonaka 	               | SMC_CAPS_SINGLE_ONLY
    244       1.1   nonaka 	               | SMC_CAPS_POLL_CARD_DET;
    245       1.1   nonaka 
    246  1.3.44.1  thorpej 	sc->sc_sdmmc = config_found(sc->sc_dev, &saa, NULL, CFARG_EOL);
    247       1.1   nonaka 	if (sc->sc_sdmmc == NULL)
    248       1.1   nonaka 		aprint_error_dev(sc->sc_dev, "couldn't attach bus\n");
    249       1.1   nonaka }
    250       1.1   nonaka 
    251       1.1   nonaka /*
    252       1.1   nonaka  * Reset the host controller.  Called during initialization, when
    253       1.1   nonaka  * cards are removed, upon resume, and during error recovery.
    254       1.1   nonaka  */
    255       1.1   nonaka /*ARGSUSED*/
    256       1.1   nonaka static int
    257       1.1   nonaka ssumci_host_reset(sdmmc_chipset_handle_t sch)
    258       1.1   nonaka {
    259       1.1   nonaka 
    260       1.1   nonaka 	return 0;
    261       1.1   nonaka }
    262       1.1   nonaka 
    263       1.1   nonaka /*ARGSUSED*/
    264       1.1   nonaka static uint32_t
    265       1.1   nonaka ssumci_host_ocr(sdmmc_chipset_handle_t sch)
    266       1.1   nonaka {
    267       1.1   nonaka 
    268       1.1   nonaka 	return MMC_OCR_3_2V_3_3V|MMC_OCR_3_3V_3_4V;
    269       1.1   nonaka }
    270       1.1   nonaka 
    271       1.1   nonaka /*ARGSUSED*/
    272       1.1   nonaka static int
    273       1.1   nonaka ssumci_host_maxblklen(sdmmc_chipset_handle_t sch)
    274       1.1   nonaka {
    275       1.1   nonaka 
    276       1.1   nonaka 	return 512;
    277       1.1   nonaka }
    278       1.1   nonaka 
    279       1.1   nonaka /*ARGSUSED*/
    280       1.1   nonaka static int
    281       1.1   nonaka ssumci_card_detect(sdmmc_chipset_handle_t sch)
    282       1.1   nonaka {
    283       1.1   nonaka 	uint8_t reg;
    284       1.1   nonaka 	int s;
    285       1.1   nonaka 
    286       1.1   nonaka 	s = splsdmmc();
    287       1.1   nonaka 	CSR_SET_2(SH7709_SCPCR, SCPCR_EJECT, 0);
    288       1.1   nonaka 	reg = _reg_read_1(SH7709_SCPDR);
    289       1.1   nonaka 	splx(s);
    290       1.1   nonaka 
    291       1.1   nonaka 	return !(reg & SCPDR_EJECT);
    292       1.1   nonaka }
    293       1.1   nonaka 
    294       1.1   nonaka /*ARGSUSED*/
    295       1.1   nonaka static int
    296       1.1   nonaka ssumci_write_protect(sdmmc_chipset_handle_t sch)
    297       1.1   nonaka {
    298       1.1   nonaka 
    299       1.1   nonaka 	return 0;	/* non-protect */
    300       1.1   nonaka }
    301       1.1   nonaka 
    302       1.1   nonaka /*
    303       1.1   nonaka  * Set or change SD bus voltage and enable or disable SD bus power.
    304       1.1   nonaka  * Return zero on success.
    305       1.1   nonaka  */
    306       1.1   nonaka /*ARGSUSED*/
    307       1.1   nonaka static int
    308       1.1   nonaka ssumci_bus_power(sdmmc_chipset_handle_t sch, uint32_t ocr)
    309       1.1   nonaka {
    310       1.1   nonaka 
    311       1.1   nonaka 	if ((ocr & (MMC_OCR_3_2V_3_3V|MMC_OCR_3_3V_3_4V)) == 0)
    312       1.1   nonaka 		return 1;
    313       1.1   nonaka 
    314       1.1   nonaka 	/*XXX???*/
    315       1.1   nonaka 	return 0;
    316       1.1   nonaka }
    317       1.1   nonaka 
    318       1.1   nonaka /*
    319       1.1   nonaka  * Set or change MMCLK frequency or disable the MMC clock.
    320       1.1   nonaka  * Return zero on success.
    321       1.1   nonaka  */
    322       1.1   nonaka /*ARGSUSED*/
    323       1.1   nonaka static int
    324       1.1   nonaka ssumci_bus_clock(sdmmc_chipset_handle_t sch, int freq)
    325       1.1   nonaka {
    326       1.1   nonaka 
    327       1.1   nonaka 	return 0;
    328       1.1   nonaka }
    329       1.1   nonaka 
    330       1.1   nonaka /*ARGSUSED*/
    331       1.1   nonaka static int
    332       1.1   nonaka ssumci_bus_width(sdmmc_chipset_handle_t sch, int width)
    333       1.1   nonaka {
    334       1.1   nonaka 
    335       1.1   nonaka 	if (width != 1)
    336       1.1   nonaka 		return 1;
    337       1.1   nonaka 	return 0;
    338       1.1   nonaka }
    339       1.1   nonaka 
    340       1.1   nonaka /*ARGSUSED*/
    341       1.1   nonaka static void
    342       1.1   nonaka ssumci_spi_initialize(sdmmc_chipset_handle_t sch)
    343       1.1   nonaka {
    344       1.1   nonaka 	int i, s;
    345       1.1   nonaka 
    346       1.1   nonaka 	s = splsdmmc();
    347       1.1   nonaka 	CSR_SET_1(SH7709_SCPDR, SCPDR_CS, 0);
    348       1.1   nonaka 	for (i = 0; i < 10; i++) {
    349       1.1   nonaka 		ssumci_putc(0xff);
    350       1.1   nonaka 	}
    351       1.1   nonaka 	CSR_CLR_1(SH7709_SCPDR, SCPDR_CS);
    352       1.1   nonaka 	splx(s);
    353       1.1   nonaka }
    354       1.1   nonaka 
    355       1.1   nonaka static void
    356       1.1   nonaka ssumci_exec_command(sdmmc_chipset_handle_t sch, struct sdmmc_command *cmd)
    357       1.1   nonaka {
    358       1.1   nonaka 	struct ssumci_softc *sc = (struct ssumci_softc *)sch;
    359       1.1   nonaka 	uint16_t resp;
    360       1.1   nonaka 	int timo;
    361       1.1   nonaka 	int s;
    362       1.1   nonaka 
    363       1.1   nonaka 	DPRINTF(1,("%s: start cmd %d arg=%#x data=%p dlen=%d flags=%#x\n",
    364       1.1   nonaka 	    device_xname(sc->sc_dev), cmd->c_opcode, cmd->c_arg, cmd->c_data,
    365       1.1   nonaka 	    cmd->c_datalen, cmd->c_flags));
    366       1.1   nonaka 
    367       1.1   nonaka 	s = splsdmmc();
    368       1.1   nonaka 
    369       1.1   nonaka 	ssumci_putc(0xff);
    370       1.1   nonaka 	ssumci_putc(0x40 | (cmd->c_opcode & 0x3f));
    371       1.1   nonaka 	ssumci_putc((cmd->c_arg >> 24) & 0xff);
    372       1.1   nonaka 	ssumci_putc((cmd->c_arg >> 16) & 0xff);
    373       1.1   nonaka 	ssumci_putc((cmd->c_arg >> 8) & 0xff);
    374       1.1   nonaka 	ssumci_putc((cmd->c_arg >> 0) & 0xff);
    375       1.1   nonaka 	ssumci_putc((cmd->c_opcode == MMC_GO_IDLE_STATE) ? 0x95 :
    376       1.1   nonaka 	    (cmd->c_opcode == SD_SEND_IF_COND) ? 0x87 : 0); /* CRC */
    377       1.1   nonaka 
    378       1.1   nonaka 	for (timo = MMC_TIME_OVER; timo > 0; timo--) {
    379       1.1   nonaka 		resp = ssumci_getc();
    380       1.1   nonaka 		if (!(resp & 0x80) && timo <= (MMC_TIME_OVER - 2))
    381       1.1   nonaka 			break;
    382       1.1   nonaka 	}
    383       1.1   nonaka 	if (timo == 0) {
    384       1.1   nonaka 		DPRINTF(1,(sc->sc_dev, "response timeout\n"));
    385       1.1   nonaka 		cmd->c_error = ETIMEDOUT;
    386       1.1   nonaka 		goto out;
    387       1.1   nonaka 	}
    388       1.1   nonaka 
    389       1.1   nonaka 	if (ISSET(cmd->c_flags, SCF_RSP_SPI_S2)) {
    390       1.1   nonaka 		resp |= (uint16_t) ssumci_getc() << 8;
    391       1.1   nonaka 	} else if (ISSET(cmd->c_flags, SCF_RSP_SPI_B4)) {
    392       1.1   nonaka 		cmd->c_resp[1] =  (uint32_t) ssumci_getc() << 24;
    393       1.1   nonaka 		cmd->c_resp[1] |= (uint32_t) ssumci_getc() << 16;
    394       1.1   nonaka 		cmd->c_resp[1] |= (uint32_t) ssumci_getc() << 8;
    395       1.1   nonaka 		cmd->c_resp[1] |= (uint32_t) ssumci_getc();
    396       1.1   nonaka 		DPRINTF(1, ("R3 resp: %#x\n", cmd->c_resp[1]));
    397       1.1   nonaka 	}
    398       1.1   nonaka 	cmd->c_resp[0] = resp;
    399       1.1   nonaka 	if (resp != 0 && resp != R1_SPI_IDLE) {
    400       1.1   nonaka 		DPRINTF(1,("response error: %#x\n", resp));
    401       1.1   nonaka 		cmd->c_error = EIO;
    402       1.1   nonaka 		goto out;
    403       1.1   nonaka 	}
    404       1.1   nonaka 	DPRINTF(1, ("R1 resp: %#x\n", resp));
    405       1.1   nonaka 
    406       1.1   nonaka 	if (cmd->c_datalen > 0) {
    407       1.1   nonaka 		if (ISSET(cmd->c_flags, SCF_CMD_READ)) {
    408       1.1   nonaka 			/* XXX: swap in this place? */
    409       1.1   nonaka 			if (cmd->c_opcode == MMC_SEND_CID ||
    410       1.1   nonaka 			    cmd->c_opcode == MMC_SEND_CSD) {
    411       1.1   nonaka 				sdmmc_response res;
    412       1.1   nonaka 				uint32_t *p = cmd->c_data;
    413       1.1   nonaka 
    414       1.1   nonaka 				ssumci_cmd_cfgread(sc, cmd);
    415       1.1   nonaka 				res[0] = be32toh(p[3]);
    416       1.1   nonaka 				res[1] = be32toh(p[2]);
    417       1.1   nonaka 				res[2] = be32toh(p[1]);
    418       1.1   nonaka 				res[3] = be32toh(p[0]);
    419       1.1   nonaka 				memcpy(p, &res, sizeof(res));
    420       1.1   nonaka 			} else {
    421       1.1   nonaka 				ssumci_cmd_read(sc, cmd);
    422       1.1   nonaka 			}
    423       1.1   nonaka 		} else {
    424       1.1   nonaka 			ssumci_cmd_write(sc, cmd);
    425       1.1   nonaka 		}
    426       1.1   nonaka 	} else {
    427       1.1   nonaka 		ssumci_wait();
    428       1.1   nonaka 	}
    429       1.1   nonaka 
    430       1.1   nonaka out:
    431       1.1   nonaka 	SET(cmd->c_flags, SCF_ITSDONE);
    432       1.1   nonaka 	splx(s);
    433       1.1   nonaka 
    434       1.1   nonaka 	DPRINTF(1,("%s: cmd %d done (flags=%#x error=%d)\n",
    435       1.1   nonaka 	  device_xname(sc->sc_dev), cmd->c_opcode, cmd->c_flags, cmd->c_error));
    436       1.1   nonaka }
    437       1.1   nonaka 
    438       1.1   nonaka static void
    439       1.1   nonaka ssumci_cmd_cfgread(struct ssumci_softc *sc, struct sdmmc_command *cmd)
    440       1.1   nonaka {
    441       1.1   nonaka 	u_char *data = cmd->c_data;
    442       1.1   nonaka 	int timo;
    443       1.1   nonaka 	int c;
    444       1.1   nonaka 	int i;
    445       1.1   nonaka 
    446       1.1   nonaka 	/* wait data token */
    447       1.1   nonaka 	for (timo = MMC_TIME_OVER; timo > 0; timo--) {
    448       1.1   nonaka 		c = ssumci_getc();
    449       1.1   nonaka 		if (c != 0xff)
    450       1.1   nonaka 			break;
    451       1.1   nonaka 	}
    452       1.1   nonaka 	if (timo == 0) {
    453       1.1   nonaka 		aprint_error_dev(sc->sc_dev, "cfg read timeout\n");
    454       1.1   nonaka 		cmd->c_error = ETIMEDOUT;
    455       1.1   nonaka 		return;
    456       1.1   nonaka 	}
    457       1.1   nonaka 	if (c != 0xfe) {
    458       1.1   nonaka 		aprint_error_dev(sc->sc_dev, "cfg read error (data=%#x)\n", c);
    459       1.1   nonaka 		cmd->c_error = EIO;
    460       1.1   nonaka 		return;
    461       1.1   nonaka 	}
    462       1.1   nonaka 
    463       1.1   nonaka 	/* data read */
    464       1.1   nonaka 	data[0] = '\0'; /* XXXFIXME!!! */
    465       1.1   nonaka 	for (i = 1 /* XXXFIXME!!!*/ ; i < cmd->c_datalen; i++) {
    466       1.1   nonaka 		data[i] = ssumci_getc();
    467       1.1   nonaka 	}
    468       1.1   nonaka 
    469       1.1   nonaka 	(void) ssumci_getc();
    470       1.1   nonaka 	(void) ssumci_getc();
    471       1.1   nonaka 	ssumci_wait();
    472       1.1   nonaka 
    473       1.1   nonaka #ifdef SSUMCI_DEBUG
    474       1.1   nonaka 	sdmmc_dump_data(NULL, cmd->c_data, cmd->c_datalen);
    475       1.1   nonaka #endif
    476       1.1   nonaka }
    477       1.1   nonaka 
    478       1.1   nonaka static void
    479       1.1   nonaka ssumci_cmd_read(struct ssumci_softc *sc, struct sdmmc_command *cmd)
    480       1.1   nonaka {
    481       1.1   nonaka 	u_char *data = cmd->c_data;
    482       1.1   nonaka 	int timo;
    483       1.1   nonaka 	int c;
    484       1.1   nonaka 	int i;
    485       1.1   nonaka 
    486       1.1   nonaka 	/* wait data token */
    487       1.1   nonaka 	for (timo = MMC_TIME_OVER; timo > 0; timo--) {
    488       1.1   nonaka 		c = ssumci_getc();
    489       1.1   nonaka 		if (c != 0xff)
    490       1.1   nonaka 			break;
    491       1.1   nonaka 	}
    492       1.1   nonaka 	if (timo == 0) {
    493       1.1   nonaka 		aprint_error_dev(sc->sc_dev, "read timeout\n");
    494       1.1   nonaka 		cmd->c_error = ETIMEDOUT;
    495       1.1   nonaka 		return;
    496       1.1   nonaka 	}
    497       1.1   nonaka 	if (c != 0xfe) {
    498       1.1   nonaka 		aprint_error_dev(sc->sc_dev, "read error (data=%#x)\n", c);
    499       1.1   nonaka 		cmd->c_error = EIO;
    500       1.1   nonaka 		return;
    501       1.1   nonaka 	}
    502       1.1   nonaka 
    503       1.1   nonaka 	/* data read */
    504       1.1   nonaka 	for (i = 0; i < cmd->c_datalen; i++) {
    505       1.1   nonaka 		data[i] = ssumci_getc();
    506       1.1   nonaka 	}
    507       1.1   nonaka 
    508       1.1   nonaka 	/* ignore CRC */
    509       1.1   nonaka 	(void) ssumci_getc();
    510       1.1   nonaka 	(void) ssumci_getc();
    511       1.1   nonaka 	ssumci_wait();
    512       1.1   nonaka 
    513       1.1   nonaka #ifdef SSUMCI_DEBUG
    514       1.1   nonaka 	sdmmc_dump_data(NULL, cmd->c_data, cmd->c_datalen);
    515       1.1   nonaka #endif
    516       1.1   nonaka }
    517       1.1   nonaka 
    518       1.1   nonaka static void
    519       1.1   nonaka ssumci_cmd_write(struct ssumci_softc *sc, struct sdmmc_command *cmd)
    520       1.1   nonaka {
    521       1.1   nonaka 	u_char *data = cmd->c_data;
    522       1.1   nonaka 	int timo;
    523       1.1   nonaka 	int c;
    524       1.1   nonaka 	int i;
    525       1.1   nonaka 
    526       1.1   nonaka 	ssumci_wait();
    527       1.1   nonaka 	ssumci_putc(0xfe);
    528       1.1   nonaka 
    529       1.1   nonaka 	/* data write */
    530       1.1   nonaka 	for (i = 0; i < cmd->c_datalen; i++) {
    531       1.1   nonaka 		ssumci_putc(data[i]);
    532       1.1   nonaka 	}
    533       1.1   nonaka 
    534       1.1   nonaka 	/* dummy CRC */
    535       1.1   nonaka 	ssumci_putc(0);
    536       1.1   nonaka 	ssumci_putc(0);
    537       1.1   nonaka 	ssumci_putc(0xff);
    538       1.1   nonaka 	if ((_reg_read_1(SSUMCI_SPIDR) & 0x0f) != 5) {
    539       1.1   nonaka 		aprint_error_dev(sc->sc_dev, "write error\n");
    540       1.1   nonaka 		cmd->c_error = EIO;
    541       1.1   nonaka 		return;
    542       1.1   nonaka 	}
    543       1.1   nonaka 
    544       1.1   nonaka 	for (timo = 0x7fffffff; timo > 0; timo--) {
    545       1.1   nonaka 		ssumci_putc(0xff);
    546       1.1   nonaka 		c = _reg_read_1(SSUMCI_SPIDR);
    547       1.1   nonaka 		if (c == 0xff)
    548       1.1   nonaka 			break;
    549       1.1   nonaka 	}
    550       1.1   nonaka 	if (timo == 0) {
    551       1.1   nonaka 		aprint_error_dev(sc->sc_dev, "write timeout\n");
    552       1.1   nonaka 		cmd->c_error = ETIMEDOUT;
    553       1.1   nonaka 	}
    554       1.1   nonaka }
    555