diff options
| -rw-r--r-- | arch/avr32/boards/atngw100/setup.c | 7 | ||||
| -rw-r--r-- | arch/avr32/boards/atstk1000/atstk1002.c | 3 | ||||
| -rw-r--r-- | arch/avr32/mach-at32ap/at32ap700x.c | 30 | ||||
| -rw-r--r-- | drivers/mmc/host/Kconfig | 10 | ||||
| -rw-r--r-- | drivers/mmc/host/Makefile | 1 | ||||
| -rw-r--r-- | drivers/mmc/host/atmel-mci-regs.h | 91 | ||||
| -rw-r--r-- | drivers/mmc/host/atmel-mci.c | 981 | ||||
| -rw-r--r-- | include/asm-avr32/arch-at32ap/board.h | 6 | ||||
| -rw-r--r-- | include/asm-avr32/atmel-mci.h | 9 |
9 files changed, 1132 insertions, 6 deletions
diff --git a/arch/avr32/boards/atngw100/setup.c b/arch/avr32/boards/atngw100/setup.c index a51bb9fb3c89..c7fe94d03a1e 100644 --- a/arch/avr32/boards/atngw100/setup.c +++ b/arch/avr32/boards/atngw100/setup.c | |||
| @@ -19,6 +19,7 @@ | |||
| 19 | #include <linux/leds.h> | 19 | #include <linux/leds.h> |
| 20 | #include <linux/spi/spi.h> | 20 | #include <linux/spi/spi.h> |
| 21 | 21 | ||
| 22 | #include <asm/atmel-mci.h> | ||
| 22 | #include <asm/io.h> | 23 | #include <asm/io.h> |
| 23 | #include <asm/setup.h> | 24 | #include <asm/setup.h> |
| 24 | 25 | ||
| @@ -51,6 +52,11 @@ static struct spi_board_info spi0_board_info[] __initdata = { | |||
| 51 | }, | 52 | }, |
| 52 | }; | 53 | }; |
| 53 | 54 | ||
| 55 | static struct mci_platform_data __initdata mci0_data = { | ||
| 56 | .detect_pin = GPIO_PIN_PC(25), | ||
| 57 | .wp_pin = GPIO_PIN_PE(0), | ||
| 58 | }; | ||
| 59 | |||
| 54 | /* | 60 | /* |
| 55 | * The next two functions should go away as the boot loader is | 61 | * The next two functions should go away as the boot loader is |
| 56 | * supposed to initialize the macb address registers with a valid | 62 | * supposed to initialize the macb address registers with a valid |
| @@ -170,6 +176,7 @@ static int __init atngw100_init(void) | |||
| 170 | set_hw_addr(at32_add_device_eth(1, ð_data[1])); | 176 | set_hw_addr(at32_add_device_eth(1, ð_data[1])); |
| 171 | 177 | ||
| 172 | at32_add_device_spi(0, spi0_board_info, ARRAY_SIZE(spi0_board_info)); | 178 | at32_add_device_spi(0, spi0_board_info, ARRAY_SIZE(spi0_board_info)); |
| 179 | at32_add_device_mci(0, &mci0_data); | ||
| 173 | at32_add_device_usba(0, NULL); | 180 | at32_add_device_usba(0, NULL); |
| 174 | 181 | ||
| 175 | for (i = 0; i < ARRAY_SIZE(ngw_leds); i++) { | 182 | for (i = 0; i < ARRAY_SIZE(ngw_leds); i++) { |
diff --git a/arch/avr32/boards/atstk1000/atstk1002.c b/arch/avr32/boards/atstk1000/atstk1002.c index 86b363c1c25b..e11659b732fa 100644 --- a/arch/avr32/boards/atstk1000/atstk1002.c +++ b/arch/avr32/boards/atstk1000/atstk1002.c | |||
| @@ -234,6 +234,9 @@ static int __init atstk1002_init(void) | |||
| 234 | #ifdef CONFIG_BOARD_ATSTK100X_SPI1 | 234 | #ifdef CONFIG_BOARD_ATSTK100X_SPI1 |
| 235 | at32_add_device_spi(1, spi1_board_info, ARRAY_SIZE(spi1_board_info)); | 235 | at32_add_device_spi(1, spi1_board_info, ARRAY_SIZE(spi1_board_info)); |
| 236 | #endif | 236 | #endif |
| 237 | #ifndef CONFIG_BOARD_ATSTK1002_SW2_CUSTOM | ||
| 238 | at32_add_device_mci(0, NULL); | ||
| 239 | #endif | ||
| 237 | #ifdef CONFIG_BOARD_ATSTK1002_SW5_CUSTOM | 240 | #ifdef CONFIG_BOARD_ATSTK1002_SW5_CUSTOM |
| 238 | set_hw_addr(at32_add_device_eth(1, ð_data[1])); | 241 | set_hw_addr(at32_add_device_eth(1, ð_data[1])); |
| 239 | #else | 242 | #else |
diff --git a/arch/avr32/mach-at32ap/at32ap700x.c b/arch/avr32/mach-at32ap/at32ap700x.c index 07b21b121eef..021d51217184 100644 --- a/arch/avr32/mach-at32ap/at32ap700x.c +++ b/arch/avr32/mach-at32ap/at32ap700x.c | |||
| @@ -14,6 +14,7 @@ | |||
| 14 | #include <linux/spi/spi.h> | 14 | #include <linux/spi/spi.h> |
| 15 | #include <linux/usb/atmel_usba_udc.h> | 15 | #include <linux/usb/atmel_usba_udc.h> |
| 16 | 16 | ||
| 17 | #include <asm/atmel-mci.h> | ||
| 17 | #include <asm/io.h> | 18 | #include <asm/io.h> |
| 18 | #include <asm/irq.h> | 19 | #include <asm/irq.h> |
| 19 | 20 | ||
| @@ -1278,20 +1279,32 @@ static struct clk atmel_mci0_pclk = { | |||
| 1278 | .index = 9, | 1279 | .index = 9, |
| 1279 | }; | 1280 | }; |
| 1280 | 1281 | ||
| 1281 | struct platform_device *__init at32_add_device_mci(unsigned int id) | 1282 | struct platform_device *__init |
| 1283 | at32_add_device_mci(unsigned int id, struct mci_platform_data *data) | ||
| 1282 | { | 1284 | { |
| 1283 | struct platform_device *pdev; | 1285 | struct mci_platform_data _data; |
| 1286 | struct platform_device *pdev; | ||
| 1287 | struct dw_dma_slave *dws; | ||
| 1284 | 1288 | ||
| 1285 | if (id != 0) | 1289 | if (id != 0) |
| 1286 | return NULL; | 1290 | return NULL; |
| 1287 | 1291 | ||
| 1288 | pdev = platform_device_alloc("atmel_mci", id); | 1292 | pdev = platform_device_alloc("atmel_mci", id); |
| 1289 | if (!pdev) | 1293 | if (!pdev) |
| 1290 | return NULL; | 1294 | goto fail; |
| 1291 | 1295 | ||
| 1292 | if (platform_device_add_resources(pdev, atmel_mci0_resource, | 1296 | if (platform_device_add_resources(pdev, atmel_mci0_resource, |
| 1293 | ARRAY_SIZE(atmel_mci0_resource))) | 1297 | ARRAY_SIZE(atmel_mci0_resource))) |
| 1294 | goto err_add_resources; | 1298 | goto fail; |
| 1299 | |||
| 1300 | if (!data) { | ||
| 1301 | data = &_data; | ||
| 1302 | memset(data, 0, sizeof(struct mci_platform_data)); | ||
| 1303 | } | ||
| 1304 | |||
| 1305 | if (platform_device_add_data(pdev, data, | ||
| 1306 | sizeof(struct mci_platform_data))) | ||
| 1307 | goto fail; | ||
| 1295 | 1308 | ||
| 1296 | select_peripheral(PA(10), PERIPH_A, 0); /* CLK */ | 1309 | select_peripheral(PA(10), PERIPH_A, 0); /* CLK */ |
| 1297 | select_peripheral(PA(11), PERIPH_A, 0); /* CMD */ | 1310 | select_peripheral(PA(11), PERIPH_A, 0); /* CMD */ |
| @@ -1300,12 +1313,19 @@ struct platform_device *__init at32_add_device_mci(unsigned int id) | |||
| 1300 | select_peripheral(PA(14), PERIPH_A, 0); /* DATA2 */ | 1313 | select_peripheral(PA(14), PERIPH_A, 0); /* DATA2 */ |
| 1301 | select_peripheral(PA(15), PERIPH_A, 0); /* DATA3 */ | 1314 | select_peripheral(PA(15), PERIPH_A, 0); /* DATA3 */ |
| 1302 | 1315 | ||
| 1316 | if (data) { | ||
| 1317 | if (data->detect_pin != GPIO_PIN_NONE) | ||
| 1318 | at32_select_gpio(data->detect_pin, 0); | ||
| 1319 | if (data->wp_pin != GPIO_PIN_NONE) | ||
| 1320 | at32_select_gpio(data->wp_pin, 0); | ||
| 1321 | } | ||
| 1322 | |||
| 1303 | atmel_mci0_pclk.dev = &pdev->dev; | 1323 | atmel_mci0_pclk.dev = &pdev->dev; |
| 1304 | 1324 | ||
| 1305 | platform_device_add(pdev); | 1325 | platform_device_add(pdev); |
| 1306 | return pdev; | 1326 | return pdev; |
| 1307 | 1327 | ||
| 1308 | err_add_resources: | 1328 | fail: |
| 1309 | platform_device_put(pdev); | 1329 | platform_device_put(pdev); |
| 1310 | return NULL; | 1330 | return NULL; |
| 1311 | } | 1331 | } |
diff --git a/drivers/mmc/host/Kconfig b/drivers/mmc/host/Kconfig index dc88c03662ab..198df4234354 100644 --- a/drivers/mmc/host/Kconfig +++ b/drivers/mmc/host/Kconfig | |||
| @@ -104,6 +104,16 @@ config MMC_AT91 | |||
| 104 | 104 | ||
| 105 | If unsure, say N. | 105 | If unsure, say N. |
| 106 | 106 | ||
| 107 | config MMC_ATMELMCI | ||
| 108 | tristate "Atmel Multimedia Card Interface support" | ||
| 109 | depends on AVR32 | ||
| 110 | help | ||
| 111 | This selects the Atmel Multimedia Card Interface driver. If | ||
| 112 | you have an AT32 (AVR32) platform with a Multimedia Card | ||
| 113 | slot, say Y or M here. | ||
| 114 | |||
| 115 | If unsure, say N. | ||
| 116 | |||
| 107 | config MMC_IMX | 117 | config MMC_IMX |
| 108 | tristate "Motorola i.MX Multimedia Card Interface support" | 118 | tristate "Motorola i.MX Multimedia Card Interface support" |
| 109 | depends on ARCH_IMX | 119 | depends on ARCH_IMX |
diff --git a/drivers/mmc/host/Makefile b/drivers/mmc/host/Makefile index b3e023bf8c78..2dc9ff23cfb7 100644 --- a/drivers/mmc/host/Makefile +++ b/drivers/mmc/host/Makefile | |||
| @@ -16,6 +16,7 @@ obj-$(CONFIG_MMC_WBSD) += wbsd.o | |||
| 16 | obj-$(CONFIG_MMC_AU1X) += au1xmmc.o | 16 | obj-$(CONFIG_MMC_AU1X) += au1xmmc.o |
| 17 | obj-$(CONFIG_MMC_OMAP) += omap.o | 17 | obj-$(CONFIG_MMC_OMAP) += omap.o |
| 18 | obj-$(CONFIG_MMC_AT91) += at91_mci.o | 18 | obj-$(CONFIG_MMC_AT91) += at91_mci.o |
| 19 | obj-$(CONFIG_MMC_ATMELMCI) += atmel-mci.o | ||
| 19 | obj-$(CONFIG_MMC_TIFM_SD) += tifm_sd.o | 20 | obj-$(CONFIG_MMC_TIFM_SD) += tifm_sd.o |
| 20 | obj-$(CONFIG_MMC_SPI) += mmc_spi.o | 21 | obj-$(CONFIG_MMC_SPI) += mmc_spi.o |
| 21 | obj-$(CONFIG_MMC_S3C) += s3cmci.o | 22 | obj-$(CONFIG_MMC_S3C) += s3cmci.o |
diff --git a/drivers/mmc/host/atmel-mci-regs.h b/drivers/mmc/host/atmel-mci-regs.h new file mode 100644 index 000000000000..a9a5657706c6 --- /dev/null +++ b/drivers/mmc/host/atmel-mci-regs.h | |||
| @@ -0,0 +1,91 @@ | |||
| 1 | /* | ||
| 2 | * Atmel MultiMedia Card Interface driver | ||
| 3 | * | ||
| 4 | * Copyright (C) 2004-2006 Atmel Corporation | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or modify | ||
| 7 | * it under the terms of the GNU General Public License version 2 as | ||
| 8 | * published by the Free Software Foundation. | ||
| 9 | */ | ||
| 10 | #ifndef __DRIVERS_MMC_ATMEL_MCI_H__ | ||
| 11 | #define __DRIVERS_MMC_ATMEL_MCI_H__ | ||
| 12 | |||
| 13 | /* MCI Register Definitions */ | ||
| 14 | #define MCI_CR 0x0000 /* Control */ | ||
| 15 | # define MCI_CR_MCIEN ( 1 << 0) /* MCI Enable */ | ||
| 16 | # define MCI_CR_MCIDIS ( 1 << 1) /* MCI Disable */ | ||
| 17 | # define MCI_CR_SWRST ( 1 << 7) /* Software Reset */ | ||
| 18 | #define MCI_MR 0x0004 /* Mode */ | ||
| 19 | # define MCI_MR_CLKDIV(x) ((x) << 0) /* Clock Divider */ | ||
| 20 | # define MCI_MR_RDPROOF ( 1 << 11) /* Read Proof */ | ||
| 21 | # define MCI_MR_WRPROOF ( 1 << 12) /* Write Proof */ | ||
| 22 | #define MCI_DTOR 0x0008 /* Data Timeout */ | ||
| 23 | # define MCI_DTOCYC(x) ((x) << 0) /* Data Timeout Cycles */ | ||
| 24 | # define MCI_DTOMUL(x) ((x) << 4) /* Data Timeout Multiplier */ | ||
| 25 | #define MCI_SDCR 0x000c /* SD Card / SDIO */ | ||
| 26 | # define MCI_SDCSEL_SLOT_A ( 0 << 0) /* Select SD slot A */ | ||
| 27 | # define MCI_SDCSEL_SLOT_B ( 1 << 0) /* Select SD slot A */ | ||
| 28 | # define MCI_SDCBUS_1BIT ( 0 << 7) /* 1-bit data bus */ | ||
| 29 | # define MCI_SDCBUS_4BIT ( 1 << 7) /* 4-bit data bus */ | ||
| 30 | #define MCI_ARGR 0x0010 /* Command Argument */ | ||
| 31 | #define MCI_CMDR 0x0014 /* Command */ | ||
| 32 | # define MCI_CMDR_CMDNB(x) ((x) << 0) /* Command Opcode */ | ||
| 33 | # define MCI_CMDR_RSPTYP_NONE ( 0 << 6) /* No response */ | ||
| 34 | # define MCI_CMDR_RSPTYP_48BIT ( 1 << 6) /* 48-bit response */ | ||
| 35 | # define MCI_CMDR_RSPTYP_136BIT ( 2 << 6) /* 136-bit response */ | ||
| 36 | # define MCI_CMDR_SPCMD_INIT ( 1 << 8) /* Initialization command */ | ||
| 37 | # define MCI_CMDR_SPCMD_SYNC ( 2 << 8) /* Synchronized command */ | ||
| 38 | # define MCI_CMDR_SPCMD_INT ( 4 << 8) /* Interrupt command */ | ||
| 39 | # define MCI_CMDR_SPCMD_INTRESP ( 5 << 8) /* Interrupt response */ | ||
| 40 | # define MCI_CMDR_OPDCMD ( 1 << 11) /* Open Drain */ | ||
| 41 | # define MCI_CMDR_MAXLAT_5CYC ( 0 << 12) /* Max latency 5 cycles */ | ||
| 42 | # define MCI_CMDR_MAXLAT_64CYC ( 1 << 12) /* Max latency 64 cycles */ | ||
| 43 | # define MCI_CMDR_START_XFER ( 1 << 16) /* Start data transfer */ | ||
| 44 | # define MCI_CMDR_STOP_XFER ( 2 << 16) /* Stop data transfer */ | ||
| 45 | # define MCI_CMDR_TRDIR_WRITE ( 0 << 18) /* Write data */ | ||
| 46 | # define MCI_CMDR_TRDIR_READ ( 1 << 18) /* Read data */ | ||
| 47 | # define MCI_CMDR_BLOCK ( 0 << 19) /* Single-block transfer */ | ||
| 48 | # define MCI_CMDR_MULTI_BLOCK ( 1 << 19) /* Multi-block transfer */ | ||
| 49 | # define MCI_CMDR_STREAM ( 2 << 19) /* MMC Stream transfer */ | ||
| 50 | # define MCI_CMDR_SDIO_BYTE ( 4 << 19) /* SDIO Byte transfer */ | ||
| 51 | # define MCI_CMDR_SDIO_BLOCK ( 5 << 19) /* SDIO Block transfer */ | ||
| 52 | # define MCI_CMDR_SDIO_SUSPEND ( 1 << 24) /* SDIO Suspend Command */ | ||
| 53 | # define MCI_CMDR_SDIO_RESUME ( 2 << 24) /* SDIO Resume Command */ | ||
| 54 | #define MCI_BLKR 0x0018 /* Block */ | ||
| 55 | # define MCI_BCNT(x) ((x) << 0) /* Data Block Count */ | ||
| 56 | # define MCI_BLKLEN(x) ((x) << 16) /* Data Block Length */ | ||
| 57 | #define MCI_RSPR 0x0020 /* Response 0 */ | ||
| 58 | #define MCI_RSPR1 0x0024 /* Response 1 */ | ||
| 59 | #define MCI_RSPR2 0x0028 /* Response 2 */ | ||
| 60 | #define MCI_RSPR3 0x002c /* Response 3 */ | ||
| 61 | #define MCI_RDR 0x0030 /* Receive Data */ | ||
| 62 | #define MCI_TDR 0x0034 /* Transmit Data */ | ||
| 63 | #define MCI_SR 0x0040 /* Status */ | ||
| 64 | #define MCI_IER 0x0044 /* Interrupt Enable */ | ||
| 65 | #define MCI_IDR 0x0048 /* Interrupt Disable */ | ||
| 66 | #define MCI_IMR 0x004c /* Interrupt Mask */ | ||
| 67 | # define MCI_CMDRDY ( 1 << 0) /* Command Ready */ | ||
| 68 | # define MCI_RXRDY ( 1 << 1) /* Receiver Ready */ | ||
| 69 | # define MCI_TXRDY ( 1 << 2) /* Transmitter Ready */ | ||
| 70 | # define MCI_BLKE ( 1 << 3) /* Data Block Ended */ | ||
| 71 | # define MCI_DTIP ( 1 << 4) /* Data Transfer In Progress */ | ||
| 72 | # define MCI_NOTBUSY ( 1 << 5) /* Data Not Busy */ | ||
| 73 | # define MCI_SDIOIRQA ( 1 << 8) /* SDIO IRQ in slot A */ | ||
| 74 | # define MCI_SDIOIRQB ( 1 << 9) /* SDIO IRQ in slot B */ | ||
| 75 | # define MCI_RINDE ( 1 << 16) /* Response Index Error */ | ||
| 76 | # define MCI_RDIRE ( 1 << 17) /* Response Direction Error */ | ||
| 77 | # define MCI_RCRCE ( 1 << 18) /* Response CRC Error */ | ||
| 78 | # define MCI_RENDE ( 1 << 19) /* Response End Bit Error */ | ||
| 79 | # define MCI_RTOE ( 1 << 20) /* Response Time-Out Error */ | ||
| 80 | # define MCI_DCRCE ( 1 << 21) /* Data CRC Error */ | ||
| 81 | # define MCI_DTOE ( 1 << 22) /* Data Time-Out Error */ | ||
| 82 | # define MCI_OVRE ( 1 << 30) /* RX Overrun Error */ | ||
| 83 | # define MCI_UNRE ( 1 << 31) /* TX Underrun Error */ | ||
| 84 | |||
| 85 | /* Register access macros */ | ||
| 86 | #define mci_readl(port,reg) \ | ||
| 87 | __raw_readl((port)->regs + MCI_##reg) | ||
| 88 | #define mci_writel(port,reg,value) \ | ||
| 89 | __raw_writel((value), (port)->regs + MCI_##reg) | ||
| 90 | |||
| 91 | #endif /* __DRIVERS_MMC_ATMEL_MCI_H__ */ | ||
diff --git a/drivers/mmc/host/atmel-mci.c b/drivers/mmc/host/atmel-mci.c new file mode 100644 index 000000000000..25d5324ab7e2 --- /dev/null +++ b/drivers/mmc/host/atmel-mci.c | |||
| @@ -0,0 +1,981 @@ | |||
| 1 | /* | ||
| 2 | * Atmel MultiMedia Card Interface driver | ||
| 3 | * | ||
| 4 | * Copyright (C) 2004-2008 Atmel Corporation | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or modify | ||
| 7 | * it under the terms of the GNU General Public License version 2 as | ||
| 8 | * published by the Free Software Foundation. | ||
| 9 | */ | ||
| 10 | #include <linux/blkdev.h> | ||
| 11 | #include <linux/clk.h> | ||
| 12 | #include <linux/device.h> | ||
| 13 | #include <linux/init.h> | ||
| 14 | #include <linux/interrupt.h> | ||
| 15 | #include <linux/ioport.h> | ||
| 16 | #include <linux/module.h> | ||
| 17 | #include <linux/platform_device.h> | ||
| 18 | #include <linux/scatterlist.h> | ||
| 19 | |||
| 20 | #include <linux/mmc/host.h> | ||
| 21 | |||
| 22 | #include <asm/atmel-mci.h> | ||
| 23 | #include <asm/io.h> | ||
| 24 | #include <asm/unaligned.h> | ||
| 25 | |||
| 26 | #include <asm/arch/board.h> | ||
| 27 | #include <asm/arch/gpio.h> | ||
| 28 | |||
| 29 | #include "atmel-mci-regs.h" | ||
| 30 | |||
| 31 | #define ATMCI_DATA_ERROR_FLAGS (MCI_DCRCE | MCI_DTOE | MCI_OVRE | MCI_UNRE) | ||
| 32 | |||
| 33 | enum { | ||
| 34 | EVENT_CMD_COMPLETE = 0, | ||
| 35 | EVENT_DATA_ERROR, | ||
| 36 | EVENT_DATA_COMPLETE, | ||
| 37 | EVENT_STOP_SENT, | ||
| 38 | EVENT_STOP_COMPLETE, | ||
| 39 | EVENT_XFER_COMPLETE, | ||
| 40 | }; | ||
| 41 | |||
| 42 | struct atmel_mci { | ||
| 43 | struct mmc_host *mmc; | ||
| 44 | void __iomem *regs; | ||
| 45 | |||
| 46 | struct scatterlist *sg; | ||
| 47 | unsigned int pio_offset; | ||
| 48 | |||
| 49 | struct mmc_request *mrq; | ||
| 50 | struct mmc_command *cmd; | ||
| 51 | struct mmc_data *data; | ||
| 52 | |||
| 53 | u32 cmd_status; | ||
| 54 | u32 data_status; | ||
| 55 | u32 stop_status; | ||
| 56 | u32 stop_cmdr; | ||
| 57 | |||
| 58 | u32 mode_reg; | ||
| 59 | u32 sdc_reg; | ||
| 60 | |||
| 61 | struct tasklet_struct tasklet; | ||
| 62 | unsigned long pending_events; | ||
| 63 | unsigned long completed_events; | ||
| 64 | |||
| 65 | int present; | ||
| 66 | int detect_pin; | ||
| 67 | int wp_pin; | ||
| 68 | |||
| 69 | /* For detect pin debouncing */ | ||
| 70 | struct timer_list detect_timer; | ||
| 71 | |||
| 72 | unsigned long bus_hz; | ||
| 73 | unsigned long mapbase; | ||
| 74 | struct clk *mck; | ||
| 75 | struct platform_device *pdev; | ||
| 76 | }; | ||
| 77 | |||
| 78 | #define atmci_is_completed(host, event) \ | ||
| 79 | test_bit(event, &host->completed_events) | ||
| 80 | #define atmci_test_and_clear_pending(host, event) \ | ||
| 81 | test_and_clear_bit(event, &host->pending_events) | ||
| 82 | #define atmci_test_and_set_completed(host, event) \ | ||
| 83 | test_and_set_bit(event, &host->completed_events) | ||
| 84 | #define atmci_set_completed(host, event) \ | ||
| 85 | set_bit(event, &host->completed_events) | ||
| 86 | #define atmci_set_pending(host, event) \ | ||
| 87 | set_bit(event, &host->pending_events) | ||
| 88 | #define atmci_clear_pending(host, event) \ | ||
| 89 | clear_bit(event, &host->pending_events) | ||
| 90 | |||
| 91 | |||
| 92 | static void atmci_enable(struct atmel_mci *host) | ||
| 93 | { | ||
| 94 | clk_enable(host->mck); | ||
| 95 | mci_writel(host, CR, MCI_CR_MCIEN); | ||
| 96 | mci_writel(host, MR, host->mode_reg); | ||
| 97 | mci_writel(host, SDCR, host->sdc_reg); | ||
| 98 | } | ||
| 99 | |||
| 100 | static void atmci_disable(struct atmel_mci *host) | ||
| 101 | { | ||
| 102 | mci_writel(host, CR, MCI_CR_SWRST); | ||
| 103 | |||
| 104 | /* Stall until write is complete, then disable the bus clock */ | ||
| 105 | mci_readl(host, SR); | ||
| 106 | clk_disable(host->mck); | ||
| 107 | } | ||
| 108 | |||
| 109 | static inline unsigned int ns_to_clocks(struct atmel_mci *host, | ||
| 110 | unsigned int ns) | ||
| 111 | { | ||
| 112 | return (ns * (host->bus_hz / 1000000) + 999) / 1000; | ||
| 113 | } | ||
| 114 | |||
| 115 | static void atmci_set_timeout(struct atmel_mci *host, | ||
| 116 | struct mmc_data *data) | ||
| 117 | { | ||
| 118 | static unsigned dtomul_to_shift[] = { | ||
| 119 | 0, 4, 7, 8, 10, 12, 16, 20 | ||
| 120 | }; | ||
| 121 | unsigned timeout; | ||
| 122 | unsigned dtocyc; | ||
| 123 | unsigned dtomul; | ||
| 124 | |||
| 125 | timeout = ns_to_clocks(host, data->timeout_ns) + data->timeout_clks; | ||
| 126 | |||
| 127 | for (dtomul = 0; dtomul < 8; dtomul++) { | ||
| 128 | unsigned shift = dtomul_to_shift[dtomul]; | ||
| 129 | dtocyc = (timeout + (1 << shift) - 1) >> shift; | ||
| 130 | if (dtocyc < 15) | ||
| 131 | break; | ||
| 132 | } | ||
| 133 | |||
| 134 | if (dtomul >= 8) { | ||
| 135 | dtomul = 7; | ||
| 136 | dtocyc = 15; | ||
| 137 | } | ||
| 138 | |||
| 139 | dev_vdbg(&host->mmc->class_dev, "setting timeout to %u cycles\n", | ||
| 140 | dtocyc << dtomul_to_shift[dtomul]); | ||
| 141 | mci_writel(host, DTOR, (MCI_DTOMUL(dtomul) | MCI_DTOCYC(dtocyc))); | ||
| 142 | } | ||
| 143 | |||
| 144 | /* | ||
| 145 | * Return mask with command flags to be enabled for this command. | ||
| 146 | */ | ||
| 147 | static u32 atmci_prepare_command(struct mmc_host *mmc, | ||
| 148 | struct mmc_command *cmd) | ||
| 149 | { | ||
| 150 | struct mmc_data *data; | ||
| 151 | u32 cmdr; | ||
| 152 | |||
| 153 | cmd->error = -EINPROGRESS; | ||
| 154 | |||
| 155 | cmdr = MCI_CMDR_CMDNB(cmd->opcode); | ||
| 156 | |||
| 157 | if (cmd->flags & MMC_RSP_PRESENT) { | ||
| 158 | if (cmd->flags & MMC_RSP_136) | ||
| 159 | cmdr |= MCI_CMDR_RSPTYP_136BIT; | ||
| 160 | else | ||
| 161 | cmdr |= MCI_CMDR_RSPTYP_48BIT; | ||
| 162 | } | ||
| 163 | |||
| 164 | /* | ||
| 165 | * This should really be MAXLAT_5 for CMD2 and ACMD41, but | ||
| 166 | * it's too difficult to determine whether this is an ACMD or | ||
| 167 | * not. Better make it 64. | ||
| 168 | */ | ||
| 169 | cmdr |= MCI_CMDR_MAXLAT_64CYC; | ||
| 170 | |||
| 171 | if (mmc->ios.bus_mode == MMC_BUSMODE_OPENDRAIN) | ||
| 172 | cmdr |= MCI_CMDR_OPDCMD; | ||
| 173 | |||
| 174 | data = cmd->data; | ||
| 175 | if (data) { | ||
| 176 | cmdr |= MCI_CMDR_START_XFER; | ||
| 177 | if (data->flags & MMC_DATA_STREAM) | ||
| 178 | cmdr |= MCI_CMDR_STREAM; | ||
| 179 | else if (data->blocks > 1) | ||
| 180 | cmdr |= MCI_CMDR_MULTI_BLOCK; | ||
| 181 | else | ||
| 182 | cmdr |= MCI_CMDR_BLOCK; | ||
| 183 | |||
| 184 | if (data->flags & MMC_DATA_READ) | ||
| 185 | cmdr |= MCI_CMDR_TRDIR_READ; | ||
| 186 | } | ||
| 187 | |||
| 188 | return cmdr; | ||
| 189 | } | ||
| 190 | |||
| 191 | static void atmci_start_command(struct atmel_mci *host, | ||
| 192 | struct mmc_command *cmd, | ||
| 193 | u32 cmd_flags) | ||
| 194 | { | ||
| 195 | /* Must read host->cmd after testing event flags */ | ||
| 196 | smp_rmb(); | ||
| 197 | WARN_ON(host->cmd); | ||
| 198 | host->cmd = cmd; | ||
| 199 | |||
| 200 | dev_vdbg(&host->mmc->class_dev, | ||
| 201 | "start command: ARGR=0x%08x CMDR=0x%08x\n", | ||
| 202 | cmd->arg, cmd_flags); | ||
| 203 | |||
| 204 | mci_writel(host, ARGR, cmd->arg); | ||
| 205 | mci_writel(host, CMDR, cmd_flags); | ||
| 206 | } | ||
| 207 | |||
| 208 | static void send_stop_cmd(struct mmc_host *mmc, struct mmc_data *data) | ||
| 209 | { | ||
| 210 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 211 | |||
| 212 | atmci_start_command(host, data->stop, host->stop_cmdr); | ||
| 213 | mci_writel(host, IER, MCI_CMDRDY); | ||
| 214 | } | ||
| 215 | |||
| 216 | static void atmci_request_end(struct mmc_host *mmc, struct mmc_request *mrq) | ||
| 217 | { | ||
| 218 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 219 | |||
| 220 | WARN_ON(host->cmd || host->data); | ||
| 221 | host->mrq = NULL; | ||
| 222 | |||
| 223 | atmci_disable(host); | ||
| 224 | |||
| 225 | mmc_request_done(mmc, mrq); | ||
| 226 | } | ||
| 227 | |||
| 228 | /* | ||
| 229 | * Returns a mask of interrupt flags to be enabled after the whole | ||
| 230 | * request has been prepared. | ||
| 231 | */ | ||
| 232 | static u32 atmci_submit_data(struct mmc_host *mmc, struct mmc_data *data) | ||
| 233 | { | ||
| 234 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 235 | u32 iflags; | ||
| 236 | |||
| 237 | data->error = -EINPROGRESS; | ||
| 238 | |||
| 239 | WARN_ON(host->data); | ||
| 240 | host->sg = NULL; | ||
| 241 | host->data = data; | ||
| 242 | |||
| 243 | mci_writel(host, BLKR, MCI_BCNT(data->blocks) | ||
| 244 | | MCI_BLKLEN(data->blksz)); | ||
| 245 | dev_vdbg(&mmc->class_dev, "BLKR=0x%08x\n", | ||
| 246 | MCI_BCNT(data->blocks) | MCI_BLKLEN(data->blksz)); | ||
| 247 | |||
| 248 | iflags = ATMCI_DATA_ERROR_FLAGS; | ||
| 249 | host->sg = data->sg; | ||
| 250 | host->pio_offset = 0; | ||
| 251 | if (data->flags & MMC_DATA_READ) | ||
| 252 | iflags |= MCI_RXRDY; | ||
| 253 | else | ||
| 254 | iflags |= MCI_TXRDY; | ||
| 255 | |||
| 256 | return iflags; | ||
| 257 | } | ||
| 258 | |||
| 259 | static void atmci_request(struct mmc_host *mmc, struct mmc_request *mrq) | ||
| 260 | { | ||
| 261 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 262 | struct mmc_data *data; | ||
| 263 | struct mmc_command *cmd; | ||
| 264 | u32 iflags; | ||
| 265 | u32 cmdflags = 0; | ||
| 266 | |||
| 267 | iflags = mci_readl(host, IMR); | ||
| 268 | if (iflags) | ||
| 269 | dev_warn(&mmc->class_dev, "WARNING: IMR=0x%08x\n", | ||
| 270 | mci_readl(host, IMR)); | ||
| 271 | |||
| 272 | WARN_ON(host->mrq != NULL); | ||
| 273 | |||
| 274 | /* | ||
| 275 | * We may "know" the card is gone even though there's still an | ||
| 276 | * electrical connection. If so, we really need to communicate | ||
| 277 | * this to the MMC core since there won't be any more | ||
| 278 | * interrupts as the card is completely removed. Otherwise, | ||
| 279 | * the MMC core might believe the card is still there even | ||
| 280 | * though the card was just removed very slowly. | ||
| 281 | */ | ||
| 282 | if (!host->present) { | ||
| 283 | mrq->cmd->error = -ENOMEDIUM; | ||
| 284 | mmc_request_done(mmc, mrq); | ||
| 285 | return; | ||
| 286 | } | ||
| 287 | |||
| 288 | host->mrq = mrq; | ||
| 289 | host->pending_events = 0; | ||
| 290 | host->completed_events = 0; | ||
| 291 | |||
| 292 | atmci_enable(host); | ||
| 293 | |||
| 294 | /* We don't support multiple blocks of weird lengths. */ | ||
| 295 | data = mrq->data; | ||
| 296 | if (data) { | ||
| 297 | if (data->blocks > 1 && data->blksz & 3) | ||
| 298 | goto fail; | ||
| 299 | atmci_set_timeout(host, data); | ||
| 300 | } | ||
| 301 | |||
| 302 | iflags = MCI_CMDRDY; | ||
| 303 | cmd = mrq->cmd; | ||
| 304 | cmdflags = atmci_prepare_command(mmc, cmd); | ||
| 305 | atmci_start_command(host, cmd, cmdflags); | ||
| 306 | |||
| 307 | if (data) | ||
| 308 | iflags |= atmci_submit_data(mmc, data); | ||
| 309 | |||
| 310 | if (mrq->stop) { | ||
| 311 | host->stop_cmdr = atmci_prepare_command(mmc, mrq->stop); | ||
| 312 | host->stop_cmdr |= MCI_CMDR_STOP_XFER; | ||
| 313 | if (!(data->flags & MMC_DATA_WRITE)) | ||
| 314 | host->stop_cmdr |= MCI_CMDR_TRDIR_READ; | ||
| 315 | if (data->flags & MMC_DATA_STREAM) | ||
| 316 | host->stop_cmdr |= MCI_CMDR_STREAM; | ||
| 317 | else | ||
| 318 | host->stop_cmdr |= MCI_CMDR_MULTI_BLOCK; | ||
| 319 | } | ||
| 320 | |||
| 321 | /* | ||
| 322 | * We could have enabled interrupts earlier, but I suspect | ||
| 323 | * that would open up a nice can of interesting race | ||
| 324 | * conditions (e.g. command and data complete, but stop not | ||
| 325 | * prepared yet.) | ||
| 326 | */ | ||
| 327 | mci_writel(host, IER, iflags); | ||
| 328 | |||
| 329 | return; | ||
| 330 | |||
| 331 | fail: | ||
| 332 | atmci_disable(host); | ||
| 333 | host->mrq = NULL; | ||
| 334 | mrq->cmd->error = -EINVAL; | ||
| 335 | mmc_request_done(mmc, mrq); | ||
| 336 | } | ||
| 337 | |||
| 338 | static void atmci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) | ||
| 339 | { | ||
| 340 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 341 | |||
| 342 | if (ios->clock) { | ||
| 343 | u32 clkdiv; | ||
| 344 | |||
| 345 | /* Set clock rate */ | ||
| 346 | clkdiv = DIV_ROUND_UP(host->bus_hz, 2 * ios->clock) - 1; | ||
| 347 | if (clkdiv > 255) { | ||
| 348 | dev_warn(&mmc->class_dev, | ||
| 349 | "clock %u too slow; using %lu\n", | ||
| 350 | ios->clock, host->bus_hz / (2 * 256)); | ||
| 351 | clkdiv = 255; | ||
| 352 | } | ||
| 353 | |||
| 354 | host->mode_reg = MCI_MR_CLKDIV(clkdiv) | MCI_MR_WRPROOF | ||
| 355 | | MCI_MR_RDPROOF; | ||
| 356 | } | ||
| 357 | |||
| 358 | switch (ios->bus_width) { | ||
| 359 | case MMC_BUS_WIDTH_1: | ||
| 360 | host->sdc_reg = 0; | ||
| 361 | break; | ||
| 362 | case MMC_BUS_WIDTH_4: | ||
| 363 | host->sdc_reg = MCI_SDCBUS_4BIT; | ||
| 364 | break; | ||
| 365 | } | ||
| 366 | |||
| 367 | switch (ios->power_mode) { | ||
| 368 | case MMC_POWER_ON: | ||
| 369 | /* Send init sequence (74 clock cycles) */ | ||
| 370 | atmci_enable(host); | ||
| 371 | mci_writel(host, CMDR, MCI_CMDR_SPCMD_INIT); | ||
| 372 | while (!(mci_readl(host, SR) & MCI_CMDRDY)) | ||
| 373 | cpu_relax(); | ||
| 374 | atmci_disable(host); | ||
| 375 | break; | ||
| 376 | default: | ||
| 377 | /* | ||
| 378 | * TODO: None of the currently available AVR32-based | ||
| 379 | * boards allow MMC power to be turned off. Implement | ||
| 380 | * power control when this can be tested properly. | ||
| 381 | */ | ||
| 382 | break; | ||
| 383 | } | ||
| 384 | } | ||
| 385 | |||
| 386 | static int atmci_get_ro(struct mmc_host *mmc) | ||
| 387 | { | ||
| 388 | int read_only = 0; | ||
| 389 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 390 | |||
| 391 | if (host->wp_pin >= 0) { | ||
| 392 | read_only = gpio_get_value(host->wp_pin); | ||
| 393 | dev_dbg(&mmc->class_dev, "card is %s\n", | ||
| 394 | read_only ? "read-only" : "read-write"); | ||
| 395 | } else { | ||
| 396 | dev_dbg(&mmc->class_dev, | ||
| 397 | "no pin for checking read-only switch." | ||
| 398 | " Assuming write-enable.\n"); | ||
| 399 | } | ||
| 400 | |||
| 401 | return read_only; | ||
| 402 | } | ||
| 403 | |||
| 404 | static struct mmc_host_ops atmci_ops = { | ||
| 405 | .request = atmci_request, | ||
| 406 | .set_ios = atmci_set_ios, | ||
| 407 | .get_ro = atmci_get_ro, | ||
| 408 | }; | ||
| 409 | |||
| 410 | static void atmci_command_complete(struct atmel_mci *host, | ||
| 411 | struct mmc_command *cmd, u32 status) | ||
| 412 | { | ||
| 413 | /* Read the response from the card (up to 16 bytes) */ | ||
| 414 | cmd->resp[0] = mci_readl(host, RSPR); | ||
| 415 | cmd->resp[1] = mci_readl(host, RSPR); | ||
| 416 | cmd->resp[2] = mci_readl(host, RSPR); | ||
| 417 | cmd->resp[3] = mci_readl(host, RSPR); | ||
| 418 | |||
| 419 | if (status & MCI_RTOE) | ||
| 420 | cmd->error = -ETIMEDOUT; | ||
| 421 | else if ((cmd->flags & MMC_RSP_CRC) && (status & MCI_RCRCE)) | ||
| 422 | cmd->error = -EILSEQ; | ||
| 423 | else if (status & (MCI_RINDE | MCI_RDIRE | MCI_RENDE)) | ||
| 424 | cmd->error = -EIO; | ||
| 425 | else | ||
| 426 | cmd->error = 0; | ||
| 427 | |||
| 428 | if (cmd->error) { | ||
| 429 | dev_dbg(&host->mmc->class_dev, | ||
| 430 | "command error: status=0x%08x\n", status); | ||
| 431 | |||
| 432 | if (cmd->data) { | ||
| 433 | host->data = NULL; | ||
| 434 | mci_writel(host, IDR, MCI_NOTBUSY | ||
| 435 | | MCI_TXRDY | MCI_RXRDY | ||
| 436 | | ATMCI_DATA_ERROR_FLAGS); | ||
| 437 | } | ||
| 438 | } | ||
| 439 | } | ||
| 440 | |||
| 441 | static void atmci_detect_change(unsigned long data) | ||
| 442 | { | ||
| 443 | struct atmel_mci *host = (struct atmel_mci *)data; | ||
| 444 | struct mmc_request *mrq = host->mrq; | ||
| 445 | int present; | ||
| 446 | |||
| 447 | /* | ||
| 448 | * atmci_remove() sets detect_pin to -1 before freeing the | ||
| 449 | * interrupt. We must not re-enable the interrupt if it has | ||
| 450 | * been freed. | ||
| 451 | */ | ||
| 452 | smp_rmb(); | ||
| 453 | if (host->detect_pin < 0) | ||
| 454 | return; | ||
| 455 | |||
| 456 | enable_irq(gpio_to_irq(host->detect_pin)); | ||
| 457 | present = !gpio_get_value(host->detect_pin); | ||
| 458 | |||
| 459 | dev_vdbg(&host->pdev->dev, "detect change: %d (was %d)\n", | ||
| 460 | present, host->present); | ||
| 461 | |||
| 462 | if (present != host->present) { | ||
| 463 | dev_dbg(&host->mmc->class_dev, "card %s\n", | ||
| 464 | present ? "inserted" : "removed"); | ||
| 465 | host->present = present; | ||
| 466 | |||
| 467 | /* Reset controller if card is gone */ | ||
| 468 | if (!present) { | ||
| 469 | mci_writel(host, CR, MCI_CR_SWRST); | ||
| 470 | mci_writel(host, IDR, ~0UL); | ||
| 471 | mci_writel(host, CR, MCI_CR_MCIEN); | ||
| 472 | } | ||
| 473 | |||
| 474 | /* Clean up queue if present */ | ||
| 475 | if (mrq) { | ||
| 476 | /* | ||
| 477 | * Reset controller to terminate any ongoing | ||
| 478 | * commands or data transfers. | ||
| 479 | */ | ||
| 480 | mci_writel(host, CR, MCI_CR_SWRST); | ||
| 481 | |||
| 482 | if (!atmci_is_completed(host, EVENT_CMD_COMPLETE)) | ||
| 483 | mrq->cmd->error = -ENOMEDIUM; | ||
| 484 | |||
| 485 | if (mrq->data && !atmci_is_completed(host, | ||
| 486 | EVENT_DATA_COMPLETE)) { | ||
| 487 | host->data = NULL; | ||
| 488 | mrq->data->error = -ENOMEDIUM; | ||
| 489 | } | ||
| 490 | if (mrq->stop && !atmci_is_completed(host, | ||
| 491 | EVENT_STOP_COMPLETE)) | ||
| 492 | mrq->stop->error = -ENOMEDIUM; | ||
| 493 | |||
| 494 | host->cmd = NULL; | ||
| 495 | atmci_request_end(host->mmc, mrq); | ||
| 496 | } | ||
| 497 | |||
| 498 | mmc_detect_change(host->mmc, 0); | ||
| 499 | } | ||
| 500 | } | ||
| 501 | |||
| 502 | static void atmci_tasklet_func(unsigned long priv) | ||
| 503 | { | ||
| 504 | struct mmc_host *mmc = (struct mmc_host *)priv; | ||
| 505 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 506 | struct mmc_request *mrq = host->mrq; | ||
| 507 | struct mmc_data *data = host->data; | ||
| 508 | |||
| 509 | dev_vdbg(&mmc->class_dev, | ||
| 510 | "tasklet: pending/completed/mask %lx/%lx/%x\n", | ||
| 511 | host->pending_events, host->completed_events, | ||
| 512 | mci_readl(host, IMR)); | ||
| 513 | |||
| 514 | if (atmci_test_and_clear_pending(host, EVENT_CMD_COMPLETE)) { | ||
| 515 | /* | ||
| 516 | * host->cmd must be set to NULL before the interrupt | ||
| 517 | * handler sees EVENT_CMD_COMPLETE | ||
| 518 | */ | ||
| 519 | host->cmd = NULL; | ||
| 520 | smp_wmb(); | ||
| 521 | atmci_set_completed(host, EVENT_CMD_COMPLETE); | ||
| 522 | atmci_command_complete(host, mrq->cmd, host->cmd_status); | ||
| 523 | |||
| 524 | if (!mrq->cmd->error && mrq->stop | ||
| 525 | && atmci_is_completed(host, EVENT_XFER_COMPLETE) | ||
| 526 | && !atmci_test_and_set_completed(host, | ||
| 527 | EVENT_STOP_SENT)) | ||
| 528 | send_stop_cmd(host->mmc, mrq->data); | ||
| 529 | } | ||
| 530 | if (atmci_test_and_clear_pending(host, EVENT_STOP_COMPLETE)) { | ||
| 531 | /* | ||
| 532 | * host->cmd must be set to NULL before the interrupt | ||
| 533 | * handler sees EVENT_STOP_COMPLETE | ||
| 534 | */ | ||
| 535 | host->cmd = NULL; | ||
| 536 | smp_wmb(); | ||
| 537 | atmci_set_completed(host, EVENT_STOP_COMPLETE); | ||
| 538 | atmci_command_complete(host, mrq->stop, host->stop_status); | ||
| 539 | } | ||
| 540 | if (atmci_test_and_clear_pending(host, EVENT_DATA_ERROR)) { | ||
| 541 | u32 status = host->data_status; | ||
| 542 | |||
| 543 | dev_vdbg(&mmc->class_dev, "data error: status=%08x\n", status); | ||
| 544 | |||
| 545 | atmci_set_completed(host, EVENT_DATA_ERROR); | ||
| 546 | atmci_set_completed(host, EVENT_DATA_COMPLETE); | ||
| 547 | |||
| 548 | if (status & MCI_DTOE) { | ||
| 549 | dev_dbg(&mmc->class_dev, | ||
| 550 | "data timeout error\n"); | ||
| 551 | data->error = -ETIMEDOUT; | ||
| 552 | } else if (status & MCI_DCRCE) { | ||
| 553 | dev_dbg(&mmc->class_dev, "data CRC error\n"); | ||
| 554 | data->error = -EILSEQ; | ||
| 555 | } else { | ||
| 556 | dev_dbg(&mmc->class_dev, | ||
| 557 | "data FIFO error (status=%08x)\n", | ||
| 558 | status); | ||
| 559 | data->error = -EIO; | ||
| 560 | } | ||
| 561 | |||
| 562 | if (host->present && data->stop | ||
| 563 | && atmci_is_completed(host, EVENT_CMD_COMPLETE) | ||
| 564 | && !atmci_test_and_set_completed( | ||
| 565 | host, EVENT_STOP_SENT)) | ||
| 566 | send_stop_cmd(host->mmc, data); | ||
| 567 | |||
| 568 | host->data = NULL; | ||
| 569 | } | ||
| 570 | if (atmci_test_and_clear_pending(host, EVENT_DATA_COMPLETE)) { | ||
| 571 | atmci_set_completed(host, EVENT_DATA_COMPLETE); | ||
| 572 | |||
| 573 | if (!atmci_is_completed(host, EVENT_DATA_ERROR)) { | ||
| 574 | data->bytes_xfered = data->blocks * data->blksz; | ||
| 575 | data->error = 0; | ||
| 576 | } | ||
| 577 | |||
| 578 | host->data = NULL; | ||
| 579 | } | ||
| 580 | |||
| 581 | if (host->mrq && !host->cmd && !host->data) | ||
| 582 | atmci_request_end(mmc, host->mrq); | ||
| 583 | } | ||
| 584 | |||
| 585 | static void atmci_read_data_pio(struct atmel_mci *host) | ||
| 586 | { | ||
| 587 | struct scatterlist *sg = host->sg; | ||
| 588 | void *buf = sg_virt(sg); | ||
| 589 | unsigned int offset = host->pio_offset; | ||
| 590 | struct mmc_data *data = host->data; | ||
| 591 | u32 value; | ||
| 592 | u32 status; | ||
| 593 | unsigned int nbytes = 0; | ||
| 594 | |||
| 595 | do { | ||
| 596 | value = mci_readl(host, RDR); | ||
| 597 | if (likely(offset + 4 <= sg->length)) { | ||
| 598 | put_unaligned(value, (u32 *)(buf + offset)); | ||
| 599 | |||
| 600 | offset += 4; | ||
| 601 | nbytes += 4; | ||
| 602 | |||
| 603 | if (offset == sg->length) { | ||
| 604 | host->sg = sg = sg_next(sg); | ||
| 605 | if (!sg) | ||
| 606 | goto done; | ||
| 607 | |||
| 608 | offset = 0; | ||
| 609 | buf = sg_virt(sg); | ||
| 610 | } | ||
| 611 | } else { | ||
| 612 | unsigned int remaining = sg->length - offset; | ||
| 613 | memcpy(buf + offset, &value, remaining); | ||
| 614 | nbytes += remaining; | ||
| 615 | |||
| 616 | flush_dcache_page(sg_page(sg)); | ||
| 617 | host->sg = sg = sg_next(sg); | ||
| 618 | if (!sg) | ||
| 619 | goto done; | ||
| 620 | |||
| 621 | offset = 4 - remaining; | ||
| 622 | buf = sg_virt(sg); | ||
| 623 | memcpy(buf, (u8 *)&value + remaining, offset); | ||
| 624 | nbytes += offset; | ||
| 625 | } | ||
| 626 | |||
| 627 | status = mci_readl(host, SR); | ||
| 628 | if (status & ATMCI_DATA_ERROR_FLAGS) { | ||
| 629 | mci_writel(host, IDR, (MCI_NOTBUSY | MCI_RXRDY | ||
| 630 | | ATMCI_DATA_ERROR_FLAGS)); | ||
| 631 | host->data_status = status; | ||
| 632 | atmci_set_pending(host, EVENT_DATA_ERROR); | ||
| 633 | tasklet_schedule(&host->tasklet); | ||
| 634 | break; | ||
| 635 | } | ||
| 636 | } while (status & MCI_RXRDY); | ||
| 637 | |||
| 638 | host->pio_offset = offset; | ||
| 639 | data->bytes_xfered += nbytes; | ||
| 640 | |||
| 641 | return; | ||
| 642 | |||
| 643 | done: | ||
| 644 | mci_writel(host, IDR, MCI_RXRDY); | ||
| 645 | mci_writel(host, IER, MCI_NOTBUSY); | ||
| 646 | data->bytes_xfered += nbytes; | ||
| 647 | atmci_set_completed(host, EVENT_XFER_COMPLETE); | ||
| 648 | if (data->stop && atmci_is_completed(host, EVENT_CMD_COMPLETE) | ||
| 649 | && !atmci_test_and_set_completed(host, EVENT_STOP_SENT)) | ||
| 650 | send_stop_cmd(host->mmc, data); | ||
| 651 | } | ||
| 652 | |||
| 653 | static void atmci_write_data_pio(struct atmel_mci *host) | ||
| 654 | { | ||
| 655 | struct scatterlist *sg = host->sg; | ||
| 656 | void *buf = sg_virt(sg); | ||
| 657 | unsigned int offset = host->pio_offset; | ||
| 658 | struct mmc_data *data = host->data; | ||
| 659 | u32 value; | ||
| 660 | u32 status; | ||
| 661 | unsigned int nbytes = 0; | ||
| 662 | |||
| 663 | do { | ||
| 664 | if (likely(offset + 4 <= sg->length)) { | ||
| 665 | value = get_unaligned((u32 *)(buf + offset)); | ||
| 666 | mci_writel(host, TDR, value); | ||
| 667 | |||
| 668 | offset += 4; | ||
| 669 | nbytes += 4; | ||
| 670 | if (offset == sg->length) { | ||
| 671 | host->sg = sg = sg_next(sg); | ||
| 672 | if (!sg) | ||
| 673 | goto done; | ||
| 674 | |||
| 675 | offset = 0; | ||
| 676 | buf = sg_virt(sg); | ||
| 677 | } | ||
| 678 | } else { | ||
| 679 | unsigned int remaining = sg->length - offset; | ||
| 680 | |||
| 681 | value = 0; | ||
| 682 | memcpy(&value, buf + offset, remaining); | ||
| 683 | nbytes += remaining; | ||
| 684 | |||
| 685 | host->sg = sg = sg_next(sg); | ||
| 686 | if (!sg) { | ||
| 687 | mci_writel(host, TDR, value); | ||
| 688 | goto done; | ||
| 689 | } | ||
| 690 | |||
| 691 | offset = 4 - remaining; | ||
| 692 | buf = sg_virt(sg); | ||
| 693 | memcpy((u8 *)&value + remaining, buf, offset); | ||
| 694 | mci_writel(host, TDR, value); | ||
| 695 | nbytes += offset; | ||
| 696 | } | ||
| 697 | |||
| 698 | status = mci_readl(host, SR); | ||
| 699 | if (status & ATMCI_DATA_ERROR_FLAGS) { | ||
| 700 | mci_writel(host, IDR, (MCI_NOTBUSY | MCI_TXRDY | ||
| 701 | | ATMCI_DATA_ERROR_FLAGS)); | ||
| 702 | host->data_status = status; | ||
| 703 | atmci_set_pending(host, EVENT_DATA_ERROR); | ||
| 704 | tasklet_schedule(&host->tasklet); | ||
| 705 | break; | ||
| 706 | } | ||
| 707 | } while (status & MCI_TXRDY); | ||
| 708 | |||
| 709 | host->pio_offset = offset; | ||
| 710 | data->bytes_xfered += nbytes; | ||
| 711 | |||
| 712 | return; | ||
| 713 | |||
| 714 | done: | ||
| 715 | mci_writel(host, IDR, MCI_TXRDY); | ||
| 716 | mci_writel(host, IER, MCI_NOTBUSY); | ||
| 717 | data->bytes_xfered += nbytes; | ||
| 718 | atmci_set_completed(host, EVENT_XFER_COMPLETE); | ||
| 719 | if (data->stop && atmci_is_completed(host, EVENT_CMD_COMPLETE) | ||
| 720 | && !atmci_test_and_set_completed(host, EVENT_STOP_SENT)) | ||
| 721 | send_stop_cmd(host->mmc, data); | ||
| 722 | } | ||
| 723 | |||
| 724 | static void atmci_cmd_interrupt(struct mmc_host *mmc, u32 status) | ||
| 725 | { | ||
| 726 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 727 | |||
| 728 | mci_writel(host, IDR, MCI_CMDRDY); | ||
| 729 | |||
| 730 | if (atmci_is_completed(host, EVENT_STOP_SENT)) { | ||
| 731 | host->stop_status = status; | ||
| 732 | atmci_set_pending(host, EVENT_STOP_COMPLETE); | ||
| 733 | } else { | ||
| 734 | host->cmd_status = status; | ||
| 735 | atmci_set_pending(host, EVENT_CMD_COMPLETE); | ||
| 736 | } | ||
| 737 | |||
| 738 | tasklet_schedule(&host->tasklet); | ||
| 739 | } | ||
| 740 | |||
| 741 | static irqreturn_t atmci_interrupt(int irq, void *dev_id) | ||
| 742 | { | ||
| 743 | struct mmc_host *mmc = dev_id; | ||
| 744 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 745 | u32 status, mask, pending; | ||
| 746 | unsigned int pass_count = 0; | ||
| 747 | |||
| 748 | spin_lock(&mmc->lock); | ||
| 749 | |||
| 750 | do { | ||
| 751 | status = mci_readl(host, SR); | ||
| 752 | mask = mci_readl(host, IMR); | ||
| 753 | pending = status & mask; | ||
| 754 | if (!pending) | ||
| 755 | break; | ||
| 756 | |||
| 757 | if (pending & ATMCI_DATA_ERROR_FLAGS) { | ||
| 758 | mci_writel(host, IDR, ATMCI_DATA_ERROR_FLAGS | ||
| 759 | | MCI_RXRDY | MCI_TXRDY); | ||
| 760 | pending &= mci_readl(host, IMR); | ||
| 761 | host->data_status = status; | ||
| 762 | atmci_set_pending(host, EVENT_DATA_ERROR); | ||
| 763 | tasklet_schedule(&host->tasklet); | ||
| 764 | } | ||
| 765 | if (pending & MCI_NOTBUSY) { | ||
| 766 | mci_writel(host, IDR, (MCI_NOTBUSY | ||
| 767 | | ATMCI_DATA_ERROR_FLAGS)); | ||
| 768 | atmci_set_pending(host, EVENT_DATA_COMPLETE); | ||
| 769 | tasklet_schedule(&host->tasklet); | ||
| 770 | } | ||
| 771 | if (pending & MCI_RXRDY) | ||
| 772 | atmci_read_data_pio(host); | ||
| 773 | if (pending & MCI_TXRDY) | ||
| 774 | atmci_write_data_pio(host); | ||
| 775 | |||
| 776 | if (pending & MCI_CMDRDY) | ||
| 777 | atmci_cmd_interrupt(mmc, status); | ||
| 778 | } while (pass_count++ < 5); | ||
| 779 | |||
| 780 | spin_unlock(&mmc->lock); | ||
| 781 | |||
| 782 | return pass_count ? IRQ_HANDLED : IRQ_NONE; | ||
| 783 | } | ||
| 784 | |||
| 785 | static irqreturn_t atmci_detect_interrupt(int irq, void *dev_id) | ||
| 786 | { | ||
| 787 | struct mmc_host *mmc = dev_id; | ||
| 788 | struct atmel_mci *host = mmc_priv(mmc); | ||
| 789 | |||
| 790 | /* | ||
| 791 | * Disable interrupts until the pin has stabilized and check | ||
| 792 | * the state then. Use mod_timer() since we may be in the | ||
| 793 | * middle of the timer routine when this interrupt triggers. | ||
| 794 | */ | ||
| 795 | disable_irq_nosync(irq); | ||
| 796 | mod_timer(&host->detect_timer, jiffies + msecs_to_jiffies(20)); | ||
| 797 | |||
| 798 | return IRQ_HANDLED; | ||
| 799 | } | ||
| 800 | |||
| 801 | static int __init atmci_probe(struct platform_device *pdev) | ||
| 802 | { | ||
| 803 | struct mci_platform_data *pdata; | ||
| 804 | struct atmel_mci *host; | ||
| 805 | struct mmc_host *mmc; | ||
| 806 | struct resource *regs; | ||
| 807 | int irq; | ||
| 808 | int ret; | ||
| 809 | |||
| 810 | regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
| 811 | if (!regs) | ||
| 812 | return -ENXIO; | ||
| 813 | pdata = pdev->dev.platform_data; | ||
| 814 | if (!pdata) | ||
| 815 | return -ENXIO; | ||
| 816 | irq = platform_get_irq(pdev, 0); | ||
| 817 | if (irq < 0) | ||
| 818 | return irq; | ||
| 819 | |||
| 820 | mmc = mmc_alloc_host(sizeof(struct atmel_mci), &pdev->dev); | ||
| 821 | if (!mmc) | ||
| 822 | return -ENOMEM; | ||
| 823 | |||
| 824 | host = mmc_priv(mmc); | ||
| 825 | host->pdev = pdev; | ||
| 826 | host->mmc = mmc; | ||
| 827 | host->detect_pin = pdata->detect_pin; | ||
| 828 | host->wp_pin = pdata->wp_pin; | ||
| 829 | |||
| 830 | host->mck = clk_get(&pdev->dev, "mci_clk"); | ||
| 831 | if (IS_ERR(host->mck)) { | ||
| 832 | ret = PTR_ERR(host->mck); | ||
| 833 | goto err_clk_get; | ||
| 834 | } | ||
| 835 | |||
| 836 | ret = -ENOMEM; | ||
| 837 | host->regs = ioremap(regs->start, regs->end - regs->start + 1); | ||
| 838 | if (!host->regs) | ||
| 839 | goto err_ioremap; | ||
| 840 | |||
| 841 | clk_enable(host->mck); | ||
| 842 | mci_writel(host, CR, MCI_CR_SWRST); | ||
| 843 | host->bus_hz = clk_get_rate(host->mck); | ||
| 844 | clk_disable(host->mck); | ||
| 845 | |||
| 846 | host->mapbase = regs->start; | ||
| 847 | |||
| 848 | mmc->ops = &atmci_ops; | ||
| 849 | mmc->f_min = (host->bus_hz + 511) / 512; | ||
| 850 | mmc->f_max = host->bus_hz / 2; | ||
| 851 | mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; | ||
| 852 | mmc->caps |= MMC_CAP_4_BIT_DATA | MMC_CAP_MULTIWRITE; | ||
| 853 | |||
| 854 | mmc->max_hw_segs = 64; | ||
| 855 | mmc->max_phys_segs = 64; | ||
| 856 | mmc->max_req_size = 32768 * 512; | ||
| 857 | mmc->max_blk_size = 32768; | ||
| 858 | mmc->max_blk_count = 512; | ||
| 859 | |||
| 860 | tasklet_init(&host->tasklet, atmci_tasklet_func, (unsigned long)mmc); | ||
| 861 | |||
| 862 | ret = request_irq(irq, atmci_interrupt, 0, pdev->dev.bus_id, mmc); | ||
| 863 | if (ret) | ||
| 864 | goto err_request_irq; | ||
| 865 | |||
| 866 | /* Assume card is present if we don't have a detect pin */ | ||
| 867 | host->present = 1; | ||
| 868 | if (host->detect_pin >= 0) { | ||
| 869 | if (gpio_request(host->detect_pin, "mmc_detect")) { | ||
| 870 | dev_dbg(&mmc->class_dev, "no detect pin available\n"); | ||
| 871 | host->detect_pin = -1; | ||
| 872 | } else { | ||
| 873 | host->present = !gpio_get_value(host->detect_pin); | ||
| 874 | } | ||
| 875 | } | ||
| 876 | if (host->wp_pin >= 0) { | ||
| 877 | if (gpio_request(host->wp_pin, "mmc_wp")) { | ||
| 878 | dev_dbg(&mmc->class_dev, "no WP pin available\n"); | ||
| 879 | host->wp_pin = -1; | ||
| 880 | } | ||
| 881 | } | ||
| 882 | |||
| 883 | platform_set_drvdata(pdev, host); | ||
| 884 | |||
| 885 | mmc_add_host(mmc); | ||
| 886 | |||
| 887 | if (host->detect_pin >= 0) { | ||
| 888 | setup_timer(&host->detect_timer, atmci_detect_change, | ||
| 889 | (unsigned long)host); | ||
| 890 | |||
| 891 | ret = request_irq(gpio_to_irq(host->detect_pin), | ||
| 892 | atmci_detect_interrupt, | ||
| 893 | IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING, | ||
| 894 | "mmc-detect", mmc); | ||
| 895 | if (ret) { | ||
| 896 | dev_dbg(&mmc->class_dev, | ||
| 897 | "could not request IRQ %d for detect pin\n", | ||
| 898 | gpio_to_irq(host->detect_pin)); | ||
| 899 | gpio_free(host->detect_pin); | ||
| 900 | host->detect_pin = -1; | ||
| 901 | } | ||
| 902 | } | ||
| 903 | |||
| 904 | dev_info(&mmc->class_dev, | ||
| 905 | "Atmel MCI controller at 0x%08lx irq %d\n", | ||
| 906 | host->mapbase, irq); | ||
| 907 | |||
| 908 | return 0; | ||
| 909 | |||
| 910 | err_request_irq: | ||
| 911 | iounmap(host->regs); | ||
| 912 | err_ioremap: | ||
| 913 | clk_put(host->mck); | ||
| 914 | err_clk_get: | ||
| 915 | mmc_free_host(mmc); | ||
| 916 | return ret; | ||
| 917 | } | ||
| 918 | |||
| 919 | static int __exit atmci_remove(struct platform_device *pdev) | ||
| 920 | { | ||
| 921 | struct atmel_mci *host = platform_get_drvdata(pdev); | ||
| 922 | |||
| 923 | platform_set_drvdata(pdev, NULL); | ||
| 924 | |||
| 925 | if (host) { | ||
| 926 | if (host->detect_pin >= 0) { | ||
| 927 | int pin = host->detect_pin; | ||
| 928 | |||
| 929 | /* Make sure the timer doesn't enable the interrupt */ | ||
| 930 | host->detect_pin = -1; | ||
| 931 | smp_wmb(); | ||
| 932 | |||
| 933 | free_irq(gpio_to_irq(pin), host->mmc); | ||
| 934 | del_timer_sync(&host->detect_timer); | ||
| 935 | gpio_free(pin); | ||
| 936 | } | ||
| 937 | |||
| 938 | mmc_remove_host(host->mmc); | ||
| 939 | |||
| 940 | clk_enable(host->mck); | ||
| 941 | mci_writel(host, IDR, ~0UL); | ||
| 942 | mci_writel(host, CR, MCI_CR_MCIDIS); | ||
| 943 | mci_readl(host, SR); | ||
| 944 | clk_disable(host->mck); | ||
| 945 | |||
| 946 | if (host->wp_pin >= 0) | ||
| 947 | gpio_free(host->wp_pin); | ||
| 948 | |||
| 949 | free_irq(platform_get_irq(pdev, 0), host->mmc); | ||
| 950 | iounmap(host->regs); | ||
| 951 | |||
| 952 | clk_put(host->mck); | ||
| 953 | |||
| 954 | mmc_free_host(host->mmc); | ||
| 955 | } | ||
| 956 | return 0; | ||
| 957 | } | ||
| 958 | |||
| 959 | static struct platform_driver atmci_driver = { | ||
| 960 | .remove = __exit_p(atmci_remove), | ||
| 961 | .driver = { | ||
| 962 | .name = "atmel_mci", | ||
| 963 | }, | ||
| 964 | }; | ||
| 965 | |||
| 966 | static int __init atmci_init(void) | ||
| 967 | { | ||
| 968 | return platform_driver_probe(&atmci_driver, atmci_probe); | ||
| 969 | } | ||
| 970 | |||
| 971 | static void __exit atmci_exit(void) | ||
| 972 | { | ||
| 973 | platform_driver_unregister(&atmci_driver); | ||
| 974 | } | ||
| 975 | |||
| 976 | module_init(atmci_init); | ||
| 977 | module_exit(atmci_exit); | ||
| 978 | |||
| 979 | MODULE_DESCRIPTION("Atmel Multimedia Card Interface driver"); | ||
| 980 | MODULE_AUTHOR("Haavard Skinnemoen <haavard.skinnemoen@atmel.com>"); | ||
| 981 | MODULE_LICENSE("GPL v2"); | ||
diff --git a/include/asm-avr32/arch-at32ap/board.h b/include/asm-avr32/arch-at32ap/board.h index b4cddfaca90e..a3783861cdd2 100644 --- a/include/asm-avr32/arch-at32ap/board.h +++ b/include/asm-avr32/arch-at32ap/board.h | |||
| @@ -77,7 +77,11 @@ struct i2c_board_info; | |||
| 77 | struct platform_device *at32_add_device_twi(unsigned int id, | 77 | struct platform_device *at32_add_device_twi(unsigned int id, |
| 78 | struct i2c_board_info *b, | 78 | struct i2c_board_info *b, |
| 79 | unsigned int n); | 79 | unsigned int n); |
| 80 | struct platform_device *at32_add_device_mci(unsigned int id); | 80 | |
| 81 | struct mci_platform_data; | ||
| 82 | struct platform_device * | ||
| 83 | at32_add_device_mci(unsigned int id, struct mci_platform_data *data); | ||
| 84 | |||
| 81 | struct platform_device *at32_add_device_ac97c(unsigned int id); | 85 | struct platform_device *at32_add_device_ac97c(unsigned int id); |
| 82 | struct platform_device *at32_add_device_abdac(unsigned int id); | 86 | struct platform_device *at32_add_device_abdac(unsigned int id); |
| 83 | struct platform_device *at32_add_device_psif(unsigned int id); | 87 | struct platform_device *at32_add_device_psif(unsigned int id); |
diff --git a/include/asm-avr32/atmel-mci.h b/include/asm-avr32/atmel-mci.h new file mode 100644 index 000000000000..c2ea6e1c9aa1 --- /dev/null +++ b/include/asm-avr32/atmel-mci.h | |||
| @@ -0,0 +1,9 @@ | |||
| 1 | #ifndef __ASM_AVR32_ATMEL_MCI_H | ||
| 2 | #define __ASM_AVR32_ATMEL_MCI_H | ||
| 3 | |||
| 4 | struct mci_platform_data { | ||
| 5 | int detect_pin; | ||
| 6 | int wp_pin; | ||
| 7 | }; | ||
| 8 | |||
| 9 | #endif /* __ASM_AVR32_ATMEL_MCI_H */ | ||
