17d2be074SHaavard Skinnemoen /* 27d2be074SHaavard Skinnemoen * Atmel MultiMedia Card Interface driver 37d2be074SHaavard Skinnemoen * 47d2be074SHaavard Skinnemoen * Copyright (C) 2004-2008 Atmel Corporation 57d2be074SHaavard Skinnemoen * 67d2be074SHaavard Skinnemoen * This program is free software; you can redistribute it and/or modify 77d2be074SHaavard Skinnemoen * it under the terms of the GNU General Public License version 2 as 87d2be074SHaavard Skinnemoen * published by the Free Software Foundation. 97d2be074SHaavard Skinnemoen */ 107d2be074SHaavard Skinnemoen #include <linux/blkdev.h> 117d2be074SHaavard Skinnemoen #include <linux/clk.h> 127d2be074SHaavard Skinnemoen #include <linux/device.h> 137d2be074SHaavard Skinnemoen #include <linux/init.h> 147d2be074SHaavard Skinnemoen #include <linux/interrupt.h> 157d2be074SHaavard Skinnemoen #include <linux/ioport.h> 167d2be074SHaavard Skinnemoen #include <linux/module.h> 177d2be074SHaavard Skinnemoen #include <linux/platform_device.h> 187d2be074SHaavard Skinnemoen #include <linux/scatterlist.h> 197d2be074SHaavard Skinnemoen 207d2be074SHaavard Skinnemoen #include <linux/mmc/host.h> 217d2be074SHaavard Skinnemoen 227d2be074SHaavard Skinnemoen #include <asm/atmel-mci.h> 237d2be074SHaavard Skinnemoen #include <asm/io.h> 247d2be074SHaavard Skinnemoen #include <asm/unaligned.h> 257d2be074SHaavard Skinnemoen 267d2be074SHaavard Skinnemoen #include <asm/arch/board.h> 277d2be074SHaavard Skinnemoen #include <asm/arch/gpio.h> 287d2be074SHaavard Skinnemoen 297d2be074SHaavard Skinnemoen #include "atmel-mci-regs.h" 307d2be074SHaavard Skinnemoen 317d2be074SHaavard Skinnemoen #define ATMCI_DATA_ERROR_FLAGS (MCI_DCRCE | MCI_DTOE | MCI_OVRE | MCI_UNRE) 327d2be074SHaavard Skinnemoen 337d2be074SHaavard Skinnemoen enum { 347d2be074SHaavard Skinnemoen EVENT_CMD_COMPLETE = 0, 357d2be074SHaavard Skinnemoen EVENT_DATA_ERROR, 367d2be074SHaavard Skinnemoen EVENT_DATA_COMPLETE, 377d2be074SHaavard Skinnemoen EVENT_STOP_SENT, 387d2be074SHaavard Skinnemoen EVENT_STOP_COMPLETE, 397d2be074SHaavard Skinnemoen EVENT_XFER_COMPLETE, 407d2be074SHaavard Skinnemoen }; 417d2be074SHaavard Skinnemoen 427d2be074SHaavard Skinnemoen struct atmel_mci { 437d2be074SHaavard Skinnemoen struct mmc_host *mmc; 447d2be074SHaavard Skinnemoen void __iomem *regs; 457d2be074SHaavard Skinnemoen 467d2be074SHaavard Skinnemoen struct scatterlist *sg; 477d2be074SHaavard Skinnemoen unsigned int pio_offset; 487d2be074SHaavard Skinnemoen 497d2be074SHaavard Skinnemoen struct mmc_request *mrq; 507d2be074SHaavard Skinnemoen struct mmc_command *cmd; 517d2be074SHaavard Skinnemoen struct mmc_data *data; 527d2be074SHaavard Skinnemoen 537d2be074SHaavard Skinnemoen u32 cmd_status; 547d2be074SHaavard Skinnemoen u32 data_status; 557d2be074SHaavard Skinnemoen u32 stop_status; 567d2be074SHaavard Skinnemoen u32 stop_cmdr; 577d2be074SHaavard Skinnemoen 587d2be074SHaavard Skinnemoen u32 mode_reg; 597d2be074SHaavard Skinnemoen u32 sdc_reg; 607d2be074SHaavard Skinnemoen 617d2be074SHaavard Skinnemoen struct tasklet_struct tasklet; 627d2be074SHaavard Skinnemoen unsigned long pending_events; 637d2be074SHaavard Skinnemoen unsigned long completed_events; 647d2be074SHaavard Skinnemoen 657d2be074SHaavard Skinnemoen int present; 667d2be074SHaavard Skinnemoen int detect_pin; 677d2be074SHaavard Skinnemoen int wp_pin; 687d2be074SHaavard Skinnemoen 697d2be074SHaavard Skinnemoen /* For detect pin debouncing */ 707d2be074SHaavard Skinnemoen struct timer_list detect_timer; 717d2be074SHaavard Skinnemoen 727d2be074SHaavard Skinnemoen unsigned long bus_hz; 737d2be074SHaavard Skinnemoen unsigned long mapbase; 747d2be074SHaavard Skinnemoen struct clk *mck; 757d2be074SHaavard Skinnemoen struct platform_device *pdev; 767d2be074SHaavard Skinnemoen }; 777d2be074SHaavard Skinnemoen 787d2be074SHaavard Skinnemoen #define atmci_is_completed(host, event) \ 797d2be074SHaavard Skinnemoen test_bit(event, &host->completed_events) 807d2be074SHaavard Skinnemoen #define atmci_test_and_clear_pending(host, event) \ 817d2be074SHaavard Skinnemoen test_and_clear_bit(event, &host->pending_events) 827d2be074SHaavard Skinnemoen #define atmci_test_and_set_completed(host, event) \ 837d2be074SHaavard Skinnemoen test_and_set_bit(event, &host->completed_events) 847d2be074SHaavard Skinnemoen #define atmci_set_completed(host, event) \ 857d2be074SHaavard Skinnemoen set_bit(event, &host->completed_events) 867d2be074SHaavard Skinnemoen #define atmci_set_pending(host, event) \ 877d2be074SHaavard Skinnemoen set_bit(event, &host->pending_events) 887d2be074SHaavard Skinnemoen #define atmci_clear_pending(host, event) \ 897d2be074SHaavard Skinnemoen clear_bit(event, &host->pending_events) 907d2be074SHaavard Skinnemoen 917d2be074SHaavard Skinnemoen 927d2be074SHaavard Skinnemoen static void atmci_enable(struct atmel_mci *host) 937d2be074SHaavard Skinnemoen { 947d2be074SHaavard Skinnemoen clk_enable(host->mck); 957d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 967d2be074SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 977d2be074SHaavard Skinnemoen mci_writel(host, SDCR, host->sdc_reg); 987d2be074SHaavard Skinnemoen } 997d2be074SHaavard Skinnemoen 1007d2be074SHaavard Skinnemoen static void atmci_disable(struct atmel_mci *host) 1017d2be074SHaavard Skinnemoen { 1027d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 1037d2be074SHaavard Skinnemoen 1047d2be074SHaavard Skinnemoen /* Stall until write is complete, then disable the bus clock */ 1057d2be074SHaavard Skinnemoen mci_readl(host, SR); 1067d2be074SHaavard Skinnemoen clk_disable(host->mck); 1077d2be074SHaavard Skinnemoen } 1087d2be074SHaavard Skinnemoen 1097d2be074SHaavard Skinnemoen static inline unsigned int ns_to_clocks(struct atmel_mci *host, 1107d2be074SHaavard Skinnemoen unsigned int ns) 1117d2be074SHaavard Skinnemoen { 1127d2be074SHaavard Skinnemoen return (ns * (host->bus_hz / 1000000) + 999) / 1000; 1137d2be074SHaavard Skinnemoen } 1147d2be074SHaavard Skinnemoen 1157d2be074SHaavard Skinnemoen static void atmci_set_timeout(struct atmel_mci *host, 1167d2be074SHaavard Skinnemoen struct mmc_data *data) 1177d2be074SHaavard Skinnemoen { 1187d2be074SHaavard Skinnemoen static unsigned dtomul_to_shift[] = { 1197d2be074SHaavard Skinnemoen 0, 4, 7, 8, 10, 12, 16, 20 1207d2be074SHaavard Skinnemoen }; 1217d2be074SHaavard Skinnemoen unsigned timeout; 1227d2be074SHaavard Skinnemoen unsigned dtocyc; 1237d2be074SHaavard Skinnemoen unsigned dtomul; 1247d2be074SHaavard Skinnemoen 1257d2be074SHaavard Skinnemoen timeout = ns_to_clocks(host, data->timeout_ns) + data->timeout_clks; 1267d2be074SHaavard Skinnemoen 1277d2be074SHaavard Skinnemoen for (dtomul = 0; dtomul < 8; dtomul++) { 1287d2be074SHaavard Skinnemoen unsigned shift = dtomul_to_shift[dtomul]; 1297d2be074SHaavard Skinnemoen dtocyc = (timeout + (1 << shift) - 1) >> shift; 1307d2be074SHaavard Skinnemoen if (dtocyc < 15) 1317d2be074SHaavard Skinnemoen break; 1327d2be074SHaavard Skinnemoen } 1337d2be074SHaavard Skinnemoen 1347d2be074SHaavard Skinnemoen if (dtomul >= 8) { 1357d2be074SHaavard Skinnemoen dtomul = 7; 1367d2be074SHaavard Skinnemoen dtocyc = 15; 1377d2be074SHaavard Skinnemoen } 1387d2be074SHaavard Skinnemoen 1397d2be074SHaavard Skinnemoen dev_vdbg(&host->mmc->class_dev, "setting timeout to %u cycles\n", 1407d2be074SHaavard Skinnemoen dtocyc << dtomul_to_shift[dtomul]); 1417d2be074SHaavard Skinnemoen mci_writel(host, DTOR, (MCI_DTOMUL(dtomul) | MCI_DTOCYC(dtocyc))); 1427d2be074SHaavard Skinnemoen } 1437d2be074SHaavard Skinnemoen 1447d2be074SHaavard Skinnemoen /* 1457d2be074SHaavard Skinnemoen * Return mask with command flags to be enabled for this command. 1467d2be074SHaavard Skinnemoen */ 1477d2be074SHaavard Skinnemoen static u32 atmci_prepare_command(struct mmc_host *mmc, 1487d2be074SHaavard Skinnemoen struct mmc_command *cmd) 1497d2be074SHaavard Skinnemoen { 1507d2be074SHaavard Skinnemoen struct mmc_data *data; 1517d2be074SHaavard Skinnemoen u32 cmdr; 1527d2be074SHaavard Skinnemoen 1537d2be074SHaavard Skinnemoen cmd->error = -EINPROGRESS; 1547d2be074SHaavard Skinnemoen 1557d2be074SHaavard Skinnemoen cmdr = MCI_CMDR_CMDNB(cmd->opcode); 1567d2be074SHaavard Skinnemoen 1577d2be074SHaavard Skinnemoen if (cmd->flags & MMC_RSP_PRESENT) { 1587d2be074SHaavard Skinnemoen if (cmd->flags & MMC_RSP_136) 1597d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_RSPTYP_136BIT; 1607d2be074SHaavard Skinnemoen else 1617d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_RSPTYP_48BIT; 1627d2be074SHaavard Skinnemoen } 1637d2be074SHaavard Skinnemoen 1647d2be074SHaavard Skinnemoen /* 1657d2be074SHaavard Skinnemoen * This should really be MAXLAT_5 for CMD2 and ACMD41, but 1667d2be074SHaavard Skinnemoen * it's too difficult to determine whether this is an ACMD or 1677d2be074SHaavard Skinnemoen * not. Better make it 64. 1687d2be074SHaavard Skinnemoen */ 1697d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_MAXLAT_64CYC; 1707d2be074SHaavard Skinnemoen 1717d2be074SHaavard Skinnemoen if (mmc->ios.bus_mode == MMC_BUSMODE_OPENDRAIN) 1727d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_OPDCMD; 1737d2be074SHaavard Skinnemoen 1747d2be074SHaavard Skinnemoen data = cmd->data; 1757d2be074SHaavard Skinnemoen if (data) { 1767d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_START_XFER; 1777d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_STREAM) 1787d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_STREAM; 1797d2be074SHaavard Skinnemoen else if (data->blocks > 1) 1807d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_MULTI_BLOCK; 1817d2be074SHaavard Skinnemoen else 1827d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_BLOCK; 1837d2be074SHaavard Skinnemoen 1847d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_READ) 1857d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_TRDIR_READ; 1867d2be074SHaavard Skinnemoen } 1877d2be074SHaavard Skinnemoen 1887d2be074SHaavard Skinnemoen return cmdr; 1897d2be074SHaavard Skinnemoen } 1907d2be074SHaavard Skinnemoen 1917d2be074SHaavard Skinnemoen static void atmci_start_command(struct atmel_mci *host, 1927d2be074SHaavard Skinnemoen struct mmc_command *cmd, 1937d2be074SHaavard Skinnemoen u32 cmd_flags) 1947d2be074SHaavard Skinnemoen { 1957d2be074SHaavard Skinnemoen /* Must read host->cmd after testing event flags */ 1967d2be074SHaavard Skinnemoen smp_rmb(); 1977d2be074SHaavard Skinnemoen WARN_ON(host->cmd); 1987d2be074SHaavard Skinnemoen host->cmd = cmd; 1997d2be074SHaavard Skinnemoen 2007d2be074SHaavard Skinnemoen dev_vdbg(&host->mmc->class_dev, 2017d2be074SHaavard Skinnemoen "start command: ARGR=0x%08x CMDR=0x%08x\n", 2027d2be074SHaavard Skinnemoen cmd->arg, cmd_flags); 2037d2be074SHaavard Skinnemoen 2047d2be074SHaavard Skinnemoen mci_writel(host, ARGR, cmd->arg); 2057d2be074SHaavard Skinnemoen mci_writel(host, CMDR, cmd_flags); 2067d2be074SHaavard Skinnemoen } 2077d2be074SHaavard Skinnemoen 2087d2be074SHaavard Skinnemoen static void send_stop_cmd(struct mmc_host *mmc, struct mmc_data *data) 2097d2be074SHaavard Skinnemoen { 2107d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 2117d2be074SHaavard Skinnemoen 2127d2be074SHaavard Skinnemoen atmci_start_command(host, data->stop, host->stop_cmdr); 2137d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_CMDRDY); 2147d2be074SHaavard Skinnemoen } 2157d2be074SHaavard Skinnemoen 2167d2be074SHaavard Skinnemoen static void atmci_request_end(struct mmc_host *mmc, struct mmc_request *mrq) 2177d2be074SHaavard Skinnemoen { 2187d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 2197d2be074SHaavard Skinnemoen 2207d2be074SHaavard Skinnemoen WARN_ON(host->cmd || host->data); 2217d2be074SHaavard Skinnemoen host->mrq = NULL; 2227d2be074SHaavard Skinnemoen 2237d2be074SHaavard Skinnemoen atmci_disable(host); 2247d2be074SHaavard Skinnemoen 2257d2be074SHaavard Skinnemoen mmc_request_done(mmc, mrq); 2267d2be074SHaavard Skinnemoen } 2277d2be074SHaavard Skinnemoen 2287d2be074SHaavard Skinnemoen /* 2297d2be074SHaavard Skinnemoen * Returns a mask of interrupt flags to be enabled after the whole 2307d2be074SHaavard Skinnemoen * request has been prepared. 2317d2be074SHaavard Skinnemoen */ 2327d2be074SHaavard Skinnemoen static u32 atmci_submit_data(struct mmc_host *mmc, struct mmc_data *data) 2337d2be074SHaavard Skinnemoen { 2347d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 2357d2be074SHaavard Skinnemoen u32 iflags; 2367d2be074SHaavard Skinnemoen 2377d2be074SHaavard Skinnemoen data->error = -EINPROGRESS; 2387d2be074SHaavard Skinnemoen 2397d2be074SHaavard Skinnemoen WARN_ON(host->data); 2407d2be074SHaavard Skinnemoen host->sg = NULL; 2417d2be074SHaavard Skinnemoen host->data = data; 2427d2be074SHaavard Skinnemoen 2437d2be074SHaavard Skinnemoen mci_writel(host, BLKR, MCI_BCNT(data->blocks) 2447d2be074SHaavard Skinnemoen | MCI_BLKLEN(data->blksz)); 2457d2be074SHaavard Skinnemoen dev_vdbg(&mmc->class_dev, "BLKR=0x%08x\n", 2467d2be074SHaavard Skinnemoen MCI_BCNT(data->blocks) | MCI_BLKLEN(data->blksz)); 2477d2be074SHaavard Skinnemoen 2487d2be074SHaavard Skinnemoen iflags = ATMCI_DATA_ERROR_FLAGS; 2497d2be074SHaavard Skinnemoen host->sg = data->sg; 2507d2be074SHaavard Skinnemoen host->pio_offset = 0; 2517d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_READ) 2527d2be074SHaavard Skinnemoen iflags |= MCI_RXRDY; 2537d2be074SHaavard Skinnemoen else 2547d2be074SHaavard Skinnemoen iflags |= MCI_TXRDY; 2557d2be074SHaavard Skinnemoen 2567d2be074SHaavard Skinnemoen return iflags; 2577d2be074SHaavard Skinnemoen } 2587d2be074SHaavard Skinnemoen 2597d2be074SHaavard Skinnemoen static void atmci_request(struct mmc_host *mmc, struct mmc_request *mrq) 2607d2be074SHaavard Skinnemoen { 2617d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 2627d2be074SHaavard Skinnemoen struct mmc_data *data; 2637d2be074SHaavard Skinnemoen struct mmc_command *cmd; 2647d2be074SHaavard Skinnemoen u32 iflags; 2657d2be074SHaavard Skinnemoen u32 cmdflags = 0; 2667d2be074SHaavard Skinnemoen 2677d2be074SHaavard Skinnemoen iflags = mci_readl(host, IMR); 2687d2be074SHaavard Skinnemoen if (iflags) 2697d2be074SHaavard Skinnemoen dev_warn(&mmc->class_dev, "WARNING: IMR=0x%08x\n", 2707d2be074SHaavard Skinnemoen mci_readl(host, IMR)); 2717d2be074SHaavard Skinnemoen 2727d2be074SHaavard Skinnemoen WARN_ON(host->mrq != NULL); 2737d2be074SHaavard Skinnemoen 2747d2be074SHaavard Skinnemoen /* 2757d2be074SHaavard Skinnemoen * We may "know" the card is gone even though there's still an 2767d2be074SHaavard Skinnemoen * electrical connection. If so, we really need to communicate 2777d2be074SHaavard Skinnemoen * this to the MMC core since there won't be any more 2787d2be074SHaavard Skinnemoen * interrupts as the card is completely removed. Otherwise, 2797d2be074SHaavard Skinnemoen * the MMC core might believe the card is still there even 2807d2be074SHaavard Skinnemoen * though the card was just removed very slowly. 2817d2be074SHaavard Skinnemoen */ 2827d2be074SHaavard Skinnemoen if (!host->present) { 2837d2be074SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 2847d2be074SHaavard Skinnemoen mmc_request_done(mmc, mrq); 2857d2be074SHaavard Skinnemoen return; 2867d2be074SHaavard Skinnemoen } 2877d2be074SHaavard Skinnemoen 2887d2be074SHaavard Skinnemoen host->mrq = mrq; 2897d2be074SHaavard Skinnemoen host->pending_events = 0; 2907d2be074SHaavard Skinnemoen host->completed_events = 0; 2917d2be074SHaavard Skinnemoen 2927d2be074SHaavard Skinnemoen atmci_enable(host); 2937d2be074SHaavard Skinnemoen 2947d2be074SHaavard Skinnemoen /* We don't support multiple blocks of weird lengths. */ 2957d2be074SHaavard Skinnemoen data = mrq->data; 2967d2be074SHaavard Skinnemoen if (data) { 2977d2be074SHaavard Skinnemoen if (data->blocks > 1 && data->blksz & 3) 2987d2be074SHaavard Skinnemoen goto fail; 2997d2be074SHaavard Skinnemoen atmci_set_timeout(host, data); 3007d2be074SHaavard Skinnemoen } 3017d2be074SHaavard Skinnemoen 3027d2be074SHaavard Skinnemoen iflags = MCI_CMDRDY; 3037d2be074SHaavard Skinnemoen cmd = mrq->cmd; 3047d2be074SHaavard Skinnemoen cmdflags = atmci_prepare_command(mmc, cmd); 3057d2be074SHaavard Skinnemoen atmci_start_command(host, cmd, cmdflags); 3067d2be074SHaavard Skinnemoen 3077d2be074SHaavard Skinnemoen if (data) 3087d2be074SHaavard Skinnemoen iflags |= atmci_submit_data(mmc, data); 3097d2be074SHaavard Skinnemoen 3107d2be074SHaavard Skinnemoen if (mrq->stop) { 3117d2be074SHaavard Skinnemoen host->stop_cmdr = atmci_prepare_command(mmc, mrq->stop); 3127d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_STOP_XFER; 3137d2be074SHaavard Skinnemoen if (!(data->flags & MMC_DATA_WRITE)) 3147d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_TRDIR_READ; 3157d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_STREAM) 3167d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_STREAM; 3177d2be074SHaavard Skinnemoen else 3187d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_MULTI_BLOCK; 3197d2be074SHaavard Skinnemoen } 3207d2be074SHaavard Skinnemoen 3217d2be074SHaavard Skinnemoen /* 3227d2be074SHaavard Skinnemoen * We could have enabled interrupts earlier, but I suspect 3237d2be074SHaavard Skinnemoen * that would open up a nice can of interesting race 3247d2be074SHaavard Skinnemoen * conditions (e.g. command and data complete, but stop not 3257d2be074SHaavard Skinnemoen * prepared yet.) 3267d2be074SHaavard Skinnemoen */ 3277d2be074SHaavard Skinnemoen mci_writel(host, IER, iflags); 3287d2be074SHaavard Skinnemoen 3297d2be074SHaavard Skinnemoen return; 3307d2be074SHaavard Skinnemoen 3317d2be074SHaavard Skinnemoen fail: 3327d2be074SHaavard Skinnemoen atmci_disable(host); 3337d2be074SHaavard Skinnemoen host->mrq = NULL; 3347d2be074SHaavard Skinnemoen mrq->cmd->error = -EINVAL; 3357d2be074SHaavard Skinnemoen mmc_request_done(mmc, mrq); 3367d2be074SHaavard Skinnemoen } 3377d2be074SHaavard Skinnemoen 3387d2be074SHaavard Skinnemoen static void atmci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) 3397d2be074SHaavard Skinnemoen { 3407d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 3417d2be074SHaavard Skinnemoen 3427d2be074SHaavard Skinnemoen if (ios->clock) { 3437d2be074SHaavard Skinnemoen u32 clkdiv; 3447d2be074SHaavard Skinnemoen 3457d2be074SHaavard Skinnemoen /* Set clock rate */ 3467d2be074SHaavard Skinnemoen clkdiv = DIV_ROUND_UP(host->bus_hz, 2 * ios->clock) - 1; 3477d2be074SHaavard Skinnemoen if (clkdiv > 255) { 3487d2be074SHaavard Skinnemoen dev_warn(&mmc->class_dev, 3497d2be074SHaavard Skinnemoen "clock %u too slow; using %lu\n", 3507d2be074SHaavard Skinnemoen ios->clock, host->bus_hz / (2 * 256)); 3517d2be074SHaavard Skinnemoen clkdiv = 255; 3527d2be074SHaavard Skinnemoen } 3537d2be074SHaavard Skinnemoen 3547d2be074SHaavard Skinnemoen host->mode_reg = MCI_MR_CLKDIV(clkdiv) | MCI_MR_WRPROOF 3557d2be074SHaavard Skinnemoen | MCI_MR_RDPROOF; 3567d2be074SHaavard Skinnemoen } 3577d2be074SHaavard Skinnemoen 3587d2be074SHaavard Skinnemoen switch (ios->bus_width) { 3597d2be074SHaavard Skinnemoen case MMC_BUS_WIDTH_1: 3607d2be074SHaavard Skinnemoen host->sdc_reg = 0; 3617d2be074SHaavard Skinnemoen break; 3627d2be074SHaavard Skinnemoen case MMC_BUS_WIDTH_4: 3637d2be074SHaavard Skinnemoen host->sdc_reg = MCI_SDCBUS_4BIT; 3647d2be074SHaavard Skinnemoen break; 3657d2be074SHaavard Skinnemoen } 3667d2be074SHaavard Skinnemoen 3677d2be074SHaavard Skinnemoen switch (ios->power_mode) { 3687d2be074SHaavard Skinnemoen case MMC_POWER_ON: 3697d2be074SHaavard Skinnemoen /* Send init sequence (74 clock cycles) */ 3707d2be074SHaavard Skinnemoen atmci_enable(host); 3717d2be074SHaavard Skinnemoen mci_writel(host, CMDR, MCI_CMDR_SPCMD_INIT); 3727d2be074SHaavard Skinnemoen while (!(mci_readl(host, SR) & MCI_CMDRDY)) 3737d2be074SHaavard Skinnemoen cpu_relax(); 3747d2be074SHaavard Skinnemoen atmci_disable(host); 3757d2be074SHaavard Skinnemoen break; 3767d2be074SHaavard Skinnemoen default: 3777d2be074SHaavard Skinnemoen /* 3787d2be074SHaavard Skinnemoen * TODO: None of the currently available AVR32-based 3797d2be074SHaavard Skinnemoen * boards allow MMC power to be turned off. Implement 3807d2be074SHaavard Skinnemoen * power control when this can be tested properly. 3817d2be074SHaavard Skinnemoen */ 3827d2be074SHaavard Skinnemoen break; 3837d2be074SHaavard Skinnemoen } 3847d2be074SHaavard Skinnemoen } 3857d2be074SHaavard Skinnemoen 3867d2be074SHaavard Skinnemoen static int atmci_get_ro(struct mmc_host *mmc) 3877d2be074SHaavard Skinnemoen { 3887d2be074SHaavard Skinnemoen int read_only = 0; 3897d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 3907d2be074SHaavard Skinnemoen 3917d2be074SHaavard Skinnemoen if (host->wp_pin >= 0) { 3927d2be074SHaavard Skinnemoen read_only = gpio_get_value(host->wp_pin); 3937d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "card is %s\n", 3947d2be074SHaavard Skinnemoen read_only ? "read-only" : "read-write"); 3957d2be074SHaavard Skinnemoen } else { 3967d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 3977d2be074SHaavard Skinnemoen "no pin for checking read-only switch." 3987d2be074SHaavard Skinnemoen " Assuming write-enable.\n"); 3997d2be074SHaavard Skinnemoen } 4007d2be074SHaavard Skinnemoen 4017d2be074SHaavard Skinnemoen return read_only; 4027d2be074SHaavard Skinnemoen } 4037d2be074SHaavard Skinnemoen 4047d2be074SHaavard Skinnemoen static struct mmc_host_ops atmci_ops = { 4057d2be074SHaavard Skinnemoen .request = atmci_request, 4067d2be074SHaavard Skinnemoen .set_ios = atmci_set_ios, 4077d2be074SHaavard Skinnemoen .get_ro = atmci_get_ro, 4087d2be074SHaavard Skinnemoen }; 4097d2be074SHaavard Skinnemoen 4107d2be074SHaavard Skinnemoen static void atmci_command_complete(struct atmel_mci *host, 4117d2be074SHaavard Skinnemoen struct mmc_command *cmd, u32 status) 4127d2be074SHaavard Skinnemoen { 4137d2be074SHaavard Skinnemoen /* Read the response from the card (up to 16 bytes) */ 4147d2be074SHaavard Skinnemoen cmd->resp[0] = mci_readl(host, RSPR); 4157d2be074SHaavard Skinnemoen cmd->resp[1] = mci_readl(host, RSPR); 4167d2be074SHaavard Skinnemoen cmd->resp[2] = mci_readl(host, RSPR); 4177d2be074SHaavard Skinnemoen cmd->resp[3] = mci_readl(host, RSPR); 4187d2be074SHaavard Skinnemoen 4197d2be074SHaavard Skinnemoen if (status & MCI_RTOE) 4207d2be074SHaavard Skinnemoen cmd->error = -ETIMEDOUT; 4217d2be074SHaavard Skinnemoen else if ((cmd->flags & MMC_RSP_CRC) && (status & MCI_RCRCE)) 4227d2be074SHaavard Skinnemoen cmd->error = -EILSEQ; 4237d2be074SHaavard Skinnemoen else if (status & (MCI_RINDE | MCI_RDIRE | MCI_RENDE)) 4247d2be074SHaavard Skinnemoen cmd->error = -EIO; 4257d2be074SHaavard Skinnemoen else 4267d2be074SHaavard Skinnemoen cmd->error = 0; 4277d2be074SHaavard Skinnemoen 4287d2be074SHaavard Skinnemoen if (cmd->error) { 4297d2be074SHaavard Skinnemoen dev_dbg(&host->mmc->class_dev, 4307d2be074SHaavard Skinnemoen "command error: status=0x%08x\n", status); 4317d2be074SHaavard Skinnemoen 4327d2be074SHaavard Skinnemoen if (cmd->data) { 4337d2be074SHaavard Skinnemoen host->data = NULL; 4347d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_NOTBUSY 4357d2be074SHaavard Skinnemoen | MCI_TXRDY | MCI_RXRDY 4367d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS); 4377d2be074SHaavard Skinnemoen } 4387d2be074SHaavard Skinnemoen } 4397d2be074SHaavard Skinnemoen } 4407d2be074SHaavard Skinnemoen 4417d2be074SHaavard Skinnemoen static void atmci_detect_change(unsigned long data) 4427d2be074SHaavard Skinnemoen { 4437d2be074SHaavard Skinnemoen struct atmel_mci *host = (struct atmel_mci *)data; 4447d2be074SHaavard Skinnemoen struct mmc_request *mrq = host->mrq; 4457d2be074SHaavard Skinnemoen int present; 4467d2be074SHaavard Skinnemoen 4477d2be074SHaavard Skinnemoen /* 4487d2be074SHaavard Skinnemoen * atmci_remove() sets detect_pin to -1 before freeing the 4497d2be074SHaavard Skinnemoen * interrupt. We must not re-enable the interrupt if it has 4507d2be074SHaavard Skinnemoen * been freed. 4517d2be074SHaavard Skinnemoen */ 4527d2be074SHaavard Skinnemoen smp_rmb(); 4537d2be074SHaavard Skinnemoen if (host->detect_pin < 0) 4547d2be074SHaavard Skinnemoen return; 4557d2be074SHaavard Skinnemoen 4567d2be074SHaavard Skinnemoen enable_irq(gpio_to_irq(host->detect_pin)); 4577d2be074SHaavard Skinnemoen present = !gpio_get_value(host->detect_pin); 4587d2be074SHaavard Skinnemoen 4597d2be074SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, "detect change: %d (was %d)\n", 4607d2be074SHaavard Skinnemoen present, host->present); 4617d2be074SHaavard Skinnemoen 4627d2be074SHaavard Skinnemoen if (present != host->present) { 4637d2be074SHaavard Skinnemoen dev_dbg(&host->mmc->class_dev, "card %s\n", 4647d2be074SHaavard Skinnemoen present ? "inserted" : "removed"); 4657d2be074SHaavard Skinnemoen host->present = present; 4667d2be074SHaavard Skinnemoen 4677d2be074SHaavard Skinnemoen /* Reset controller if card is gone */ 4687d2be074SHaavard Skinnemoen if (!present) { 4697d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 4707d2be074SHaavard Skinnemoen mci_writel(host, IDR, ~0UL); 4717d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 4727d2be074SHaavard Skinnemoen } 4737d2be074SHaavard Skinnemoen 4747d2be074SHaavard Skinnemoen /* Clean up queue if present */ 4757d2be074SHaavard Skinnemoen if (mrq) { 4767d2be074SHaavard Skinnemoen /* 4777d2be074SHaavard Skinnemoen * Reset controller to terminate any ongoing 4787d2be074SHaavard Skinnemoen * commands or data transfers. 4797d2be074SHaavard Skinnemoen */ 4807d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 4817d2be074SHaavard Skinnemoen 4827d2be074SHaavard Skinnemoen if (!atmci_is_completed(host, EVENT_CMD_COMPLETE)) 4837d2be074SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 4847d2be074SHaavard Skinnemoen 4857d2be074SHaavard Skinnemoen if (mrq->data && !atmci_is_completed(host, 4867d2be074SHaavard Skinnemoen EVENT_DATA_COMPLETE)) { 4877d2be074SHaavard Skinnemoen host->data = NULL; 4887d2be074SHaavard Skinnemoen mrq->data->error = -ENOMEDIUM; 4897d2be074SHaavard Skinnemoen } 4907d2be074SHaavard Skinnemoen if (mrq->stop && !atmci_is_completed(host, 4917d2be074SHaavard Skinnemoen EVENT_STOP_COMPLETE)) 4927d2be074SHaavard Skinnemoen mrq->stop->error = -ENOMEDIUM; 4937d2be074SHaavard Skinnemoen 4947d2be074SHaavard Skinnemoen host->cmd = NULL; 4957d2be074SHaavard Skinnemoen atmci_request_end(host->mmc, mrq); 4967d2be074SHaavard Skinnemoen } 4977d2be074SHaavard Skinnemoen 4987d2be074SHaavard Skinnemoen mmc_detect_change(host->mmc, 0); 4997d2be074SHaavard Skinnemoen } 5007d2be074SHaavard Skinnemoen } 5017d2be074SHaavard Skinnemoen 5027d2be074SHaavard Skinnemoen static void atmci_tasklet_func(unsigned long priv) 5037d2be074SHaavard Skinnemoen { 5047d2be074SHaavard Skinnemoen struct mmc_host *mmc = (struct mmc_host *)priv; 5057d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 5067d2be074SHaavard Skinnemoen struct mmc_request *mrq = host->mrq; 5077d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 5087d2be074SHaavard Skinnemoen 5097d2be074SHaavard Skinnemoen dev_vdbg(&mmc->class_dev, 5107d2be074SHaavard Skinnemoen "tasklet: pending/completed/mask %lx/%lx/%x\n", 5117d2be074SHaavard Skinnemoen host->pending_events, host->completed_events, 5127d2be074SHaavard Skinnemoen mci_readl(host, IMR)); 5137d2be074SHaavard Skinnemoen 5147d2be074SHaavard Skinnemoen if (atmci_test_and_clear_pending(host, EVENT_CMD_COMPLETE)) { 5157d2be074SHaavard Skinnemoen /* 5167d2be074SHaavard Skinnemoen * host->cmd must be set to NULL before the interrupt 5177d2be074SHaavard Skinnemoen * handler sees EVENT_CMD_COMPLETE 5187d2be074SHaavard Skinnemoen */ 5197d2be074SHaavard Skinnemoen host->cmd = NULL; 5207d2be074SHaavard Skinnemoen smp_wmb(); 5217d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_CMD_COMPLETE); 5227d2be074SHaavard Skinnemoen atmci_command_complete(host, mrq->cmd, host->cmd_status); 5237d2be074SHaavard Skinnemoen 5247d2be074SHaavard Skinnemoen if (!mrq->cmd->error && mrq->stop 5257d2be074SHaavard Skinnemoen && atmci_is_completed(host, EVENT_XFER_COMPLETE) 5267d2be074SHaavard Skinnemoen && !atmci_test_and_set_completed(host, 5277d2be074SHaavard Skinnemoen EVENT_STOP_SENT)) 5287d2be074SHaavard Skinnemoen send_stop_cmd(host->mmc, mrq->data); 5297d2be074SHaavard Skinnemoen } 5307d2be074SHaavard Skinnemoen if (atmci_test_and_clear_pending(host, EVENT_STOP_COMPLETE)) { 5317d2be074SHaavard Skinnemoen /* 5327d2be074SHaavard Skinnemoen * host->cmd must be set to NULL before the interrupt 5337d2be074SHaavard Skinnemoen * handler sees EVENT_STOP_COMPLETE 5347d2be074SHaavard Skinnemoen */ 5357d2be074SHaavard Skinnemoen host->cmd = NULL; 5367d2be074SHaavard Skinnemoen smp_wmb(); 5377d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_STOP_COMPLETE); 5387d2be074SHaavard Skinnemoen atmci_command_complete(host, mrq->stop, host->stop_status); 5397d2be074SHaavard Skinnemoen } 5407d2be074SHaavard Skinnemoen if (atmci_test_and_clear_pending(host, EVENT_DATA_ERROR)) { 5417d2be074SHaavard Skinnemoen u32 status = host->data_status; 5427d2be074SHaavard Skinnemoen 5437d2be074SHaavard Skinnemoen dev_vdbg(&mmc->class_dev, "data error: status=%08x\n", status); 5447d2be074SHaavard Skinnemoen 5457d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_DATA_ERROR); 5467d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_DATA_COMPLETE); 5477d2be074SHaavard Skinnemoen 5487d2be074SHaavard Skinnemoen if (status & MCI_DTOE) { 5497d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 5507d2be074SHaavard Skinnemoen "data timeout error\n"); 5517d2be074SHaavard Skinnemoen data->error = -ETIMEDOUT; 5527d2be074SHaavard Skinnemoen } else if (status & MCI_DCRCE) { 5537d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "data CRC error\n"); 5547d2be074SHaavard Skinnemoen data->error = -EILSEQ; 5557d2be074SHaavard Skinnemoen } else { 5567d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 5577d2be074SHaavard Skinnemoen "data FIFO error (status=%08x)\n", 5587d2be074SHaavard Skinnemoen status); 5597d2be074SHaavard Skinnemoen data->error = -EIO; 5607d2be074SHaavard Skinnemoen } 5617d2be074SHaavard Skinnemoen 5627d2be074SHaavard Skinnemoen if (host->present && data->stop 5637d2be074SHaavard Skinnemoen && atmci_is_completed(host, EVENT_CMD_COMPLETE) 5647d2be074SHaavard Skinnemoen && !atmci_test_and_set_completed( 5657d2be074SHaavard Skinnemoen host, EVENT_STOP_SENT)) 5667d2be074SHaavard Skinnemoen send_stop_cmd(host->mmc, data); 5677d2be074SHaavard Skinnemoen 5687d2be074SHaavard Skinnemoen host->data = NULL; 5697d2be074SHaavard Skinnemoen } 5707d2be074SHaavard Skinnemoen if (atmci_test_and_clear_pending(host, EVENT_DATA_COMPLETE)) { 5717d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_DATA_COMPLETE); 5727d2be074SHaavard Skinnemoen 5737d2be074SHaavard Skinnemoen if (!atmci_is_completed(host, EVENT_DATA_ERROR)) { 5747d2be074SHaavard Skinnemoen data->bytes_xfered = data->blocks * data->blksz; 5757d2be074SHaavard Skinnemoen data->error = 0; 5767d2be074SHaavard Skinnemoen } 5777d2be074SHaavard Skinnemoen 5787d2be074SHaavard Skinnemoen host->data = NULL; 5797d2be074SHaavard Skinnemoen } 5807d2be074SHaavard Skinnemoen 5817d2be074SHaavard Skinnemoen if (host->mrq && !host->cmd && !host->data) 5827d2be074SHaavard Skinnemoen atmci_request_end(mmc, host->mrq); 5837d2be074SHaavard Skinnemoen } 5847d2be074SHaavard Skinnemoen 5857d2be074SHaavard Skinnemoen static void atmci_read_data_pio(struct atmel_mci *host) 5867d2be074SHaavard Skinnemoen { 5877d2be074SHaavard Skinnemoen struct scatterlist *sg = host->sg; 5887d2be074SHaavard Skinnemoen void *buf = sg_virt(sg); 5897d2be074SHaavard Skinnemoen unsigned int offset = host->pio_offset; 5907d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 5917d2be074SHaavard Skinnemoen u32 value; 5927d2be074SHaavard Skinnemoen u32 status; 5937d2be074SHaavard Skinnemoen unsigned int nbytes = 0; 5947d2be074SHaavard Skinnemoen 5957d2be074SHaavard Skinnemoen do { 5967d2be074SHaavard Skinnemoen value = mci_readl(host, RDR); 5977d2be074SHaavard Skinnemoen if (likely(offset + 4 <= sg->length)) { 5987d2be074SHaavard Skinnemoen put_unaligned(value, (u32 *)(buf + offset)); 5997d2be074SHaavard Skinnemoen 6007d2be074SHaavard Skinnemoen offset += 4; 6017d2be074SHaavard Skinnemoen nbytes += 4; 6027d2be074SHaavard Skinnemoen 6037d2be074SHaavard Skinnemoen if (offset == sg->length) { 6047d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 6057d2be074SHaavard Skinnemoen if (!sg) 6067d2be074SHaavard Skinnemoen goto done; 6077d2be074SHaavard Skinnemoen 6087d2be074SHaavard Skinnemoen offset = 0; 6097d2be074SHaavard Skinnemoen buf = sg_virt(sg); 6107d2be074SHaavard Skinnemoen } 6117d2be074SHaavard Skinnemoen } else { 6127d2be074SHaavard Skinnemoen unsigned int remaining = sg->length - offset; 6137d2be074SHaavard Skinnemoen memcpy(buf + offset, &value, remaining); 6147d2be074SHaavard Skinnemoen nbytes += remaining; 6157d2be074SHaavard Skinnemoen 6167d2be074SHaavard Skinnemoen flush_dcache_page(sg_page(sg)); 6177d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 6187d2be074SHaavard Skinnemoen if (!sg) 6197d2be074SHaavard Skinnemoen goto done; 6207d2be074SHaavard Skinnemoen 6217d2be074SHaavard Skinnemoen offset = 4 - remaining; 6227d2be074SHaavard Skinnemoen buf = sg_virt(sg); 6237d2be074SHaavard Skinnemoen memcpy(buf, (u8 *)&value + remaining, offset); 6247d2be074SHaavard Skinnemoen nbytes += offset; 6257d2be074SHaavard Skinnemoen } 6267d2be074SHaavard Skinnemoen 6277d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 6287d2be074SHaavard Skinnemoen if (status & ATMCI_DATA_ERROR_FLAGS) { 6297d2be074SHaavard Skinnemoen mci_writel(host, IDR, (MCI_NOTBUSY | MCI_RXRDY 6307d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS)); 6317d2be074SHaavard Skinnemoen host->data_status = status; 6327d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 6337d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 6347d2be074SHaavard Skinnemoen break; 6357d2be074SHaavard Skinnemoen } 6367d2be074SHaavard Skinnemoen } while (status & MCI_RXRDY); 6377d2be074SHaavard Skinnemoen 6387d2be074SHaavard Skinnemoen host->pio_offset = offset; 6397d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 6407d2be074SHaavard Skinnemoen 6417d2be074SHaavard Skinnemoen return; 6427d2be074SHaavard Skinnemoen 6437d2be074SHaavard Skinnemoen done: 6447d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_RXRDY); 6457d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 6467d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 6477d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_XFER_COMPLETE); 6487d2be074SHaavard Skinnemoen if (data->stop && atmci_is_completed(host, EVENT_CMD_COMPLETE) 6497d2be074SHaavard Skinnemoen && !atmci_test_and_set_completed(host, EVENT_STOP_SENT)) 6507d2be074SHaavard Skinnemoen send_stop_cmd(host->mmc, data); 6517d2be074SHaavard Skinnemoen } 6527d2be074SHaavard Skinnemoen 6537d2be074SHaavard Skinnemoen static void atmci_write_data_pio(struct atmel_mci *host) 6547d2be074SHaavard Skinnemoen { 6557d2be074SHaavard Skinnemoen struct scatterlist *sg = host->sg; 6567d2be074SHaavard Skinnemoen void *buf = sg_virt(sg); 6577d2be074SHaavard Skinnemoen unsigned int offset = host->pio_offset; 6587d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 6597d2be074SHaavard Skinnemoen u32 value; 6607d2be074SHaavard Skinnemoen u32 status; 6617d2be074SHaavard Skinnemoen unsigned int nbytes = 0; 6627d2be074SHaavard Skinnemoen 6637d2be074SHaavard Skinnemoen do { 6647d2be074SHaavard Skinnemoen if (likely(offset + 4 <= sg->length)) { 6657d2be074SHaavard Skinnemoen value = get_unaligned((u32 *)(buf + offset)); 6667d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 6677d2be074SHaavard Skinnemoen 6687d2be074SHaavard Skinnemoen offset += 4; 6697d2be074SHaavard Skinnemoen nbytes += 4; 6707d2be074SHaavard Skinnemoen if (offset == sg->length) { 6717d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 6727d2be074SHaavard Skinnemoen if (!sg) 6737d2be074SHaavard Skinnemoen goto done; 6747d2be074SHaavard Skinnemoen 6757d2be074SHaavard Skinnemoen offset = 0; 6767d2be074SHaavard Skinnemoen buf = sg_virt(sg); 6777d2be074SHaavard Skinnemoen } 6787d2be074SHaavard Skinnemoen } else { 6797d2be074SHaavard Skinnemoen unsigned int remaining = sg->length - offset; 6807d2be074SHaavard Skinnemoen 6817d2be074SHaavard Skinnemoen value = 0; 6827d2be074SHaavard Skinnemoen memcpy(&value, buf + offset, remaining); 6837d2be074SHaavard Skinnemoen nbytes += remaining; 6847d2be074SHaavard Skinnemoen 6857d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 6867d2be074SHaavard Skinnemoen if (!sg) { 6877d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 6887d2be074SHaavard Skinnemoen goto done; 6897d2be074SHaavard Skinnemoen } 6907d2be074SHaavard Skinnemoen 6917d2be074SHaavard Skinnemoen offset = 4 - remaining; 6927d2be074SHaavard Skinnemoen buf = sg_virt(sg); 6937d2be074SHaavard Skinnemoen memcpy((u8 *)&value + remaining, buf, offset); 6947d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 6957d2be074SHaavard Skinnemoen nbytes += offset; 6967d2be074SHaavard Skinnemoen } 6977d2be074SHaavard Skinnemoen 6987d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 6997d2be074SHaavard Skinnemoen if (status & ATMCI_DATA_ERROR_FLAGS) { 7007d2be074SHaavard Skinnemoen mci_writel(host, IDR, (MCI_NOTBUSY | MCI_TXRDY 7017d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS)); 7027d2be074SHaavard Skinnemoen host->data_status = status; 7037d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 7047d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 7057d2be074SHaavard Skinnemoen break; 7067d2be074SHaavard Skinnemoen } 7077d2be074SHaavard Skinnemoen } while (status & MCI_TXRDY); 7087d2be074SHaavard Skinnemoen 7097d2be074SHaavard Skinnemoen host->pio_offset = offset; 7107d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 7117d2be074SHaavard Skinnemoen 7127d2be074SHaavard Skinnemoen return; 7137d2be074SHaavard Skinnemoen 7147d2be074SHaavard Skinnemoen done: 7157d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_TXRDY); 7167d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 7177d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 7187d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_XFER_COMPLETE); 7197d2be074SHaavard Skinnemoen if (data->stop && atmci_is_completed(host, EVENT_CMD_COMPLETE) 7207d2be074SHaavard Skinnemoen && !atmci_test_and_set_completed(host, EVENT_STOP_SENT)) 7217d2be074SHaavard Skinnemoen send_stop_cmd(host->mmc, data); 7227d2be074SHaavard Skinnemoen } 7237d2be074SHaavard Skinnemoen 7247d2be074SHaavard Skinnemoen static void atmci_cmd_interrupt(struct mmc_host *mmc, u32 status) 7257d2be074SHaavard Skinnemoen { 7267d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 7277d2be074SHaavard Skinnemoen 7287d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_CMDRDY); 7297d2be074SHaavard Skinnemoen 7307d2be074SHaavard Skinnemoen if (atmci_is_completed(host, EVENT_STOP_SENT)) { 7317d2be074SHaavard Skinnemoen host->stop_status = status; 7327d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_STOP_COMPLETE); 7337d2be074SHaavard Skinnemoen } else { 7347d2be074SHaavard Skinnemoen host->cmd_status = status; 7357d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_CMD_COMPLETE); 7367d2be074SHaavard Skinnemoen } 7377d2be074SHaavard Skinnemoen 7387d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 7397d2be074SHaavard Skinnemoen } 7407d2be074SHaavard Skinnemoen 7417d2be074SHaavard Skinnemoen static irqreturn_t atmci_interrupt(int irq, void *dev_id) 7427d2be074SHaavard Skinnemoen { 7437d2be074SHaavard Skinnemoen struct mmc_host *mmc = dev_id; 7447d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 7457d2be074SHaavard Skinnemoen u32 status, mask, pending; 7467d2be074SHaavard Skinnemoen unsigned int pass_count = 0; 7477d2be074SHaavard Skinnemoen 7487d2be074SHaavard Skinnemoen spin_lock(&mmc->lock); 7497d2be074SHaavard Skinnemoen 7507d2be074SHaavard Skinnemoen do { 7517d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 7527d2be074SHaavard Skinnemoen mask = mci_readl(host, IMR); 7537d2be074SHaavard Skinnemoen pending = status & mask; 7547d2be074SHaavard Skinnemoen if (!pending) 7557d2be074SHaavard Skinnemoen break; 7567d2be074SHaavard Skinnemoen 7577d2be074SHaavard Skinnemoen if (pending & ATMCI_DATA_ERROR_FLAGS) { 7587d2be074SHaavard Skinnemoen mci_writel(host, IDR, ATMCI_DATA_ERROR_FLAGS 7597d2be074SHaavard Skinnemoen | MCI_RXRDY | MCI_TXRDY); 7607d2be074SHaavard Skinnemoen pending &= mci_readl(host, IMR); 7617d2be074SHaavard Skinnemoen host->data_status = status; 7627d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 7637d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 7647d2be074SHaavard Skinnemoen } 7657d2be074SHaavard Skinnemoen if (pending & MCI_NOTBUSY) { 7667d2be074SHaavard Skinnemoen mci_writel(host, IDR, (MCI_NOTBUSY 7677d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS)); 7687d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_COMPLETE); 7697d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 7707d2be074SHaavard Skinnemoen } 7717d2be074SHaavard Skinnemoen if (pending & MCI_RXRDY) 7727d2be074SHaavard Skinnemoen atmci_read_data_pio(host); 7737d2be074SHaavard Skinnemoen if (pending & MCI_TXRDY) 7747d2be074SHaavard Skinnemoen atmci_write_data_pio(host); 7757d2be074SHaavard Skinnemoen 7767d2be074SHaavard Skinnemoen if (pending & MCI_CMDRDY) 7777d2be074SHaavard Skinnemoen atmci_cmd_interrupt(mmc, status); 7787d2be074SHaavard Skinnemoen } while (pass_count++ < 5); 7797d2be074SHaavard Skinnemoen 7807d2be074SHaavard Skinnemoen spin_unlock(&mmc->lock); 7817d2be074SHaavard Skinnemoen 7827d2be074SHaavard Skinnemoen return pass_count ? IRQ_HANDLED : IRQ_NONE; 7837d2be074SHaavard Skinnemoen } 7847d2be074SHaavard Skinnemoen 7857d2be074SHaavard Skinnemoen static irqreturn_t atmci_detect_interrupt(int irq, void *dev_id) 7867d2be074SHaavard Skinnemoen { 7877d2be074SHaavard Skinnemoen struct mmc_host *mmc = dev_id; 7887d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 7897d2be074SHaavard Skinnemoen 7907d2be074SHaavard Skinnemoen /* 7917d2be074SHaavard Skinnemoen * Disable interrupts until the pin has stabilized and check 7927d2be074SHaavard Skinnemoen * the state then. Use mod_timer() since we may be in the 7937d2be074SHaavard Skinnemoen * middle of the timer routine when this interrupt triggers. 7947d2be074SHaavard Skinnemoen */ 7957d2be074SHaavard Skinnemoen disable_irq_nosync(irq); 7967d2be074SHaavard Skinnemoen mod_timer(&host->detect_timer, jiffies + msecs_to_jiffies(20)); 7977d2be074SHaavard Skinnemoen 7987d2be074SHaavard Skinnemoen return IRQ_HANDLED; 7997d2be074SHaavard Skinnemoen } 8007d2be074SHaavard Skinnemoen 8017d2be074SHaavard Skinnemoen static int __init atmci_probe(struct platform_device *pdev) 8027d2be074SHaavard Skinnemoen { 8037d2be074SHaavard Skinnemoen struct mci_platform_data *pdata; 8047d2be074SHaavard Skinnemoen struct atmel_mci *host; 8057d2be074SHaavard Skinnemoen struct mmc_host *mmc; 8067d2be074SHaavard Skinnemoen struct resource *regs; 8077d2be074SHaavard Skinnemoen int irq; 8087d2be074SHaavard Skinnemoen int ret; 8097d2be074SHaavard Skinnemoen 8107d2be074SHaavard Skinnemoen regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); 8117d2be074SHaavard Skinnemoen if (!regs) 8127d2be074SHaavard Skinnemoen return -ENXIO; 8137d2be074SHaavard Skinnemoen pdata = pdev->dev.platform_data; 8147d2be074SHaavard Skinnemoen if (!pdata) 8157d2be074SHaavard Skinnemoen return -ENXIO; 8167d2be074SHaavard Skinnemoen irq = platform_get_irq(pdev, 0); 8177d2be074SHaavard Skinnemoen if (irq < 0) 8187d2be074SHaavard Skinnemoen return irq; 8197d2be074SHaavard Skinnemoen 8207d2be074SHaavard Skinnemoen mmc = mmc_alloc_host(sizeof(struct atmel_mci), &pdev->dev); 8217d2be074SHaavard Skinnemoen if (!mmc) 8227d2be074SHaavard Skinnemoen return -ENOMEM; 8237d2be074SHaavard Skinnemoen 8247d2be074SHaavard Skinnemoen host = mmc_priv(mmc); 8257d2be074SHaavard Skinnemoen host->pdev = pdev; 8267d2be074SHaavard Skinnemoen host->mmc = mmc; 8277d2be074SHaavard Skinnemoen host->detect_pin = pdata->detect_pin; 8287d2be074SHaavard Skinnemoen host->wp_pin = pdata->wp_pin; 8297d2be074SHaavard Skinnemoen 8307d2be074SHaavard Skinnemoen host->mck = clk_get(&pdev->dev, "mci_clk"); 8317d2be074SHaavard Skinnemoen if (IS_ERR(host->mck)) { 8327d2be074SHaavard Skinnemoen ret = PTR_ERR(host->mck); 8337d2be074SHaavard Skinnemoen goto err_clk_get; 8347d2be074SHaavard Skinnemoen } 8357d2be074SHaavard Skinnemoen 8367d2be074SHaavard Skinnemoen ret = -ENOMEM; 8377d2be074SHaavard Skinnemoen host->regs = ioremap(regs->start, regs->end - regs->start + 1); 8387d2be074SHaavard Skinnemoen if (!host->regs) 8397d2be074SHaavard Skinnemoen goto err_ioremap; 8407d2be074SHaavard Skinnemoen 8417d2be074SHaavard Skinnemoen clk_enable(host->mck); 8427d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 8437d2be074SHaavard Skinnemoen host->bus_hz = clk_get_rate(host->mck); 8447d2be074SHaavard Skinnemoen clk_disable(host->mck); 8457d2be074SHaavard Skinnemoen 8467d2be074SHaavard Skinnemoen host->mapbase = regs->start; 8477d2be074SHaavard Skinnemoen 8487d2be074SHaavard Skinnemoen mmc->ops = &atmci_ops; 8497d2be074SHaavard Skinnemoen mmc->f_min = (host->bus_hz + 511) / 512; 8507d2be074SHaavard Skinnemoen mmc->f_max = host->bus_hz / 2; 8517d2be074SHaavard Skinnemoen mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; 85223af6039SPierre Ossman mmc->caps |= MMC_CAP_4_BIT_DATA; 8537d2be074SHaavard Skinnemoen 8547d2be074SHaavard Skinnemoen mmc->max_hw_segs = 64; 8557d2be074SHaavard Skinnemoen mmc->max_phys_segs = 64; 8567d2be074SHaavard Skinnemoen mmc->max_req_size = 32768 * 512; 8577d2be074SHaavard Skinnemoen mmc->max_blk_size = 32768; 8587d2be074SHaavard Skinnemoen mmc->max_blk_count = 512; 8597d2be074SHaavard Skinnemoen 8607d2be074SHaavard Skinnemoen tasklet_init(&host->tasklet, atmci_tasklet_func, (unsigned long)mmc); 8617d2be074SHaavard Skinnemoen 8627d2be074SHaavard Skinnemoen ret = request_irq(irq, atmci_interrupt, 0, pdev->dev.bus_id, mmc); 8637d2be074SHaavard Skinnemoen if (ret) 8647d2be074SHaavard Skinnemoen goto err_request_irq; 8657d2be074SHaavard Skinnemoen 8667d2be074SHaavard Skinnemoen /* Assume card is present if we don't have a detect pin */ 8677d2be074SHaavard Skinnemoen host->present = 1; 8687d2be074SHaavard Skinnemoen if (host->detect_pin >= 0) { 8697d2be074SHaavard Skinnemoen if (gpio_request(host->detect_pin, "mmc_detect")) { 8707d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "no detect pin available\n"); 8717d2be074SHaavard Skinnemoen host->detect_pin = -1; 8727d2be074SHaavard Skinnemoen } else { 8737d2be074SHaavard Skinnemoen host->present = !gpio_get_value(host->detect_pin); 8747d2be074SHaavard Skinnemoen } 8757d2be074SHaavard Skinnemoen } 8767d2be074SHaavard Skinnemoen if (host->wp_pin >= 0) { 8777d2be074SHaavard Skinnemoen if (gpio_request(host->wp_pin, "mmc_wp")) { 8787d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "no WP pin available\n"); 8797d2be074SHaavard Skinnemoen host->wp_pin = -1; 8807d2be074SHaavard Skinnemoen } 8817d2be074SHaavard Skinnemoen } 8827d2be074SHaavard Skinnemoen 8837d2be074SHaavard Skinnemoen platform_set_drvdata(pdev, host); 8847d2be074SHaavard Skinnemoen 8857d2be074SHaavard Skinnemoen mmc_add_host(mmc); 8867d2be074SHaavard Skinnemoen 8877d2be074SHaavard Skinnemoen if (host->detect_pin >= 0) { 8887d2be074SHaavard Skinnemoen setup_timer(&host->detect_timer, atmci_detect_change, 8897d2be074SHaavard Skinnemoen (unsigned long)host); 8907d2be074SHaavard Skinnemoen 8917d2be074SHaavard Skinnemoen ret = request_irq(gpio_to_irq(host->detect_pin), 8927d2be074SHaavard Skinnemoen atmci_detect_interrupt, 8937d2be074SHaavard Skinnemoen IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING, 8947d2be074SHaavard Skinnemoen "mmc-detect", mmc); 8957d2be074SHaavard Skinnemoen if (ret) { 8967d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 8977d2be074SHaavard Skinnemoen "could not request IRQ %d for detect pin\n", 8987d2be074SHaavard Skinnemoen gpio_to_irq(host->detect_pin)); 8997d2be074SHaavard Skinnemoen gpio_free(host->detect_pin); 9007d2be074SHaavard Skinnemoen host->detect_pin = -1; 9017d2be074SHaavard Skinnemoen } 9027d2be074SHaavard Skinnemoen } 9037d2be074SHaavard Skinnemoen 9047d2be074SHaavard Skinnemoen dev_info(&mmc->class_dev, 9057d2be074SHaavard Skinnemoen "Atmel MCI controller at 0x%08lx irq %d\n", 9067d2be074SHaavard Skinnemoen host->mapbase, irq); 9077d2be074SHaavard Skinnemoen 9087d2be074SHaavard Skinnemoen return 0; 9097d2be074SHaavard Skinnemoen 9107d2be074SHaavard Skinnemoen err_request_irq: 9117d2be074SHaavard Skinnemoen iounmap(host->regs); 9127d2be074SHaavard Skinnemoen err_ioremap: 9137d2be074SHaavard Skinnemoen clk_put(host->mck); 9147d2be074SHaavard Skinnemoen err_clk_get: 9157d2be074SHaavard Skinnemoen mmc_free_host(mmc); 9167d2be074SHaavard Skinnemoen return ret; 9177d2be074SHaavard Skinnemoen } 9187d2be074SHaavard Skinnemoen 9197d2be074SHaavard Skinnemoen static int __exit atmci_remove(struct platform_device *pdev) 9207d2be074SHaavard Skinnemoen { 9217d2be074SHaavard Skinnemoen struct atmel_mci *host = platform_get_drvdata(pdev); 9227d2be074SHaavard Skinnemoen 9237d2be074SHaavard Skinnemoen platform_set_drvdata(pdev, NULL); 9247d2be074SHaavard Skinnemoen 9257d2be074SHaavard Skinnemoen if (host) { 9267d2be074SHaavard Skinnemoen if (host->detect_pin >= 0) { 9277d2be074SHaavard Skinnemoen int pin = host->detect_pin; 9287d2be074SHaavard Skinnemoen 9297d2be074SHaavard Skinnemoen /* Make sure the timer doesn't enable the interrupt */ 9307d2be074SHaavard Skinnemoen host->detect_pin = -1; 9317d2be074SHaavard Skinnemoen smp_wmb(); 9327d2be074SHaavard Skinnemoen 9337d2be074SHaavard Skinnemoen free_irq(gpio_to_irq(pin), host->mmc); 9347d2be074SHaavard Skinnemoen del_timer_sync(&host->detect_timer); 9357d2be074SHaavard Skinnemoen gpio_free(pin); 9367d2be074SHaavard Skinnemoen } 9377d2be074SHaavard Skinnemoen 9387d2be074SHaavard Skinnemoen mmc_remove_host(host->mmc); 9397d2be074SHaavard Skinnemoen 9407d2be074SHaavard Skinnemoen clk_enable(host->mck); 9417d2be074SHaavard Skinnemoen mci_writel(host, IDR, ~0UL); 9427d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIDIS); 9437d2be074SHaavard Skinnemoen mci_readl(host, SR); 9447d2be074SHaavard Skinnemoen clk_disable(host->mck); 9457d2be074SHaavard Skinnemoen 9467d2be074SHaavard Skinnemoen if (host->wp_pin >= 0) 9477d2be074SHaavard Skinnemoen gpio_free(host->wp_pin); 9487d2be074SHaavard Skinnemoen 9497d2be074SHaavard Skinnemoen free_irq(platform_get_irq(pdev, 0), host->mmc); 9507d2be074SHaavard Skinnemoen iounmap(host->regs); 9517d2be074SHaavard Skinnemoen 9527d2be074SHaavard Skinnemoen clk_put(host->mck); 9537d2be074SHaavard Skinnemoen 9547d2be074SHaavard Skinnemoen mmc_free_host(host->mmc); 9557d2be074SHaavard Skinnemoen } 9567d2be074SHaavard Skinnemoen return 0; 9577d2be074SHaavard Skinnemoen } 9587d2be074SHaavard Skinnemoen 9597d2be074SHaavard Skinnemoen static struct platform_driver atmci_driver = { 9607d2be074SHaavard Skinnemoen .remove = __exit_p(atmci_remove), 9617d2be074SHaavard Skinnemoen .driver = { 9627d2be074SHaavard Skinnemoen .name = "atmel_mci", 9637d2be074SHaavard Skinnemoen }, 9647d2be074SHaavard Skinnemoen }; 9657d2be074SHaavard Skinnemoen 9667d2be074SHaavard Skinnemoen static int __init atmci_init(void) 9677d2be074SHaavard Skinnemoen { 9687d2be074SHaavard Skinnemoen return platform_driver_probe(&atmci_driver, atmci_probe); 9697d2be074SHaavard Skinnemoen } 9707d2be074SHaavard Skinnemoen 9717d2be074SHaavard Skinnemoen static void __exit atmci_exit(void) 9727d2be074SHaavard Skinnemoen { 9737d2be074SHaavard Skinnemoen platform_driver_unregister(&atmci_driver); 9747d2be074SHaavard Skinnemoen } 9757d2be074SHaavard Skinnemoen 9767d2be074SHaavard Skinnemoen module_init(atmci_init); 9777d2be074SHaavard Skinnemoen module_exit(atmci_exit); 9787d2be074SHaavard Skinnemoen 9797d2be074SHaavard Skinnemoen MODULE_DESCRIPTION("Atmel Multimedia Card Interface driver"); 9807d2be074SHaavard Skinnemoen MODULE_AUTHOR("Haavard Skinnemoen <haavard.skinnemoen@atmel.com>"); 9817d2be074SHaavard Skinnemoen MODULE_LICENSE("GPL v2"); 982