Home | History | Annotate | Line # | Download | only in t_sh7706lan
ssumci.c revision 1.2.6.1
      1  1.2.6.1     tls /*	$NetBSD: ssumci.c,v 1.2.6.1 2014/08/20 00:02:59 tls 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.2.6.1     tls __KERNEL_RCSID(0, "$NetBSD: ssumci.c,v 1.2.6.1 2014/08/20 00:02:59 tls 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.2.6.1     tls #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.1  nonaka 	sc->sc_sdmmc = config_found(sc->sc_dev, &saa, NULL);
    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