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> 12deec9ae3SHaavard Skinnemoen #include <linux/debugfs.h> 137d2be074SHaavard Skinnemoen #include <linux/device.h> 1465e8b083SHaavard Skinnemoen #include <linux/dmaengine.h> 1565e8b083SHaavard Skinnemoen #include <linux/dma-mapping.h> 16fbfca4b8SBen Nizette #include <linux/err.h> 173c26e170SDavid Brownell #include <linux/gpio.h> 187d2be074SHaavard Skinnemoen #include <linux/init.h> 197d2be074SHaavard Skinnemoen #include <linux/interrupt.h> 207d2be074SHaavard Skinnemoen #include <linux/ioport.h> 217d2be074SHaavard Skinnemoen #include <linux/module.h> 227d2be074SHaavard Skinnemoen #include <linux/platform_device.h> 237d2be074SHaavard Skinnemoen #include <linux/scatterlist.h> 24deec9ae3SHaavard Skinnemoen #include <linux/seq_file.h> 25deec9ae3SHaavard Skinnemoen #include <linux/stat.h> 267d2be074SHaavard Skinnemoen 277d2be074SHaavard Skinnemoen #include <linux/mmc/host.h> 287d2be074SHaavard Skinnemoen 297d2be074SHaavard Skinnemoen #include <asm/atmel-mci.h> 307d2be074SHaavard Skinnemoen #include <asm/io.h> 317d2be074SHaavard Skinnemoen #include <asm/unaligned.h> 327d2be074SHaavard Skinnemoen 333663b736SHaavard Skinnemoen #include <mach/board.h> 347d2be074SHaavard Skinnemoen 357d2be074SHaavard Skinnemoen #include "atmel-mci-regs.h" 367d2be074SHaavard Skinnemoen 377d2be074SHaavard Skinnemoen #define ATMCI_DATA_ERROR_FLAGS (MCI_DCRCE | MCI_DTOE | MCI_OVRE | MCI_UNRE) 3865e8b083SHaavard Skinnemoen #define ATMCI_DMA_THRESHOLD 16 397d2be074SHaavard Skinnemoen 407d2be074SHaavard Skinnemoen enum { 417d2be074SHaavard Skinnemoen EVENT_CMD_COMPLETE = 0, 427d2be074SHaavard Skinnemoen EVENT_XFER_COMPLETE, 43c06ad258SHaavard Skinnemoen EVENT_DATA_COMPLETE, 44c06ad258SHaavard Skinnemoen EVENT_DATA_ERROR, 45c06ad258SHaavard Skinnemoen }; 46c06ad258SHaavard Skinnemoen 47c06ad258SHaavard Skinnemoen enum atmel_mci_state { 48965ebf33SHaavard Skinnemoen STATE_IDLE = 0, 49965ebf33SHaavard Skinnemoen STATE_SENDING_CMD, 50c06ad258SHaavard Skinnemoen STATE_SENDING_DATA, 51c06ad258SHaavard Skinnemoen STATE_DATA_BUSY, 52c06ad258SHaavard Skinnemoen STATE_SENDING_STOP, 53c06ad258SHaavard Skinnemoen STATE_DATA_ERROR, 547d2be074SHaavard Skinnemoen }; 557d2be074SHaavard Skinnemoen 5665e8b083SHaavard Skinnemoen struct atmel_mci_dma { 5765e8b083SHaavard Skinnemoen #ifdef CONFIG_MMC_ATMELMCI_DMA 5865e8b083SHaavard Skinnemoen struct dma_client client; 5965e8b083SHaavard Skinnemoen struct dma_chan *chan; 6065e8b083SHaavard Skinnemoen struct dma_async_tx_descriptor *data_desc; 6165e8b083SHaavard Skinnemoen #endif 6265e8b083SHaavard Skinnemoen }; 6365e8b083SHaavard Skinnemoen 64965ebf33SHaavard Skinnemoen /** 65965ebf33SHaavard Skinnemoen * struct atmel_mci - MMC controller state shared between all slots 66965ebf33SHaavard Skinnemoen * @lock: Spinlock protecting the queue and associated data. 67965ebf33SHaavard Skinnemoen * @regs: Pointer to MMIO registers. 68965ebf33SHaavard Skinnemoen * @sg: Scatterlist entry currently being processed by PIO code, if any. 69965ebf33SHaavard Skinnemoen * @pio_offset: Offset into the current scatterlist entry. 70965ebf33SHaavard Skinnemoen * @cur_slot: The slot which is currently using the controller. 71965ebf33SHaavard Skinnemoen * @mrq: The request currently being processed on @cur_slot, 72965ebf33SHaavard Skinnemoen * or NULL if the controller is idle. 73965ebf33SHaavard Skinnemoen * @cmd: The command currently being sent to the card, or NULL. 74965ebf33SHaavard Skinnemoen * @data: The data currently being transferred, or NULL if no data 75965ebf33SHaavard Skinnemoen * transfer is in progress. 7665e8b083SHaavard Skinnemoen * @dma: DMA client state. 7765e8b083SHaavard Skinnemoen * @data_chan: DMA channel being used for the current data transfer. 78965ebf33SHaavard Skinnemoen * @cmd_status: Snapshot of SR taken upon completion of the current 79965ebf33SHaavard Skinnemoen * command. Only valid when EVENT_CMD_COMPLETE is pending. 80965ebf33SHaavard Skinnemoen * @data_status: Snapshot of SR taken upon completion of the current 81965ebf33SHaavard Skinnemoen * data transfer. Only valid when EVENT_DATA_COMPLETE or 82965ebf33SHaavard Skinnemoen * EVENT_DATA_ERROR is pending. 83965ebf33SHaavard Skinnemoen * @stop_cmdr: Value to be loaded into CMDR when the stop command is 84965ebf33SHaavard Skinnemoen * to be sent. 85965ebf33SHaavard Skinnemoen * @tasklet: Tasklet running the request state machine. 86965ebf33SHaavard Skinnemoen * @pending_events: Bitmask of events flagged by the interrupt handler 87965ebf33SHaavard Skinnemoen * to be processed by the tasklet. 88965ebf33SHaavard Skinnemoen * @completed_events: Bitmask of events which the state machine has 89965ebf33SHaavard Skinnemoen * processed. 90965ebf33SHaavard Skinnemoen * @state: Tasklet state. 91965ebf33SHaavard Skinnemoen * @queue: List of slots waiting for access to the controller. 92965ebf33SHaavard Skinnemoen * @need_clock_update: Update the clock rate before the next request. 93965ebf33SHaavard Skinnemoen * @need_reset: Reset controller before next request. 94965ebf33SHaavard Skinnemoen * @mode_reg: Value of the MR register. 95965ebf33SHaavard Skinnemoen * @bus_hz: The rate of @mck in Hz. This forms the basis for MMC bus 96965ebf33SHaavard Skinnemoen * rate and timeout calculations. 97965ebf33SHaavard Skinnemoen * @mapbase: Physical address of the MMIO registers. 98965ebf33SHaavard Skinnemoen * @mck: The peripheral bus clock hooked up to the MMC controller. 99965ebf33SHaavard Skinnemoen * @pdev: Platform device associated with the MMC controller. 100965ebf33SHaavard Skinnemoen * @slot: Slots sharing this MMC controller. 101965ebf33SHaavard Skinnemoen * 102965ebf33SHaavard Skinnemoen * Locking 103965ebf33SHaavard Skinnemoen * ======= 104965ebf33SHaavard Skinnemoen * 105965ebf33SHaavard Skinnemoen * @lock is a softirq-safe spinlock protecting @queue as well as 106965ebf33SHaavard Skinnemoen * @cur_slot, @mrq and @state. These must always be updated 107965ebf33SHaavard Skinnemoen * at the same time while holding @lock. 108965ebf33SHaavard Skinnemoen * 109965ebf33SHaavard Skinnemoen * @lock also protects mode_reg and need_clock_update since these are 110965ebf33SHaavard Skinnemoen * used to synchronize mode register updates with the queue 111965ebf33SHaavard Skinnemoen * processing. 112965ebf33SHaavard Skinnemoen * 113965ebf33SHaavard Skinnemoen * The @mrq field of struct atmel_mci_slot is also protected by @lock, 114965ebf33SHaavard Skinnemoen * and must always be written at the same time as the slot is added to 115965ebf33SHaavard Skinnemoen * @queue. 116965ebf33SHaavard Skinnemoen * 117965ebf33SHaavard Skinnemoen * @pending_events and @completed_events are accessed using atomic bit 118965ebf33SHaavard Skinnemoen * operations, so they don't need any locking. 119965ebf33SHaavard Skinnemoen * 120965ebf33SHaavard Skinnemoen * None of the fields touched by the interrupt handler need any 121965ebf33SHaavard Skinnemoen * locking. However, ordering is important: Before EVENT_DATA_ERROR or 122965ebf33SHaavard Skinnemoen * EVENT_DATA_COMPLETE is set in @pending_events, all data-related 123965ebf33SHaavard Skinnemoen * interrupts must be disabled and @data_status updated with a 124965ebf33SHaavard Skinnemoen * snapshot of SR. Similarly, before EVENT_CMD_COMPLETE is set, the 125965ebf33SHaavard Skinnemoen * CMDRDY interupt must be disabled and @cmd_status updated with a 126965ebf33SHaavard Skinnemoen * snapshot of SR, and before EVENT_XFER_COMPLETE can be set, the 127965ebf33SHaavard Skinnemoen * bytes_xfered field of @data must be written. This is ensured by 128965ebf33SHaavard Skinnemoen * using barriers. 129965ebf33SHaavard Skinnemoen */ 1307d2be074SHaavard Skinnemoen struct atmel_mci { 131965ebf33SHaavard Skinnemoen spinlock_t lock; 1327d2be074SHaavard Skinnemoen void __iomem *regs; 1337d2be074SHaavard Skinnemoen 1347d2be074SHaavard Skinnemoen struct scatterlist *sg; 1357d2be074SHaavard Skinnemoen unsigned int pio_offset; 1367d2be074SHaavard Skinnemoen 137965ebf33SHaavard Skinnemoen struct atmel_mci_slot *cur_slot; 1387d2be074SHaavard Skinnemoen struct mmc_request *mrq; 1397d2be074SHaavard Skinnemoen struct mmc_command *cmd; 1407d2be074SHaavard Skinnemoen struct mmc_data *data; 1417d2be074SHaavard Skinnemoen 14265e8b083SHaavard Skinnemoen struct atmel_mci_dma dma; 14365e8b083SHaavard Skinnemoen struct dma_chan *data_chan; 14465e8b083SHaavard Skinnemoen 1457d2be074SHaavard Skinnemoen u32 cmd_status; 1467d2be074SHaavard Skinnemoen u32 data_status; 1477d2be074SHaavard Skinnemoen u32 stop_cmdr; 1487d2be074SHaavard Skinnemoen 1497d2be074SHaavard Skinnemoen struct tasklet_struct tasklet; 1507d2be074SHaavard Skinnemoen unsigned long pending_events; 1517d2be074SHaavard Skinnemoen unsigned long completed_events; 152c06ad258SHaavard Skinnemoen enum atmel_mci_state state; 153965ebf33SHaavard Skinnemoen struct list_head queue; 1547d2be074SHaavard Skinnemoen 155965ebf33SHaavard Skinnemoen bool need_clock_update; 156965ebf33SHaavard Skinnemoen bool need_reset; 157965ebf33SHaavard Skinnemoen u32 mode_reg; 1587d2be074SHaavard Skinnemoen unsigned long bus_hz; 1597d2be074SHaavard Skinnemoen unsigned long mapbase; 1607d2be074SHaavard Skinnemoen struct clk *mck; 1617d2be074SHaavard Skinnemoen struct platform_device *pdev; 162965ebf33SHaavard Skinnemoen 163965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot[ATMEL_MCI_MAX_NR_SLOTS]; 164965ebf33SHaavard Skinnemoen }; 165965ebf33SHaavard Skinnemoen 166965ebf33SHaavard Skinnemoen /** 167965ebf33SHaavard Skinnemoen * struct atmel_mci_slot - MMC slot state 168965ebf33SHaavard Skinnemoen * @mmc: The mmc_host representing this slot. 169965ebf33SHaavard Skinnemoen * @host: The MMC controller this slot is using. 170965ebf33SHaavard Skinnemoen * @sdc_reg: Value of SDCR to be written before using this slot. 171965ebf33SHaavard Skinnemoen * @mrq: mmc_request currently being processed or waiting to be 172965ebf33SHaavard Skinnemoen * processed, or NULL when the slot is idle. 173965ebf33SHaavard Skinnemoen * @queue_node: List node for placing this node in the @queue list of 174965ebf33SHaavard Skinnemoen * &struct atmel_mci. 175965ebf33SHaavard Skinnemoen * @clock: Clock rate configured by set_ios(). Protected by host->lock. 176965ebf33SHaavard Skinnemoen * @flags: Random state bits associated with the slot. 177965ebf33SHaavard Skinnemoen * @detect_pin: GPIO pin used for card detection, or negative if not 178965ebf33SHaavard Skinnemoen * available. 179965ebf33SHaavard Skinnemoen * @wp_pin: GPIO pin used for card write protect sending, or negative 180965ebf33SHaavard Skinnemoen * if not available. 181965ebf33SHaavard Skinnemoen * @detect_timer: Timer used for debouncing @detect_pin interrupts. 182965ebf33SHaavard Skinnemoen */ 183965ebf33SHaavard Skinnemoen struct atmel_mci_slot { 184965ebf33SHaavard Skinnemoen struct mmc_host *mmc; 185965ebf33SHaavard Skinnemoen struct atmel_mci *host; 186965ebf33SHaavard Skinnemoen 187965ebf33SHaavard Skinnemoen u32 sdc_reg; 188965ebf33SHaavard Skinnemoen 189965ebf33SHaavard Skinnemoen struct mmc_request *mrq; 190965ebf33SHaavard Skinnemoen struct list_head queue_node; 191965ebf33SHaavard Skinnemoen 192965ebf33SHaavard Skinnemoen unsigned int clock; 193965ebf33SHaavard Skinnemoen unsigned long flags; 194965ebf33SHaavard Skinnemoen #define ATMCI_CARD_PRESENT 0 195965ebf33SHaavard Skinnemoen #define ATMCI_CARD_NEED_INIT 1 196965ebf33SHaavard Skinnemoen #define ATMCI_SHUTDOWN 2 197965ebf33SHaavard Skinnemoen 198965ebf33SHaavard Skinnemoen int detect_pin; 199965ebf33SHaavard Skinnemoen int wp_pin; 200965ebf33SHaavard Skinnemoen 201965ebf33SHaavard Skinnemoen struct timer_list detect_timer; 2027d2be074SHaavard Skinnemoen }; 2037d2be074SHaavard Skinnemoen 2047d2be074SHaavard Skinnemoen #define atmci_test_and_clear_pending(host, event) \ 2057d2be074SHaavard Skinnemoen test_and_clear_bit(event, &host->pending_events) 2067d2be074SHaavard Skinnemoen #define atmci_set_completed(host, event) \ 2077d2be074SHaavard Skinnemoen set_bit(event, &host->completed_events) 2087d2be074SHaavard Skinnemoen #define atmci_set_pending(host, event) \ 2097d2be074SHaavard Skinnemoen set_bit(event, &host->pending_events) 2107d2be074SHaavard Skinnemoen 211deec9ae3SHaavard Skinnemoen /* 212deec9ae3SHaavard Skinnemoen * The debugfs stuff below is mostly optimized away when 213deec9ae3SHaavard Skinnemoen * CONFIG_DEBUG_FS is not set. 214deec9ae3SHaavard Skinnemoen */ 215deec9ae3SHaavard Skinnemoen static int atmci_req_show(struct seq_file *s, void *v) 216deec9ae3SHaavard Skinnemoen { 217965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = s->private; 218965ebf33SHaavard Skinnemoen struct mmc_request *mrq; 219deec9ae3SHaavard Skinnemoen struct mmc_command *cmd; 220deec9ae3SHaavard Skinnemoen struct mmc_command *stop; 221deec9ae3SHaavard Skinnemoen struct mmc_data *data; 222deec9ae3SHaavard Skinnemoen 223deec9ae3SHaavard Skinnemoen /* Make sure we get a consistent snapshot */ 224965ebf33SHaavard Skinnemoen spin_lock_bh(&slot->host->lock); 225965ebf33SHaavard Skinnemoen mrq = slot->mrq; 226deec9ae3SHaavard Skinnemoen 227deec9ae3SHaavard Skinnemoen if (mrq) { 228deec9ae3SHaavard Skinnemoen cmd = mrq->cmd; 229deec9ae3SHaavard Skinnemoen data = mrq->data; 230deec9ae3SHaavard Skinnemoen stop = mrq->stop; 231deec9ae3SHaavard Skinnemoen 232deec9ae3SHaavard Skinnemoen if (cmd) 233deec9ae3SHaavard Skinnemoen seq_printf(s, 234deec9ae3SHaavard Skinnemoen "CMD%u(0x%x) flg %x rsp %x %x %x %x err %d\n", 235deec9ae3SHaavard Skinnemoen cmd->opcode, cmd->arg, cmd->flags, 236deec9ae3SHaavard Skinnemoen cmd->resp[0], cmd->resp[1], cmd->resp[2], 237deec9ae3SHaavard Skinnemoen cmd->resp[2], cmd->error); 238deec9ae3SHaavard Skinnemoen if (data) 239deec9ae3SHaavard Skinnemoen seq_printf(s, "DATA %u / %u * %u flg %x err %d\n", 240deec9ae3SHaavard Skinnemoen data->bytes_xfered, data->blocks, 241deec9ae3SHaavard Skinnemoen data->blksz, data->flags, data->error); 242deec9ae3SHaavard Skinnemoen if (stop) 243deec9ae3SHaavard Skinnemoen seq_printf(s, 244deec9ae3SHaavard Skinnemoen "CMD%u(0x%x) flg %x rsp %x %x %x %x err %d\n", 245deec9ae3SHaavard Skinnemoen stop->opcode, stop->arg, stop->flags, 246deec9ae3SHaavard Skinnemoen stop->resp[0], stop->resp[1], stop->resp[2], 247deec9ae3SHaavard Skinnemoen stop->resp[2], stop->error); 248deec9ae3SHaavard Skinnemoen } 249deec9ae3SHaavard Skinnemoen 250965ebf33SHaavard Skinnemoen spin_unlock_bh(&slot->host->lock); 251deec9ae3SHaavard Skinnemoen 252deec9ae3SHaavard Skinnemoen return 0; 253deec9ae3SHaavard Skinnemoen } 254deec9ae3SHaavard Skinnemoen 255deec9ae3SHaavard Skinnemoen static int atmci_req_open(struct inode *inode, struct file *file) 256deec9ae3SHaavard Skinnemoen { 257deec9ae3SHaavard Skinnemoen return single_open(file, atmci_req_show, inode->i_private); 258deec9ae3SHaavard Skinnemoen } 259deec9ae3SHaavard Skinnemoen 260deec9ae3SHaavard Skinnemoen static const struct file_operations atmci_req_fops = { 261deec9ae3SHaavard Skinnemoen .owner = THIS_MODULE, 262deec9ae3SHaavard Skinnemoen .open = atmci_req_open, 263deec9ae3SHaavard Skinnemoen .read = seq_read, 264deec9ae3SHaavard Skinnemoen .llseek = seq_lseek, 265deec9ae3SHaavard Skinnemoen .release = single_release, 266deec9ae3SHaavard Skinnemoen }; 267deec9ae3SHaavard Skinnemoen 268deec9ae3SHaavard Skinnemoen static void atmci_show_status_reg(struct seq_file *s, 269deec9ae3SHaavard Skinnemoen const char *regname, u32 value) 270deec9ae3SHaavard Skinnemoen { 271deec9ae3SHaavard Skinnemoen static const char *sr_bit[] = { 272deec9ae3SHaavard Skinnemoen [0] = "CMDRDY", 273deec9ae3SHaavard Skinnemoen [1] = "RXRDY", 274deec9ae3SHaavard Skinnemoen [2] = "TXRDY", 275deec9ae3SHaavard Skinnemoen [3] = "BLKE", 276deec9ae3SHaavard Skinnemoen [4] = "DTIP", 277deec9ae3SHaavard Skinnemoen [5] = "NOTBUSY", 278deec9ae3SHaavard Skinnemoen [8] = "SDIOIRQA", 279deec9ae3SHaavard Skinnemoen [9] = "SDIOIRQB", 280deec9ae3SHaavard Skinnemoen [16] = "RINDE", 281deec9ae3SHaavard Skinnemoen [17] = "RDIRE", 282deec9ae3SHaavard Skinnemoen [18] = "RCRCE", 283deec9ae3SHaavard Skinnemoen [19] = "RENDE", 284deec9ae3SHaavard Skinnemoen [20] = "RTOE", 285deec9ae3SHaavard Skinnemoen [21] = "DCRCE", 286deec9ae3SHaavard Skinnemoen [22] = "DTOE", 287deec9ae3SHaavard Skinnemoen [30] = "OVRE", 288deec9ae3SHaavard Skinnemoen [31] = "UNRE", 289deec9ae3SHaavard Skinnemoen }; 290deec9ae3SHaavard Skinnemoen unsigned int i; 291deec9ae3SHaavard Skinnemoen 292deec9ae3SHaavard Skinnemoen seq_printf(s, "%s:\t0x%08x", regname, value); 293deec9ae3SHaavard Skinnemoen for (i = 0; i < ARRAY_SIZE(sr_bit); i++) { 294deec9ae3SHaavard Skinnemoen if (value & (1 << i)) { 295deec9ae3SHaavard Skinnemoen if (sr_bit[i]) 296deec9ae3SHaavard Skinnemoen seq_printf(s, " %s", sr_bit[i]); 297deec9ae3SHaavard Skinnemoen else 298deec9ae3SHaavard Skinnemoen seq_puts(s, " UNKNOWN"); 299deec9ae3SHaavard Skinnemoen } 300deec9ae3SHaavard Skinnemoen } 301deec9ae3SHaavard Skinnemoen seq_putc(s, '\n'); 302deec9ae3SHaavard Skinnemoen } 303deec9ae3SHaavard Skinnemoen 304deec9ae3SHaavard Skinnemoen static int atmci_regs_show(struct seq_file *s, void *v) 305deec9ae3SHaavard Skinnemoen { 306deec9ae3SHaavard Skinnemoen struct atmel_mci *host = s->private; 307deec9ae3SHaavard Skinnemoen u32 *buf; 308deec9ae3SHaavard Skinnemoen 309deec9ae3SHaavard Skinnemoen buf = kmalloc(MCI_REGS_SIZE, GFP_KERNEL); 310deec9ae3SHaavard Skinnemoen if (!buf) 311deec9ae3SHaavard Skinnemoen return -ENOMEM; 312deec9ae3SHaavard Skinnemoen 313965ebf33SHaavard Skinnemoen /* 314965ebf33SHaavard Skinnemoen * Grab a more or less consistent snapshot. Note that we're 315965ebf33SHaavard Skinnemoen * not disabling interrupts, so IMR and SR may not be 316965ebf33SHaavard Skinnemoen * consistent. 317965ebf33SHaavard Skinnemoen */ 318965ebf33SHaavard Skinnemoen spin_lock_bh(&host->lock); 31987e60f2bSHaavard Skinnemoen clk_enable(host->mck); 320deec9ae3SHaavard Skinnemoen memcpy_fromio(buf, host->regs, MCI_REGS_SIZE); 32187e60f2bSHaavard Skinnemoen clk_disable(host->mck); 322965ebf33SHaavard Skinnemoen spin_unlock_bh(&host->lock); 323deec9ae3SHaavard Skinnemoen 324deec9ae3SHaavard Skinnemoen seq_printf(s, "MR:\t0x%08x%s%s CLKDIV=%u\n", 325deec9ae3SHaavard Skinnemoen buf[MCI_MR / 4], 326deec9ae3SHaavard Skinnemoen buf[MCI_MR / 4] & MCI_MR_RDPROOF ? " RDPROOF" : "", 327deec9ae3SHaavard Skinnemoen buf[MCI_MR / 4] & MCI_MR_WRPROOF ? " WRPROOF" : "", 328deec9ae3SHaavard Skinnemoen buf[MCI_MR / 4] & 0xff); 329deec9ae3SHaavard Skinnemoen seq_printf(s, "DTOR:\t0x%08x\n", buf[MCI_DTOR / 4]); 330deec9ae3SHaavard Skinnemoen seq_printf(s, "SDCR:\t0x%08x\n", buf[MCI_SDCR / 4]); 331deec9ae3SHaavard Skinnemoen seq_printf(s, "ARGR:\t0x%08x\n", buf[MCI_ARGR / 4]); 332deec9ae3SHaavard Skinnemoen seq_printf(s, "BLKR:\t0x%08x BCNT=%u BLKLEN=%u\n", 333deec9ae3SHaavard Skinnemoen buf[MCI_BLKR / 4], 334deec9ae3SHaavard Skinnemoen buf[MCI_BLKR / 4] & 0xffff, 335deec9ae3SHaavard Skinnemoen (buf[MCI_BLKR / 4] >> 16) & 0xffff); 336deec9ae3SHaavard Skinnemoen 337deec9ae3SHaavard Skinnemoen /* Don't read RSPR and RDR; it will consume the data there */ 338deec9ae3SHaavard Skinnemoen 339deec9ae3SHaavard Skinnemoen atmci_show_status_reg(s, "SR", buf[MCI_SR / 4]); 340deec9ae3SHaavard Skinnemoen atmci_show_status_reg(s, "IMR", buf[MCI_IMR / 4]); 341deec9ae3SHaavard Skinnemoen 342b17339a1SHaavard Skinnemoen kfree(buf); 343b17339a1SHaavard Skinnemoen 344deec9ae3SHaavard Skinnemoen return 0; 345deec9ae3SHaavard Skinnemoen } 346deec9ae3SHaavard Skinnemoen 347deec9ae3SHaavard Skinnemoen static int atmci_regs_open(struct inode *inode, struct file *file) 348deec9ae3SHaavard Skinnemoen { 349deec9ae3SHaavard Skinnemoen return single_open(file, atmci_regs_show, inode->i_private); 350deec9ae3SHaavard Skinnemoen } 351deec9ae3SHaavard Skinnemoen 352deec9ae3SHaavard Skinnemoen static const struct file_operations atmci_regs_fops = { 353deec9ae3SHaavard Skinnemoen .owner = THIS_MODULE, 354deec9ae3SHaavard Skinnemoen .open = atmci_regs_open, 355deec9ae3SHaavard Skinnemoen .read = seq_read, 356deec9ae3SHaavard Skinnemoen .llseek = seq_lseek, 357deec9ae3SHaavard Skinnemoen .release = single_release, 358deec9ae3SHaavard Skinnemoen }; 359deec9ae3SHaavard Skinnemoen 360965ebf33SHaavard Skinnemoen static void atmci_init_debugfs(struct atmel_mci_slot *slot) 361deec9ae3SHaavard Skinnemoen { 362965ebf33SHaavard Skinnemoen struct mmc_host *mmc = slot->mmc; 363965ebf33SHaavard Skinnemoen struct atmel_mci *host = slot->host; 364deec9ae3SHaavard Skinnemoen struct dentry *root; 365deec9ae3SHaavard Skinnemoen struct dentry *node; 366deec9ae3SHaavard Skinnemoen 367deec9ae3SHaavard Skinnemoen root = mmc->debugfs_root; 368deec9ae3SHaavard Skinnemoen if (!root) 369deec9ae3SHaavard Skinnemoen return; 370deec9ae3SHaavard Skinnemoen 371deec9ae3SHaavard Skinnemoen node = debugfs_create_file("regs", S_IRUSR, root, host, 372deec9ae3SHaavard Skinnemoen &atmci_regs_fops); 373deec9ae3SHaavard Skinnemoen if (IS_ERR(node)) 374deec9ae3SHaavard Skinnemoen return; 375deec9ae3SHaavard Skinnemoen if (!node) 376deec9ae3SHaavard Skinnemoen goto err; 377deec9ae3SHaavard Skinnemoen 378965ebf33SHaavard Skinnemoen node = debugfs_create_file("req", S_IRUSR, root, slot, &atmci_req_fops); 379deec9ae3SHaavard Skinnemoen if (!node) 380deec9ae3SHaavard Skinnemoen goto err; 381deec9ae3SHaavard Skinnemoen 382c06ad258SHaavard Skinnemoen node = debugfs_create_u32("state", S_IRUSR, root, (u32 *)&host->state); 383c06ad258SHaavard Skinnemoen if (!node) 384c06ad258SHaavard Skinnemoen goto err; 385c06ad258SHaavard Skinnemoen 386deec9ae3SHaavard Skinnemoen node = debugfs_create_x32("pending_events", S_IRUSR, root, 387deec9ae3SHaavard Skinnemoen (u32 *)&host->pending_events); 388deec9ae3SHaavard Skinnemoen if (!node) 389deec9ae3SHaavard Skinnemoen goto err; 390deec9ae3SHaavard Skinnemoen 391deec9ae3SHaavard Skinnemoen node = debugfs_create_x32("completed_events", S_IRUSR, root, 392deec9ae3SHaavard Skinnemoen (u32 *)&host->completed_events); 393deec9ae3SHaavard Skinnemoen if (!node) 394deec9ae3SHaavard Skinnemoen goto err; 395deec9ae3SHaavard Skinnemoen 396deec9ae3SHaavard Skinnemoen return; 397deec9ae3SHaavard Skinnemoen 398deec9ae3SHaavard Skinnemoen err: 399965ebf33SHaavard Skinnemoen dev_err(&mmc->class_dev, "failed to initialize debugfs for slot\n"); 400deec9ae3SHaavard Skinnemoen } 4017d2be074SHaavard Skinnemoen 4027d2be074SHaavard Skinnemoen static inline unsigned int ns_to_clocks(struct atmel_mci *host, 4037d2be074SHaavard Skinnemoen unsigned int ns) 4047d2be074SHaavard Skinnemoen { 4057d2be074SHaavard Skinnemoen return (ns * (host->bus_hz / 1000000) + 999) / 1000; 4067d2be074SHaavard Skinnemoen } 4077d2be074SHaavard Skinnemoen 4087d2be074SHaavard Skinnemoen static void atmci_set_timeout(struct atmel_mci *host, 409965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot, struct mmc_data *data) 4107d2be074SHaavard Skinnemoen { 4117d2be074SHaavard Skinnemoen static unsigned dtomul_to_shift[] = { 4127d2be074SHaavard Skinnemoen 0, 4, 7, 8, 10, 12, 16, 20 4137d2be074SHaavard Skinnemoen }; 4147d2be074SHaavard Skinnemoen unsigned timeout; 4157d2be074SHaavard Skinnemoen unsigned dtocyc; 4167d2be074SHaavard Skinnemoen unsigned dtomul; 4177d2be074SHaavard Skinnemoen 4187d2be074SHaavard Skinnemoen timeout = ns_to_clocks(host, data->timeout_ns) + data->timeout_clks; 4197d2be074SHaavard Skinnemoen 4207d2be074SHaavard Skinnemoen for (dtomul = 0; dtomul < 8; dtomul++) { 4217d2be074SHaavard Skinnemoen unsigned shift = dtomul_to_shift[dtomul]; 4227d2be074SHaavard Skinnemoen dtocyc = (timeout + (1 << shift) - 1) >> shift; 4237d2be074SHaavard Skinnemoen if (dtocyc < 15) 4247d2be074SHaavard Skinnemoen break; 4257d2be074SHaavard Skinnemoen } 4267d2be074SHaavard Skinnemoen 4277d2be074SHaavard Skinnemoen if (dtomul >= 8) { 4287d2be074SHaavard Skinnemoen dtomul = 7; 4297d2be074SHaavard Skinnemoen dtocyc = 15; 4307d2be074SHaavard Skinnemoen } 4317d2be074SHaavard Skinnemoen 432965ebf33SHaavard Skinnemoen dev_vdbg(&slot->mmc->class_dev, "setting timeout to %u cycles\n", 4337d2be074SHaavard Skinnemoen dtocyc << dtomul_to_shift[dtomul]); 4347d2be074SHaavard Skinnemoen mci_writel(host, DTOR, (MCI_DTOMUL(dtomul) | MCI_DTOCYC(dtocyc))); 4357d2be074SHaavard Skinnemoen } 4367d2be074SHaavard Skinnemoen 4377d2be074SHaavard Skinnemoen /* 4387d2be074SHaavard Skinnemoen * Return mask with command flags to be enabled for this command. 4397d2be074SHaavard Skinnemoen */ 4407d2be074SHaavard Skinnemoen static u32 atmci_prepare_command(struct mmc_host *mmc, 4417d2be074SHaavard Skinnemoen struct mmc_command *cmd) 4427d2be074SHaavard Skinnemoen { 4437d2be074SHaavard Skinnemoen struct mmc_data *data; 4447d2be074SHaavard Skinnemoen u32 cmdr; 4457d2be074SHaavard Skinnemoen 4467d2be074SHaavard Skinnemoen cmd->error = -EINPROGRESS; 4477d2be074SHaavard Skinnemoen 4487d2be074SHaavard Skinnemoen cmdr = MCI_CMDR_CMDNB(cmd->opcode); 4497d2be074SHaavard Skinnemoen 4507d2be074SHaavard Skinnemoen if (cmd->flags & MMC_RSP_PRESENT) { 4517d2be074SHaavard Skinnemoen if (cmd->flags & MMC_RSP_136) 4527d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_RSPTYP_136BIT; 4537d2be074SHaavard Skinnemoen else 4547d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_RSPTYP_48BIT; 4557d2be074SHaavard Skinnemoen } 4567d2be074SHaavard Skinnemoen 4577d2be074SHaavard Skinnemoen /* 4587d2be074SHaavard Skinnemoen * This should really be MAXLAT_5 for CMD2 and ACMD41, but 4597d2be074SHaavard Skinnemoen * it's too difficult to determine whether this is an ACMD or 4607d2be074SHaavard Skinnemoen * not. Better make it 64. 4617d2be074SHaavard Skinnemoen */ 4627d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_MAXLAT_64CYC; 4637d2be074SHaavard Skinnemoen 4647d2be074SHaavard Skinnemoen if (mmc->ios.bus_mode == MMC_BUSMODE_OPENDRAIN) 4657d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_OPDCMD; 4667d2be074SHaavard Skinnemoen 4677d2be074SHaavard Skinnemoen data = cmd->data; 4687d2be074SHaavard Skinnemoen if (data) { 4697d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_START_XFER; 4707d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_STREAM) 4717d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_STREAM; 4727d2be074SHaavard Skinnemoen else if (data->blocks > 1) 4737d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_MULTI_BLOCK; 4747d2be074SHaavard Skinnemoen else 4757d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_BLOCK; 4767d2be074SHaavard Skinnemoen 4777d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_READ) 4787d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_TRDIR_READ; 4797d2be074SHaavard Skinnemoen } 4807d2be074SHaavard Skinnemoen 4817d2be074SHaavard Skinnemoen return cmdr; 4827d2be074SHaavard Skinnemoen } 4837d2be074SHaavard Skinnemoen 4847d2be074SHaavard Skinnemoen static void atmci_start_command(struct atmel_mci *host, 485965ebf33SHaavard Skinnemoen struct mmc_command *cmd, u32 cmd_flags) 4867d2be074SHaavard Skinnemoen { 4877d2be074SHaavard Skinnemoen WARN_ON(host->cmd); 4887d2be074SHaavard Skinnemoen host->cmd = cmd; 4897d2be074SHaavard Skinnemoen 490965ebf33SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, 4917d2be074SHaavard Skinnemoen "start command: ARGR=0x%08x CMDR=0x%08x\n", 4927d2be074SHaavard Skinnemoen cmd->arg, cmd_flags); 4937d2be074SHaavard Skinnemoen 4947d2be074SHaavard Skinnemoen mci_writel(host, ARGR, cmd->arg); 4957d2be074SHaavard Skinnemoen mci_writel(host, CMDR, cmd_flags); 4967d2be074SHaavard Skinnemoen } 4977d2be074SHaavard Skinnemoen 498965ebf33SHaavard Skinnemoen static void send_stop_cmd(struct atmel_mci *host, struct mmc_data *data) 4997d2be074SHaavard Skinnemoen { 5007d2be074SHaavard Skinnemoen atmci_start_command(host, data->stop, host->stop_cmdr); 5017d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_CMDRDY); 5027d2be074SHaavard Skinnemoen } 5037d2be074SHaavard Skinnemoen 50465e8b083SHaavard Skinnemoen #ifdef CONFIG_MMC_ATMELMCI_DMA 50565e8b083SHaavard Skinnemoen static void atmci_dma_cleanup(struct atmel_mci *host) 50665e8b083SHaavard Skinnemoen { 50765e8b083SHaavard Skinnemoen struct mmc_data *data = host->data; 50865e8b083SHaavard Skinnemoen 50965e8b083SHaavard Skinnemoen dma_unmap_sg(&host->pdev->dev, data->sg, data->sg_len, 51065e8b083SHaavard Skinnemoen ((data->flags & MMC_DATA_WRITE) 51165e8b083SHaavard Skinnemoen ? DMA_TO_DEVICE : DMA_FROM_DEVICE)); 51265e8b083SHaavard Skinnemoen } 51365e8b083SHaavard Skinnemoen 51465e8b083SHaavard Skinnemoen static void atmci_stop_dma(struct atmel_mci *host) 51565e8b083SHaavard Skinnemoen { 51665e8b083SHaavard Skinnemoen struct dma_chan *chan = host->data_chan; 51765e8b083SHaavard Skinnemoen 51865e8b083SHaavard Skinnemoen if (chan) { 51965e8b083SHaavard Skinnemoen chan->device->device_terminate_all(chan); 52065e8b083SHaavard Skinnemoen atmci_dma_cleanup(host); 52165e8b083SHaavard Skinnemoen } else { 52265e8b083SHaavard Skinnemoen /* Data transfer was stopped by the interrupt handler */ 52365e8b083SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 52465e8b083SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 52565e8b083SHaavard Skinnemoen } 52665e8b083SHaavard Skinnemoen } 52765e8b083SHaavard Skinnemoen 52865e8b083SHaavard Skinnemoen /* This function is called by the DMA driver from tasklet context. */ 52965e8b083SHaavard Skinnemoen static void atmci_dma_complete(void *arg) 53065e8b083SHaavard Skinnemoen { 53165e8b083SHaavard Skinnemoen struct atmel_mci *host = arg; 53265e8b083SHaavard Skinnemoen struct mmc_data *data = host->data; 53365e8b083SHaavard Skinnemoen 53465e8b083SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, "DMA complete\n"); 53565e8b083SHaavard Skinnemoen 53665e8b083SHaavard Skinnemoen atmci_dma_cleanup(host); 53765e8b083SHaavard Skinnemoen 53865e8b083SHaavard Skinnemoen /* 53965e8b083SHaavard Skinnemoen * If the card was removed, data will be NULL. No point trying 54065e8b083SHaavard Skinnemoen * to send the stop command or waiting for NBUSY in this case. 54165e8b083SHaavard Skinnemoen */ 54265e8b083SHaavard Skinnemoen if (data) { 54365e8b083SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 54465e8b083SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 54565e8b083SHaavard Skinnemoen 54665e8b083SHaavard Skinnemoen /* 54765e8b083SHaavard Skinnemoen * Regardless of what the documentation says, we have 54865e8b083SHaavard Skinnemoen * to wait for NOTBUSY even after block read 54965e8b083SHaavard Skinnemoen * operations. 55065e8b083SHaavard Skinnemoen * 55165e8b083SHaavard Skinnemoen * When the DMA transfer is complete, the controller 55265e8b083SHaavard Skinnemoen * may still be reading the CRC from the card, i.e. 55365e8b083SHaavard Skinnemoen * the data transfer is still in progress and we 55465e8b083SHaavard Skinnemoen * haven't seen all the potential error bits yet. 55565e8b083SHaavard Skinnemoen * 55665e8b083SHaavard Skinnemoen * The interrupt handler will schedule a different 55765e8b083SHaavard Skinnemoen * tasklet to finish things up when the data transfer 55865e8b083SHaavard Skinnemoen * is completely done. 55965e8b083SHaavard Skinnemoen * 56065e8b083SHaavard Skinnemoen * We may not complete the mmc request here anyway 56165e8b083SHaavard Skinnemoen * because the mmc layer may call back and cause us to 56265e8b083SHaavard Skinnemoen * violate the "don't submit new operations from the 56365e8b083SHaavard Skinnemoen * completion callback" rule of the dma engine 56465e8b083SHaavard Skinnemoen * framework. 56565e8b083SHaavard Skinnemoen */ 56665e8b083SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 56765e8b083SHaavard Skinnemoen } 56865e8b083SHaavard Skinnemoen } 56965e8b083SHaavard Skinnemoen 57065e8b083SHaavard Skinnemoen static int 57165e8b083SHaavard Skinnemoen atmci_submit_data_dma(struct atmel_mci *host, struct mmc_data *data) 57265e8b083SHaavard Skinnemoen { 57365e8b083SHaavard Skinnemoen struct dma_chan *chan; 57465e8b083SHaavard Skinnemoen struct dma_async_tx_descriptor *desc; 57565e8b083SHaavard Skinnemoen struct scatterlist *sg; 57665e8b083SHaavard Skinnemoen unsigned int i; 57765e8b083SHaavard Skinnemoen enum dma_data_direction direction; 57865e8b083SHaavard Skinnemoen 57965e8b083SHaavard Skinnemoen /* 58065e8b083SHaavard Skinnemoen * We don't do DMA on "complex" transfers, i.e. with 58165e8b083SHaavard Skinnemoen * non-word-aligned buffers or lengths. Also, we don't bother 58265e8b083SHaavard Skinnemoen * with all the DMA setup overhead for short transfers. 58365e8b083SHaavard Skinnemoen */ 58465e8b083SHaavard Skinnemoen if (data->blocks * data->blksz < ATMCI_DMA_THRESHOLD) 58565e8b083SHaavard Skinnemoen return -EINVAL; 58665e8b083SHaavard Skinnemoen if (data->blksz & 3) 58765e8b083SHaavard Skinnemoen return -EINVAL; 58865e8b083SHaavard Skinnemoen 58965e8b083SHaavard Skinnemoen for_each_sg(data->sg, sg, data->sg_len, i) { 59065e8b083SHaavard Skinnemoen if (sg->offset & 3 || sg->length & 3) 59165e8b083SHaavard Skinnemoen return -EINVAL; 59265e8b083SHaavard Skinnemoen } 59365e8b083SHaavard Skinnemoen 59465e8b083SHaavard Skinnemoen /* If we don't have a channel, we can't do DMA */ 59565e8b083SHaavard Skinnemoen chan = host->dma.chan; 5966f49a57aSDan Williams if (chan) 59765e8b083SHaavard Skinnemoen host->data_chan = chan; 59865e8b083SHaavard Skinnemoen 59965e8b083SHaavard Skinnemoen if (!chan) 60065e8b083SHaavard Skinnemoen return -ENODEV; 60165e8b083SHaavard Skinnemoen 60265e8b083SHaavard Skinnemoen if (data->flags & MMC_DATA_READ) 60365e8b083SHaavard Skinnemoen direction = DMA_FROM_DEVICE; 60465e8b083SHaavard Skinnemoen else 60565e8b083SHaavard Skinnemoen direction = DMA_TO_DEVICE; 60665e8b083SHaavard Skinnemoen 60765e8b083SHaavard Skinnemoen desc = chan->device->device_prep_slave_sg(chan, 60865e8b083SHaavard Skinnemoen data->sg, data->sg_len, direction, 60965e8b083SHaavard Skinnemoen DMA_PREP_INTERRUPT | DMA_CTRL_ACK); 61065e8b083SHaavard Skinnemoen if (!desc) 61165e8b083SHaavard Skinnemoen return -ENOMEM; 61265e8b083SHaavard Skinnemoen 61365e8b083SHaavard Skinnemoen host->dma.data_desc = desc; 61465e8b083SHaavard Skinnemoen desc->callback = atmci_dma_complete; 61565e8b083SHaavard Skinnemoen desc->callback_param = host; 61665e8b083SHaavard Skinnemoen desc->tx_submit(desc); 61765e8b083SHaavard Skinnemoen 61865e8b083SHaavard Skinnemoen /* Go! */ 61965e8b083SHaavard Skinnemoen chan->device->device_issue_pending(chan); 62065e8b083SHaavard Skinnemoen 62165e8b083SHaavard Skinnemoen return 0; 62265e8b083SHaavard Skinnemoen } 62365e8b083SHaavard Skinnemoen 62465e8b083SHaavard Skinnemoen #else /* CONFIG_MMC_ATMELMCI_DMA */ 62565e8b083SHaavard Skinnemoen 62665e8b083SHaavard Skinnemoen static int atmci_submit_data_dma(struct atmel_mci *host, struct mmc_data *data) 62765e8b083SHaavard Skinnemoen { 62865e8b083SHaavard Skinnemoen return -ENOSYS; 62965e8b083SHaavard Skinnemoen } 63065e8b083SHaavard Skinnemoen 63165e8b083SHaavard Skinnemoen static void atmci_stop_dma(struct atmel_mci *host) 63265e8b083SHaavard Skinnemoen { 63365e8b083SHaavard Skinnemoen /* Data transfer was stopped by the interrupt handler */ 63465e8b083SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 63565e8b083SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 63665e8b083SHaavard Skinnemoen } 63765e8b083SHaavard Skinnemoen 63865e8b083SHaavard Skinnemoen #endif /* CONFIG_MMC_ATMELMCI_DMA */ 63965e8b083SHaavard Skinnemoen 6407d2be074SHaavard Skinnemoen /* 6417d2be074SHaavard Skinnemoen * Returns a mask of interrupt flags to be enabled after the whole 6427d2be074SHaavard Skinnemoen * request has been prepared. 6437d2be074SHaavard Skinnemoen */ 644965ebf33SHaavard Skinnemoen static u32 atmci_submit_data(struct atmel_mci *host, struct mmc_data *data) 6457d2be074SHaavard Skinnemoen { 6467d2be074SHaavard Skinnemoen u32 iflags; 6477d2be074SHaavard Skinnemoen 6487d2be074SHaavard Skinnemoen data->error = -EINPROGRESS; 6497d2be074SHaavard Skinnemoen 6507d2be074SHaavard Skinnemoen WARN_ON(host->data); 6517d2be074SHaavard Skinnemoen host->sg = NULL; 6527d2be074SHaavard Skinnemoen host->data = data; 6537d2be074SHaavard Skinnemoen 6547d2be074SHaavard Skinnemoen iflags = ATMCI_DATA_ERROR_FLAGS; 65565e8b083SHaavard Skinnemoen if (atmci_submit_data_dma(host, data)) { 65665e8b083SHaavard Skinnemoen host->data_chan = NULL; 657965ebf33SHaavard Skinnemoen 658965ebf33SHaavard Skinnemoen /* 659965ebf33SHaavard Skinnemoen * Errata: MMC data write operation with less than 12 660965ebf33SHaavard Skinnemoen * bytes is impossible. 661965ebf33SHaavard Skinnemoen * 662965ebf33SHaavard Skinnemoen * Errata: MCI Transmit Data Register (TDR) FIFO 663965ebf33SHaavard Skinnemoen * corruption when length is not multiple of 4. 664965ebf33SHaavard Skinnemoen */ 665965ebf33SHaavard Skinnemoen if (data->blocks * data->blksz < 12 666965ebf33SHaavard Skinnemoen || (data->blocks * data->blksz) & 3) 667965ebf33SHaavard Skinnemoen host->need_reset = true; 668965ebf33SHaavard Skinnemoen 6697d2be074SHaavard Skinnemoen host->sg = data->sg; 6707d2be074SHaavard Skinnemoen host->pio_offset = 0; 6717d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_READ) 6727d2be074SHaavard Skinnemoen iflags |= MCI_RXRDY; 6737d2be074SHaavard Skinnemoen else 6747d2be074SHaavard Skinnemoen iflags |= MCI_TXRDY; 67565e8b083SHaavard Skinnemoen } 6767d2be074SHaavard Skinnemoen 6777d2be074SHaavard Skinnemoen return iflags; 6787d2be074SHaavard Skinnemoen } 6797d2be074SHaavard Skinnemoen 680965ebf33SHaavard Skinnemoen static void atmci_start_request(struct atmel_mci *host, 681965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot) 6827d2be074SHaavard Skinnemoen { 683965ebf33SHaavard Skinnemoen struct mmc_request *mrq; 6847d2be074SHaavard Skinnemoen struct mmc_command *cmd; 685965ebf33SHaavard Skinnemoen struct mmc_data *data; 6867d2be074SHaavard Skinnemoen u32 iflags; 687965ebf33SHaavard Skinnemoen u32 cmdflags; 688965ebf33SHaavard Skinnemoen 689965ebf33SHaavard Skinnemoen mrq = slot->mrq; 690965ebf33SHaavard Skinnemoen host->cur_slot = slot; 691965ebf33SHaavard Skinnemoen host->mrq = mrq; 692965ebf33SHaavard Skinnemoen 693965ebf33SHaavard Skinnemoen host->pending_events = 0; 694965ebf33SHaavard Skinnemoen host->completed_events = 0; 695ca55f46eSHaavard Skinnemoen host->data_status = 0; 696965ebf33SHaavard Skinnemoen 697965ebf33SHaavard Skinnemoen if (host->need_reset) { 698965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 699965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 700965ebf33SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 701965ebf33SHaavard Skinnemoen host->need_reset = false; 702965ebf33SHaavard Skinnemoen } 703965ebf33SHaavard Skinnemoen mci_writel(host, SDCR, slot->sdc_reg); 7047d2be074SHaavard Skinnemoen 7057d2be074SHaavard Skinnemoen iflags = mci_readl(host, IMR); 7067d2be074SHaavard Skinnemoen if (iflags) 707965ebf33SHaavard Skinnemoen dev_warn(&slot->mmc->class_dev, "WARNING: IMR=0x%08x\n", 708965ebf33SHaavard Skinnemoen iflags); 7097d2be074SHaavard Skinnemoen 710965ebf33SHaavard Skinnemoen if (unlikely(test_and_clear_bit(ATMCI_CARD_NEED_INIT, &slot->flags))) { 711965ebf33SHaavard Skinnemoen /* Send init sequence (74 clock cycles) */ 712965ebf33SHaavard Skinnemoen mci_writel(host, CMDR, MCI_CMDR_SPCMD_INIT); 713965ebf33SHaavard Skinnemoen while (!(mci_readl(host, SR) & MCI_CMDRDY)) 714965ebf33SHaavard Skinnemoen cpu_relax(); 7157d2be074SHaavard Skinnemoen } 7167d2be074SHaavard Skinnemoen data = mrq->data; 7177d2be074SHaavard Skinnemoen if (data) { 718965ebf33SHaavard Skinnemoen atmci_set_timeout(host, slot, data); 719a252e3e3SHaavard Skinnemoen 720a252e3e3SHaavard Skinnemoen /* Must set block count/size before sending command */ 721a252e3e3SHaavard Skinnemoen mci_writel(host, BLKR, MCI_BCNT(data->blocks) 722a252e3e3SHaavard Skinnemoen | MCI_BLKLEN(data->blksz)); 723965ebf33SHaavard Skinnemoen dev_vdbg(&slot->mmc->class_dev, "BLKR=0x%08x\n", 724965ebf33SHaavard Skinnemoen MCI_BCNT(data->blocks) | MCI_BLKLEN(data->blksz)); 7257d2be074SHaavard Skinnemoen } 7267d2be074SHaavard Skinnemoen 7277d2be074SHaavard Skinnemoen iflags = MCI_CMDRDY; 7287d2be074SHaavard Skinnemoen cmd = mrq->cmd; 729965ebf33SHaavard Skinnemoen cmdflags = atmci_prepare_command(slot->mmc, cmd); 7307d2be074SHaavard Skinnemoen atmci_start_command(host, cmd, cmdflags); 7317d2be074SHaavard Skinnemoen 7327d2be074SHaavard Skinnemoen if (data) 733965ebf33SHaavard Skinnemoen iflags |= atmci_submit_data(host, data); 7347d2be074SHaavard Skinnemoen 7357d2be074SHaavard Skinnemoen if (mrq->stop) { 736965ebf33SHaavard Skinnemoen host->stop_cmdr = atmci_prepare_command(slot->mmc, mrq->stop); 7377d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_STOP_XFER; 7387d2be074SHaavard Skinnemoen if (!(data->flags & MMC_DATA_WRITE)) 7397d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_TRDIR_READ; 7407d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_STREAM) 7417d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_STREAM; 7427d2be074SHaavard Skinnemoen else 7437d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_MULTI_BLOCK; 7447d2be074SHaavard Skinnemoen } 7457d2be074SHaavard Skinnemoen 7467d2be074SHaavard Skinnemoen /* 7477d2be074SHaavard Skinnemoen * We could have enabled interrupts earlier, but I suspect 7487d2be074SHaavard Skinnemoen * that would open up a nice can of interesting race 7497d2be074SHaavard Skinnemoen * conditions (e.g. command and data complete, but stop not 7507d2be074SHaavard Skinnemoen * prepared yet.) 7517d2be074SHaavard Skinnemoen */ 7527d2be074SHaavard Skinnemoen mci_writel(host, IER, iflags); 753965ebf33SHaavard Skinnemoen } 7547d2be074SHaavard Skinnemoen 755965ebf33SHaavard Skinnemoen static void atmci_queue_request(struct atmel_mci *host, 756965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot, struct mmc_request *mrq) 757965ebf33SHaavard Skinnemoen { 758965ebf33SHaavard Skinnemoen dev_vdbg(&slot->mmc->class_dev, "queue request: state=%d\n", 759965ebf33SHaavard Skinnemoen host->state); 760965ebf33SHaavard Skinnemoen 761965ebf33SHaavard Skinnemoen spin_lock_bh(&host->lock); 762965ebf33SHaavard Skinnemoen slot->mrq = mrq; 763965ebf33SHaavard Skinnemoen if (host->state == STATE_IDLE) { 764965ebf33SHaavard Skinnemoen host->state = STATE_SENDING_CMD; 765965ebf33SHaavard Skinnemoen atmci_start_request(host, slot); 766965ebf33SHaavard Skinnemoen } else { 767965ebf33SHaavard Skinnemoen list_add_tail(&slot->queue_node, &host->queue); 768965ebf33SHaavard Skinnemoen } 769965ebf33SHaavard Skinnemoen spin_unlock_bh(&host->lock); 770965ebf33SHaavard Skinnemoen } 771965ebf33SHaavard Skinnemoen 772965ebf33SHaavard Skinnemoen static void atmci_request(struct mmc_host *mmc, struct mmc_request *mrq) 773965ebf33SHaavard Skinnemoen { 774965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = mmc_priv(mmc); 775965ebf33SHaavard Skinnemoen struct atmel_mci *host = slot->host; 776965ebf33SHaavard Skinnemoen struct mmc_data *data; 777965ebf33SHaavard Skinnemoen 778965ebf33SHaavard Skinnemoen WARN_ON(slot->mrq); 779965ebf33SHaavard Skinnemoen 780965ebf33SHaavard Skinnemoen /* 781965ebf33SHaavard Skinnemoen * We may "know" the card is gone even though there's still an 782965ebf33SHaavard Skinnemoen * electrical connection. If so, we really need to communicate 783965ebf33SHaavard Skinnemoen * this to the MMC core since there won't be any more 784965ebf33SHaavard Skinnemoen * interrupts as the card is completely removed. Otherwise, 785965ebf33SHaavard Skinnemoen * the MMC core might believe the card is still there even 786965ebf33SHaavard Skinnemoen * though the card was just removed very slowly. 787965ebf33SHaavard Skinnemoen */ 788965ebf33SHaavard Skinnemoen if (!test_bit(ATMCI_CARD_PRESENT, &slot->flags)) { 789965ebf33SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 790965ebf33SHaavard Skinnemoen mmc_request_done(mmc, mrq); 7917d2be074SHaavard Skinnemoen return; 792965ebf33SHaavard Skinnemoen } 7937d2be074SHaavard Skinnemoen 794965ebf33SHaavard Skinnemoen /* We don't support multiple blocks of weird lengths. */ 795965ebf33SHaavard Skinnemoen data = mrq->data; 796965ebf33SHaavard Skinnemoen if (data && data->blocks > 1 && data->blksz & 3) { 7977d2be074SHaavard Skinnemoen mrq->cmd->error = -EINVAL; 7987d2be074SHaavard Skinnemoen mmc_request_done(mmc, mrq); 7997d2be074SHaavard Skinnemoen } 8007d2be074SHaavard Skinnemoen 801965ebf33SHaavard Skinnemoen atmci_queue_request(host, slot, mrq); 802965ebf33SHaavard Skinnemoen } 803965ebf33SHaavard Skinnemoen 8047d2be074SHaavard Skinnemoen static void atmci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) 8057d2be074SHaavard Skinnemoen { 806965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = mmc_priv(mmc); 807965ebf33SHaavard Skinnemoen struct atmel_mci *host = slot->host; 808965ebf33SHaavard Skinnemoen unsigned int i; 8097d2be074SHaavard Skinnemoen 810965ebf33SHaavard Skinnemoen slot->sdc_reg &= ~MCI_SDCBUS_MASK; 811945533b5SHaavard Skinnemoen switch (ios->bus_width) { 812945533b5SHaavard Skinnemoen case MMC_BUS_WIDTH_1: 813965ebf33SHaavard Skinnemoen slot->sdc_reg |= MCI_SDCBUS_1BIT; 814945533b5SHaavard Skinnemoen break; 815945533b5SHaavard Skinnemoen case MMC_BUS_WIDTH_4: 816965ebf33SHaavard Skinnemoen slot->sdc_reg = MCI_SDCBUS_4BIT; 817945533b5SHaavard Skinnemoen break; 818945533b5SHaavard Skinnemoen } 819945533b5SHaavard Skinnemoen 8207d2be074SHaavard Skinnemoen if (ios->clock) { 821965ebf33SHaavard Skinnemoen unsigned int clock_min = ~0U; 8227d2be074SHaavard Skinnemoen u32 clkdiv; 8237d2be074SHaavard Skinnemoen 824965ebf33SHaavard Skinnemoen spin_lock_bh(&host->lock); 825965ebf33SHaavard Skinnemoen if (!host->mode_reg) { 826945533b5SHaavard Skinnemoen clk_enable(host->mck); 827965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 828965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 829965ebf33SHaavard Skinnemoen } 830945533b5SHaavard Skinnemoen 831965ebf33SHaavard Skinnemoen /* 832965ebf33SHaavard Skinnemoen * Use mirror of ios->clock to prevent race with mmc 833965ebf33SHaavard Skinnemoen * core ios update when finding the minimum. 834965ebf33SHaavard Skinnemoen */ 835965ebf33SHaavard Skinnemoen slot->clock = ios->clock; 836965ebf33SHaavard Skinnemoen for (i = 0; i < ATMEL_MCI_MAX_NR_SLOTS; i++) { 837965ebf33SHaavard Skinnemoen if (host->slot[i] && host->slot[i]->clock 838965ebf33SHaavard Skinnemoen && host->slot[i]->clock < clock_min) 839965ebf33SHaavard Skinnemoen clock_min = host->slot[i]->clock; 840965ebf33SHaavard Skinnemoen } 841965ebf33SHaavard Skinnemoen 842965ebf33SHaavard Skinnemoen /* Calculate clock divider */ 843965ebf33SHaavard Skinnemoen clkdiv = DIV_ROUND_UP(host->bus_hz, 2 * clock_min) - 1; 8447d2be074SHaavard Skinnemoen if (clkdiv > 255) { 8457d2be074SHaavard Skinnemoen dev_warn(&mmc->class_dev, 8467d2be074SHaavard Skinnemoen "clock %u too slow; using %lu\n", 847965ebf33SHaavard Skinnemoen clock_min, host->bus_hz / (2 * 256)); 8487d2be074SHaavard Skinnemoen clkdiv = 255; 8497d2be074SHaavard Skinnemoen } 8507d2be074SHaavard Skinnemoen 851965ebf33SHaavard Skinnemoen /* 852965ebf33SHaavard Skinnemoen * WRPROOF and RDPROOF prevent overruns/underruns by 853965ebf33SHaavard Skinnemoen * stopping the clock when the FIFO is full/empty. 854965ebf33SHaavard Skinnemoen * This state is not expected to last for long. 855965ebf33SHaavard Skinnemoen */ 8567d2be074SHaavard Skinnemoen host->mode_reg = MCI_MR_CLKDIV(clkdiv) | MCI_MR_WRPROOF 8577d2be074SHaavard Skinnemoen | MCI_MR_RDPROOF; 8587d2be074SHaavard Skinnemoen 859965ebf33SHaavard Skinnemoen if (list_empty(&host->queue)) 860945533b5SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 861965ebf33SHaavard Skinnemoen else 862965ebf33SHaavard Skinnemoen host->need_clock_update = true; 863965ebf33SHaavard Skinnemoen 864965ebf33SHaavard Skinnemoen spin_unlock_bh(&host->lock); 865945533b5SHaavard Skinnemoen } else { 866965ebf33SHaavard Skinnemoen bool any_slot_active = false; 867965ebf33SHaavard Skinnemoen 868965ebf33SHaavard Skinnemoen spin_lock_bh(&host->lock); 869965ebf33SHaavard Skinnemoen slot->clock = 0; 870965ebf33SHaavard Skinnemoen for (i = 0; i < ATMEL_MCI_MAX_NR_SLOTS; i++) { 871965ebf33SHaavard Skinnemoen if (host->slot[i] && host->slot[i]->clock) { 872965ebf33SHaavard Skinnemoen any_slot_active = true; 873965ebf33SHaavard Skinnemoen break; 874965ebf33SHaavard Skinnemoen } 875965ebf33SHaavard Skinnemoen } 876965ebf33SHaavard Skinnemoen if (!any_slot_active) { 877945533b5SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIDIS); 878945533b5SHaavard Skinnemoen if (host->mode_reg) { 879945533b5SHaavard Skinnemoen mci_readl(host, MR); 880945533b5SHaavard Skinnemoen clk_disable(host->mck); 881945533b5SHaavard Skinnemoen } 882945533b5SHaavard Skinnemoen host->mode_reg = 0; 8837d2be074SHaavard Skinnemoen } 884965ebf33SHaavard Skinnemoen spin_unlock_bh(&host->lock); 885965ebf33SHaavard Skinnemoen } 8867d2be074SHaavard Skinnemoen 8877d2be074SHaavard Skinnemoen switch (ios->power_mode) { 888965ebf33SHaavard Skinnemoen case MMC_POWER_UP: 889965ebf33SHaavard Skinnemoen set_bit(ATMCI_CARD_NEED_INIT, &slot->flags); 890965ebf33SHaavard Skinnemoen break; 8917d2be074SHaavard Skinnemoen default: 8927d2be074SHaavard Skinnemoen /* 8937d2be074SHaavard Skinnemoen * TODO: None of the currently available AVR32-based 8947d2be074SHaavard Skinnemoen * boards allow MMC power to be turned off. Implement 8957d2be074SHaavard Skinnemoen * power control when this can be tested properly. 896965ebf33SHaavard Skinnemoen * 897965ebf33SHaavard Skinnemoen * We also need to hook this into the clock management 898965ebf33SHaavard Skinnemoen * somehow so that newly inserted cards aren't 899965ebf33SHaavard Skinnemoen * subjected to a fast clock before we have a chance 900965ebf33SHaavard Skinnemoen * to figure out what the maximum rate is. Currently, 901965ebf33SHaavard Skinnemoen * there's no way to avoid this, and there never will 902965ebf33SHaavard Skinnemoen * be for boards that don't support power control. 9037d2be074SHaavard Skinnemoen */ 9047d2be074SHaavard Skinnemoen break; 9057d2be074SHaavard Skinnemoen } 9067d2be074SHaavard Skinnemoen } 9077d2be074SHaavard Skinnemoen 9087d2be074SHaavard Skinnemoen static int atmci_get_ro(struct mmc_host *mmc) 9097d2be074SHaavard Skinnemoen { 910965ebf33SHaavard Skinnemoen int read_only = -ENOSYS; 911965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = mmc_priv(mmc); 9127d2be074SHaavard Skinnemoen 913965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->wp_pin)) { 914965ebf33SHaavard Skinnemoen read_only = gpio_get_value(slot->wp_pin); 9157d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "card is %s\n", 9167d2be074SHaavard Skinnemoen read_only ? "read-only" : "read-write"); 9177d2be074SHaavard Skinnemoen } 9187d2be074SHaavard Skinnemoen 9197d2be074SHaavard Skinnemoen return read_only; 9207d2be074SHaavard Skinnemoen } 9217d2be074SHaavard Skinnemoen 922965ebf33SHaavard Skinnemoen static int atmci_get_cd(struct mmc_host *mmc) 923965ebf33SHaavard Skinnemoen { 924965ebf33SHaavard Skinnemoen int present = -ENOSYS; 925965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = mmc_priv(mmc); 926965ebf33SHaavard Skinnemoen 927965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->detect_pin)) { 928965ebf33SHaavard Skinnemoen present = !gpio_get_value(slot->detect_pin); 929965ebf33SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "card is %spresent\n", 930965ebf33SHaavard Skinnemoen present ? "" : "not "); 931965ebf33SHaavard Skinnemoen } 932965ebf33SHaavard Skinnemoen 933965ebf33SHaavard Skinnemoen return present; 934965ebf33SHaavard Skinnemoen } 935965ebf33SHaavard Skinnemoen 936965ebf33SHaavard Skinnemoen static const struct mmc_host_ops atmci_ops = { 9377d2be074SHaavard Skinnemoen .request = atmci_request, 9387d2be074SHaavard Skinnemoen .set_ios = atmci_set_ios, 9397d2be074SHaavard Skinnemoen .get_ro = atmci_get_ro, 940965ebf33SHaavard Skinnemoen .get_cd = atmci_get_cd, 9417d2be074SHaavard Skinnemoen }; 9427d2be074SHaavard Skinnemoen 943965ebf33SHaavard Skinnemoen /* Called with host->lock held */ 944965ebf33SHaavard Skinnemoen static void atmci_request_end(struct atmel_mci *host, struct mmc_request *mrq) 945965ebf33SHaavard Skinnemoen __releases(&host->lock) 946965ebf33SHaavard Skinnemoen __acquires(&host->lock) 947965ebf33SHaavard Skinnemoen { 948965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = NULL; 949965ebf33SHaavard Skinnemoen struct mmc_host *prev_mmc = host->cur_slot->mmc; 950965ebf33SHaavard Skinnemoen 951965ebf33SHaavard Skinnemoen WARN_ON(host->cmd || host->data); 952965ebf33SHaavard Skinnemoen 953965ebf33SHaavard Skinnemoen /* 954965ebf33SHaavard Skinnemoen * Update the MMC clock rate if necessary. This may be 955965ebf33SHaavard Skinnemoen * necessary if set_ios() is called when a different slot is 956965ebf33SHaavard Skinnemoen * busy transfering data. 957965ebf33SHaavard Skinnemoen */ 958965ebf33SHaavard Skinnemoen if (host->need_clock_update) 959965ebf33SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 960965ebf33SHaavard Skinnemoen 961965ebf33SHaavard Skinnemoen host->cur_slot->mrq = NULL; 962965ebf33SHaavard Skinnemoen host->mrq = NULL; 963965ebf33SHaavard Skinnemoen if (!list_empty(&host->queue)) { 964965ebf33SHaavard Skinnemoen slot = list_entry(host->queue.next, 965965ebf33SHaavard Skinnemoen struct atmel_mci_slot, queue_node); 966965ebf33SHaavard Skinnemoen list_del(&slot->queue_node); 967965ebf33SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, "list not empty: %s is next\n", 968965ebf33SHaavard Skinnemoen mmc_hostname(slot->mmc)); 969965ebf33SHaavard Skinnemoen host->state = STATE_SENDING_CMD; 970965ebf33SHaavard Skinnemoen atmci_start_request(host, slot); 971965ebf33SHaavard Skinnemoen } else { 972965ebf33SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, "list empty\n"); 973965ebf33SHaavard Skinnemoen host->state = STATE_IDLE; 974965ebf33SHaavard Skinnemoen } 975965ebf33SHaavard Skinnemoen 976965ebf33SHaavard Skinnemoen spin_unlock(&host->lock); 977965ebf33SHaavard Skinnemoen mmc_request_done(prev_mmc, mrq); 978965ebf33SHaavard Skinnemoen spin_lock(&host->lock); 979965ebf33SHaavard Skinnemoen } 980965ebf33SHaavard Skinnemoen 9817d2be074SHaavard Skinnemoen static void atmci_command_complete(struct atmel_mci *host, 982c06ad258SHaavard Skinnemoen struct mmc_command *cmd) 9837d2be074SHaavard Skinnemoen { 984c06ad258SHaavard Skinnemoen u32 status = host->cmd_status; 985c06ad258SHaavard Skinnemoen 9867d2be074SHaavard Skinnemoen /* Read the response from the card (up to 16 bytes) */ 9877d2be074SHaavard Skinnemoen cmd->resp[0] = mci_readl(host, RSPR); 9887d2be074SHaavard Skinnemoen cmd->resp[1] = mci_readl(host, RSPR); 9897d2be074SHaavard Skinnemoen cmd->resp[2] = mci_readl(host, RSPR); 9907d2be074SHaavard Skinnemoen cmd->resp[3] = mci_readl(host, RSPR); 9917d2be074SHaavard Skinnemoen 9927d2be074SHaavard Skinnemoen if (status & MCI_RTOE) 9937d2be074SHaavard Skinnemoen cmd->error = -ETIMEDOUT; 9947d2be074SHaavard Skinnemoen else if ((cmd->flags & MMC_RSP_CRC) && (status & MCI_RCRCE)) 9957d2be074SHaavard Skinnemoen cmd->error = -EILSEQ; 9967d2be074SHaavard Skinnemoen else if (status & (MCI_RINDE | MCI_RDIRE | MCI_RENDE)) 9977d2be074SHaavard Skinnemoen cmd->error = -EIO; 9987d2be074SHaavard Skinnemoen else 9997d2be074SHaavard Skinnemoen cmd->error = 0; 10007d2be074SHaavard Skinnemoen 10017d2be074SHaavard Skinnemoen if (cmd->error) { 1002965ebf33SHaavard Skinnemoen dev_dbg(&host->pdev->dev, 10037d2be074SHaavard Skinnemoen "command error: status=0x%08x\n", status); 10047d2be074SHaavard Skinnemoen 10057d2be074SHaavard Skinnemoen if (cmd->data) { 10067d2be074SHaavard Skinnemoen host->data = NULL; 100765e8b083SHaavard Skinnemoen atmci_stop_dma(host); 10087d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_NOTBUSY 10097d2be074SHaavard Skinnemoen | MCI_TXRDY | MCI_RXRDY 10107d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS); 10117d2be074SHaavard Skinnemoen } 10127d2be074SHaavard Skinnemoen } 10137d2be074SHaavard Skinnemoen } 10147d2be074SHaavard Skinnemoen 10157d2be074SHaavard Skinnemoen static void atmci_detect_change(unsigned long data) 10167d2be074SHaavard Skinnemoen { 1017965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = (struct atmel_mci_slot *)data; 1018965ebf33SHaavard Skinnemoen bool present; 1019965ebf33SHaavard Skinnemoen bool present_old; 10207d2be074SHaavard Skinnemoen 10217d2be074SHaavard Skinnemoen /* 1022965ebf33SHaavard Skinnemoen * atmci_cleanup_slot() sets the ATMCI_SHUTDOWN flag before 1023965ebf33SHaavard Skinnemoen * freeing the interrupt. We must not re-enable the interrupt 1024965ebf33SHaavard Skinnemoen * if it has been freed, and if we're shutting down, it 1025965ebf33SHaavard Skinnemoen * doesn't really matter whether the card is present or not. 10267d2be074SHaavard Skinnemoen */ 10277d2be074SHaavard Skinnemoen smp_rmb(); 1028965ebf33SHaavard Skinnemoen if (test_bit(ATMCI_SHUTDOWN, &slot->flags)) 10297d2be074SHaavard Skinnemoen return; 10307d2be074SHaavard Skinnemoen 1031965ebf33SHaavard Skinnemoen enable_irq(gpio_to_irq(slot->detect_pin)); 1032965ebf33SHaavard Skinnemoen present = !gpio_get_value(slot->detect_pin); 1033965ebf33SHaavard Skinnemoen present_old = test_bit(ATMCI_CARD_PRESENT, &slot->flags); 10347d2be074SHaavard Skinnemoen 1035965ebf33SHaavard Skinnemoen dev_vdbg(&slot->mmc->class_dev, "detect change: %d (was %d)\n", 1036965ebf33SHaavard Skinnemoen present, present_old); 10377d2be074SHaavard Skinnemoen 1038965ebf33SHaavard Skinnemoen if (present != present_old) { 1039965ebf33SHaavard Skinnemoen struct atmel_mci *host = slot->host; 1040965ebf33SHaavard Skinnemoen struct mmc_request *mrq; 1041965ebf33SHaavard Skinnemoen 1042965ebf33SHaavard Skinnemoen dev_dbg(&slot->mmc->class_dev, "card %s\n", 10437d2be074SHaavard Skinnemoen present ? "inserted" : "removed"); 10447d2be074SHaavard Skinnemoen 1045965ebf33SHaavard Skinnemoen spin_lock(&host->lock); 1046965ebf33SHaavard Skinnemoen 1047965ebf33SHaavard Skinnemoen if (!present) 1048965ebf33SHaavard Skinnemoen clear_bit(ATMCI_CARD_PRESENT, &slot->flags); 1049965ebf33SHaavard Skinnemoen else 1050965ebf33SHaavard Skinnemoen set_bit(ATMCI_CARD_PRESENT, &slot->flags); 10517d2be074SHaavard Skinnemoen 10527d2be074SHaavard Skinnemoen /* Clean up queue if present */ 1053965ebf33SHaavard Skinnemoen mrq = slot->mrq; 10547d2be074SHaavard Skinnemoen if (mrq) { 1055965ebf33SHaavard Skinnemoen if (mrq == host->mrq) { 10567d2be074SHaavard Skinnemoen /* 10577d2be074SHaavard Skinnemoen * Reset controller to terminate any ongoing 10587d2be074SHaavard Skinnemoen * commands or data transfers. 10597d2be074SHaavard Skinnemoen */ 10607d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 1061965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 1062965ebf33SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 10637d2be074SHaavard Skinnemoen 10647d2be074SHaavard Skinnemoen host->data = NULL; 10657d2be074SHaavard Skinnemoen host->cmd = NULL; 1066c06ad258SHaavard Skinnemoen 1067c06ad258SHaavard Skinnemoen switch (host->state) { 1068965ebf33SHaavard Skinnemoen case STATE_IDLE: 1069965ebf33SHaavard Skinnemoen break; 1070c06ad258SHaavard Skinnemoen case STATE_SENDING_CMD: 1071c06ad258SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 1072c06ad258SHaavard Skinnemoen if (!mrq->data) 1073c06ad258SHaavard Skinnemoen break; 1074c06ad258SHaavard Skinnemoen /* fall through */ 1075c06ad258SHaavard Skinnemoen case STATE_SENDING_DATA: 1076c06ad258SHaavard Skinnemoen mrq->data->error = -ENOMEDIUM; 107765e8b083SHaavard Skinnemoen atmci_stop_dma(host); 1078c06ad258SHaavard Skinnemoen break; 1079c06ad258SHaavard Skinnemoen case STATE_DATA_BUSY: 1080c06ad258SHaavard Skinnemoen case STATE_DATA_ERROR: 1081c06ad258SHaavard Skinnemoen if (mrq->data->error == -EINPROGRESS) 1082c06ad258SHaavard Skinnemoen mrq->data->error = -ENOMEDIUM; 1083c06ad258SHaavard Skinnemoen if (!mrq->stop) 1084c06ad258SHaavard Skinnemoen break; 1085c06ad258SHaavard Skinnemoen /* fall through */ 1086c06ad258SHaavard Skinnemoen case STATE_SENDING_STOP: 1087c06ad258SHaavard Skinnemoen mrq->stop->error = -ENOMEDIUM; 1088c06ad258SHaavard Skinnemoen break; 1089c06ad258SHaavard Skinnemoen } 1090c06ad258SHaavard Skinnemoen 1091965ebf33SHaavard Skinnemoen atmci_request_end(host, mrq); 1092965ebf33SHaavard Skinnemoen } else { 1093965ebf33SHaavard Skinnemoen list_del(&slot->queue_node); 1094965ebf33SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 1095965ebf33SHaavard Skinnemoen if (mrq->data) 1096965ebf33SHaavard Skinnemoen mrq->data->error = -ENOMEDIUM; 1097965ebf33SHaavard Skinnemoen if (mrq->stop) 1098965ebf33SHaavard Skinnemoen mrq->stop->error = -ENOMEDIUM; 10997d2be074SHaavard Skinnemoen 1100965ebf33SHaavard Skinnemoen spin_unlock(&host->lock); 1101965ebf33SHaavard Skinnemoen mmc_request_done(slot->mmc, mrq); 1102965ebf33SHaavard Skinnemoen spin_lock(&host->lock); 1103965ebf33SHaavard Skinnemoen } 1104965ebf33SHaavard Skinnemoen } 1105965ebf33SHaavard Skinnemoen spin_unlock(&host->lock); 1106965ebf33SHaavard Skinnemoen 1107965ebf33SHaavard Skinnemoen mmc_detect_change(slot->mmc, 0); 11087d2be074SHaavard Skinnemoen } 11097d2be074SHaavard Skinnemoen } 11107d2be074SHaavard Skinnemoen 11117d2be074SHaavard Skinnemoen static void atmci_tasklet_func(unsigned long priv) 11127d2be074SHaavard Skinnemoen { 1113965ebf33SHaavard Skinnemoen struct atmel_mci *host = (struct atmel_mci *)priv; 11147d2be074SHaavard Skinnemoen struct mmc_request *mrq = host->mrq; 11157d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 1116c06ad258SHaavard Skinnemoen struct mmc_command *cmd = host->cmd; 1117c06ad258SHaavard Skinnemoen enum atmel_mci_state state = host->state; 1118c06ad258SHaavard Skinnemoen enum atmel_mci_state prev_state; 1119c06ad258SHaavard Skinnemoen u32 status; 1120c06ad258SHaavard Skinnemoen 1121965ebf33SHaavard Skinnemoen spin_lock(&host->lock); 1122965ebf33SHaavard Skinnemoen 1123c06ad258SHaavard Skinnemoen state = host->state; 11247d2be074SHaavard Skinnemoen 1125965ebf33SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, 1126c06ad258SHaavard Skinnemoen "tasklet: state %u pending/completed/mask %lx/%lx/%x\n", 1127c06ad258SHaavard Skinnemoen state, host->pending_events, host->completed_events, 11287d2be074SHaavard Skinnemoen mci_readl(host, IMR)); 11297d2be074SHaavard Skinnemoen 1130c06ad258SHaavard Skinnemoen do { 1131c06ad258SHaavard Skinnemoen prev_state = state; 1132c06ad258SHaavard Skinnemoen 1133c06ad258SHaavard Skinnemoen switch (state) { 1134965ebf33SHaavard Skinnemoen case STATE_IDLE: 1135965ebf33SHaavard Skinnemoen break; 1136965ebf33SHaavard Skinnemoen 1137c06ad258SHaavard Skinnemoen case STATE_SENDING_CMD: 1138c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1139c06ad258SHaavard Skinnemoen EVENT_CMD_COMPLETE)) 1140c06ad258SHaavard Skinnemoen break; 1141c06ad258SHaavard Skinnemoen 11427d2be074SHaavard Skinnemoen host->cmd = NULL; 11437d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_CMD_COMPLETE); 1144c06ad258SHaavard Skinnemoen atmci_command_complete(host, mrq->cmd); 1145c06ad258SHaavard Skinnemoen if (!mrq->data || cmd->error) { 1146965ebf33SHaavard Skinnemoen atmci_request_end(host, host->mrq); 1147965ebf33SHaavard Skinnemoen goto unlock; 11487d2be074SHaavard Skinnemoen } 1149c06ad258SHaavard Skinnemoen 1150c06ad258SHaavard Skinnemoen prev_state = state = STATE_SENDING_DATA; 1151c06ad258SHaavard Skinnemoen /* fall through */ 1152c06ad258SHaavard Skinnemoen 1153c06ad258SHaavard Skinnemoen case STATE_SENDING_DATA: 1154c06ad258SHaavard Skinnemoen if (atmci_test_and_clear_pending(host, 1155c06ad258SHaavard Skinnemoen EVENT_DATA_ERROR)) { 115665e8b083SHaavard Skinnemoen atmci_stop_dma(host); 1157c06ad258SHaavard Skinnemoen if (data->stop) 1158965ebf33SHaavard Skinnemoen send_stop_cmd(host, data); 1159c06ad258SHaavard Skinnemoen state = STATE_DATA_ERROR; 1160c06ad258SHaavard Skinnemoen break; 11617d2be074SHaavard Skinnemoen } 11627d2be074SHaavard Skinnemoen 1163c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1164c06ad258SHaavard Skinnemoen EVENT_XFER_COMPLETE)) 1165c06ad258SHaavard Skinnemoen break; 11667d2be074SHaavard Skinnemoen 1167c06ad258SHaavard Skinnemoen atmci_set_completed(host, EVENT_XFER_COMPLETE); 1168c06ad258SHaavard Skinnemoen prev_state = state = STATE_DATA_BUSY; 1169c06ad258SHaavard Skinnemoen /* fall through */ 1170c06ad258SHaavard Skinnemoen 1171c06ad258SHaavard Skinnemoen case STATE_DATA_BUSY: 1172c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1173c06ad258SHaavard Skinnemoen EVENT_DATA_COMPLETE)) 1174c06ad258SHaavard Skinnemoen break; 1175c06ad258SHaavard Skinnemoen 1176c06ad258SHaavard Skinnemoen host->data = NULL; 11777d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_DATA_COMPLETE); 1178c06ad258SHaavard Skinnemoen status = host->data_status; 1179c06ad258SHaavard Skinnemoen if (unlikely(status & ATMCI_DATA_ERROR_FLAGS)) { 11807d2be074SHaavard Skinnemoen if (status & MCI_DTOE) { 1181965ebf33SHaavard Skinnemoen dev_dbg(&host->pdev->dev, 11827d2be074SHaavard Skinnemoen "data timeout error\n"); 11837d2be074SHaavard Skinnemoen data->error = -ETIMEDOUT; 11847d2be074SHaavard Skinnemoen } else if (status & MCI_DCRCE) { 1185965ebf33SHaavard Skinnemoen dev_dbg(&host->pdev->dev, 1186c06ad258SHaavard Skinnemoen "data CRC error\n"); 11877d2be074SHaavard Skinnemoen data->error = -EILSEQ; 11887d2be074SHaavard Skinnemoen } else { 1189965ebf33SHaavard Skinnemoen dev_dbg(&host->pdev->dev, 11907d2be074SHaavard Skinnemoen "data FIFO error (status=%08x)\n", 11917d2be074SHaavard Skinnemoen status); 11927d2be074SHaavard Skinnemoen data->error = -EIO; 11937d2be074SHaavard Skinnemoen } 1194c06ad258SHaavard Skinnemoen } else { 11957d2be074SHaavard Skinnemoen data->bytes_xfered = data->blocks * data->blksz; 11967d2be074SHaavard Skinnemoen data->error = 0; 11977d2be074SHaavard Skinnemoen } 11987d2be074SHaavard Skinnemoen 1199c06ad258SHaavard Skinnemoen if (!data->stop) { 1200965ebf33SHaavard Skinnemoen atmci_request_end(host, host->mrq); 1201965ebf33SHaavard Skinnemoen goto unlock; 12027d2be074SHaavard Skinnemoen } 12037d2be074SHaavard Skinnemoen 1204c06ad258SHaavard Skinnemoen prev_state = state = STATE_SENDING_STOP; 1205c06ad258SHaavard Skinnemoen if (!data->error) 1206965ebf33SHaavard Skinnemoen send_stop_cmd(host, data); 1207c06ad258SHaavard Skinnemoen /* fall through */ 1208c06ad258SHaavard Skinnemoen 1209c06ad258SHaavard Skinnemoen case STATE_SENDING_STOP: 1210c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1211c06ad258SHaavard Skinnemoen EVENT_CMD_COMPLETE)) 1212c06ad258SHaavard Skinnemoen break; 1213c06ad258SHaavard Skinnemoen 1214c06ad258SHaavard Skinnemoen host->cmd = NULL; 1215c06ad258SHaavard Skinnemoen atmci_command_complete(host, mrq->stop); 1216965ebf33SHaavard Skinnemoen atmci_request_end(host, host->mrq); 1217965ebf33SHaavard Skinnemoen goto unlock; 1218c06ad258SHaavard Skinnemoen 1219c06ad258SHaavard Skinnemoen case STATE_DATA_ERROR: 1220c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1221c06ad258SHaavard Skinnemoen EVENT_XFER_COMPLETE)) 1222c06ad258SHaavard Skinnemoen break; 1223c06ad258SHaavard Skinnemoen 1224c06ad258SHaavard Skinnemoen state = STATE_DATA_BUSY; 1225c06ad258SHaavard Skinnemoen break; 1226c06ad258SHaavard Skinnemoen } 1227c06ad258SHaavard Skinnemoen } while (state != prev_state); 1228c06ad258SHaavard Skinnemoen 1229c06ad258SHaavard Skinnemoen host->state = state; 1230965ebf33SHaavard Skinnemoen 1231965ebf33SHaavard Skinnemoen unlock: 1232965ebf33SHaavard Skinnemoen spin_unlock(&host->lock); 12337d2be074SHaavard Skinnemoen } 12347d2be074SHaavard Skinnemoen 12357d2be074SHaavard Skinnemoen static void atmci_read_data_pio(struct atmel_mci *host) 12367d2be074SHaavard Skinnemoen { 12377d2be074SHaavard Skinnemoen struct scatterlist *sg = host->sg; 12387d2be074SHaavard Skinnemoen void *buf = sg_virt(sg); 12397d2be074SHaavard Skinnemoen unsigned int offset = host->pio_offset; 12407d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 12417d2be074SHaavard Skinnemoen u32 value; 12427d2be074SHaavard Skinnemoen u32 status; 12437d2be074SHaavard Skinnemoen unsigned int nbytes = 0; 12447d2be074SHaavard Skinnemoen 12457d2be074SHaavard Skinnemoen do { 12467d2be074SHaavard Skinnemoen value = mci_readl(host, RDR); 12477d2be074SHaavard Skinnemoen if (likely(offset + 4 <= sg->length)) { 12487d2be074SHaavard Skinnemoen put_unaligned(value, (u32 *)(buf + offset)); 12497d2be074SHaavard Skinnemoen 12507d2be074SHaavard Skinnemoen offset += 4; 12517d2be074SHaavard Skinnemoen nbytes += 4; 12527d2be074SHaavard Skinnemoen 12537d2be074SHaavard Skinnemoen if (offset == sg->length) { 12545e7184aeSHaavard Skinnemoen flush_dcache_page(sg_page(sg)); 12557d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 12567d2be074SHaavard Skinnemoen if (!sg) 12577d2be074SHaavard Skinnemoen goto done; 12587d2be074SHaavard Skinnemoen 12597d2be074SHaavard Skinnemoen offset = 0; 12607d2be074SHaavard Skinnemoen buf = sg_virt(sg); 12617d2be074SHaavard Skinnemoen } 12627d2be074SHaavard Skinnemoen } else { 12637d2be074SHaavard Skinnemoen unsigned int remaining = sg->length - offset; 12647d2be074SHaavard Skinnemoen memcpy(buf + offset, &value, remaining); 12657d2be074SHaavard Skinnemoen nbytes += remaining; 12667d2be074SHaavard Skinnemoen 12677d2be074SHaavard Skinnemoen flush_dcache_page(sg_page(sg)); 12687d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 12697d2be074SHaavard Skinnemoen if (!sg) 12707d2be074SHaavard Skinnemoen goto done; 12717d2be074SHaavard Skinnemoen 12727d2be074SHaavard Skinnemoen offset = 4 - remaining; 12737d2be074SHaavard Skinnemoen buf = sg_virt(sg); 12747d2be074SHaavard Skinnemoen memcpy(buf, (u8 *)&value + remaining, offset); 12757d2be074SHaavard Skinnemoen nbytes += offset; 12767d2be074SHaavard Skinnemoen } 12777d2be074SHaavard Skinnemoen 12787d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 12797d2be074SHaavard Skinnemoen if (status & ATMCI_DATA_ERROR_FLAGS) { 12807d2be074SHaavard Skinnemoen mci_writel(host, IDR, (MCI_NOTBUSY | MCI_RXRDY 12817d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS)); 12827d2be074SHaavard Skinnemoen host->data_status = status; 1283965ebf33SHaavard Skinnemoen data->bytes_xfered += nbytes; 1284965ebf33SHaavard Skinnemoen smp_wmb(); 12857d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 12867d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 1287965ebf33SHaavard Skinnemoen return; 12887d2be074SHaavard Skinnemoen } 12897d2be074SHaavard Skinnemoen } while (status & MCI_RXRDY); 12907d2be074SHaavard Skinnemoen 12917d2be074SHaavard Skinnemoen host->pio_offset = offset; 12927d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 12937d2be074SHaavard Skinnemoen 12947d2be074SHaavard Skinnemoen return; 12957d2be074SHaavard Skinnemoen 12967d2be074SHaavard Skinnemoen done: 12977d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_RXRDY); 12987d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 12997d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 1300965ebf33SHaavard Skinnemoen smp_wmb(); 1301c06ad258SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 13027d2be074SHaavard Skinnemoen } 13037d2be074SHaavard Skinnemoen 13047d2be074SHaavard Skinnemoen static void atmci_write_data_pio(struct atmel_mci *host) 13057d2be074SHaavard Skinnemoen { 13067d2be074SHaavard Skinnemoen struct scatterlist *sg = host->sg; 13077d2be074SHaavard Skinnemoen void *buf = sg_virt(sg); 13087d2be074SHaavard Skinnemoen unsigned int offset = host->pio_offset; 13097d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 13107d2be074SHaavard Skinnemoen u32 value; 13117d2be074SHaavard Skinnemoen u32 status; 13127d2be074SHaavard Skinnemoen unsigned int nbytes = 0; 13137d2be074SHaavard Skinnemoen 13147d2be074SHaavard Skinnemoen do { 13157d2be074SHaavard Skinnemoen if (likely(offset + 4 <= sg->length)) { 13167d2be074SHaavard Skinnemoen value = get_unaligned((u32 *)(buf + offset)); 13177d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 13187d2be074SHaavard Skinnemoen 13197d2be074SHaavard Skinnemoen offset += 4; 13207d2be074SHaavard Skinnemoen nbytes += 4; 13217d2be074SHaavard Skinnemoen if (offset == sg->length) { 13227d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 13237d2be074SHaavard Skinnemoen if (!sg) 13247d2be074SHaavard Skinnemoen goto done; 13257d2be074SHaavard Skinnemoen 13267d2be074SHaavard Skinnemoen offset = 0; 13277d2be074SHaavard Skinnemoen buf = sg_virt(sg); 13287d2be074SHaavard Skinnemoen } 13297d2be074SHaavard Skinnemoen } else { 13307d2be074SHaavard Skinnemoen unsigned int remaining = sg->length - offset; 13317d2be074SHaavard Skinnemoen 13327d2be074SHaavard Skinnemoen value = 0; 13337d2be074SHaavard Skinnemoen memcpy(&value, buf + offset, remaining); 13347d2be074SHaavard Skinnemoen nbytes += remaining; 13357d2be074SHaavard Skinnemoen 13367d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 13377d2be074SHaavard Skinnemoen if (!sg) { 13387d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 13397d2be074SHaavard Skinnemoen goto done; 13407d2be074SHaavard Skinnemoen } 13417d2be074SHaavard Skinnemoen 13427d2be074SHaavard Skinnemoen offset = 4 - remaining; 13437d2be074SHaavard Skinnemoen buf = sg_virt(sg); 13447d2be074SHaavard Skinnemoen memcpy((u8 *)&value + remaining, buf, offset); 13457d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 13467d2be074SHaavard Skinnemoen nbytes += offset; 13477d2be074SHaavard Skinnemoen } 13487d2be074SHaavard Skinnemoen 13497d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 13507d2be074SHaavard Skinnemoen if (status & ATMCI_DATA_ERROR_FLAGS) { 13517d2be074SHaavard Skinnemoen mci_writel(host, IDR, (MCI_NOTBUSY | MCI_TXRDY 13527d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS)); 13537d2be074SHaavard Skinnemoen host->data_status = status; 1354965ebf33SHaavard Skinnemoen data->bytes_xfered += nbytes; 1355965ebf33SHaavard Skinnemoen smp_wmb(); 13567d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 13577d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 1358965ebf33SHaavard Skinnemoen return; 13597d2be074SHaavard Skinnemoen } 13607d2be074SHaavard Skinnemoen } while (status & MCI_TXRDY); 13617d2be074SHaavard Skinnemoen 13627d2be074SHaavard Skinnemoen host->pio_offset = offset; 13637d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 13647d2be074SHaavard Skinnemoen 13657d2be074SHaavard Skinnemoen return; 13667d2be074SHaavard Skinnemoen 13677d2be074SHaavard Skinnemoen done: 13687d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_TXRDY); 13697d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 13707d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 1371965ebf33SHaavard Skinnemoen smp_wmb(); 1372c06ad258SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 13737d2be074SHaavard Skinnemoen } 13747d2be074SHaavard Skinnemoen 1375965ebf33SHaavard Skinnemoen static void atmci_cmd_interrupt(struct atmel_mci *host, u32 status) 13767d2be074SHaavard Skinnemoen { 13777d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_CMDRDY); 13787d2be074SHaavard Skinnemoen 13797d2be074SHaavard Skinnemoen host->cmd_status = status; 1380965ebf33SHaavard Skinnemoen smp_wmb(); 13817d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_CMD_COMPLETE); 13827d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 13837d2be074SHaavard Skinnemoen } 13847d2be074SHaavard Skinnemoen 13857d2be074SHaavard Skinnemoen static irqreturn_t atmci_interrupt(int irq, void *dev_id) 13867d2be074SHaavard Skinnemoen { 1387965ebf33SHaavard Skinnemoen struct atmel_mci *host = dev_id; 13887d2be074SHaavard Skinnemoen u32 status, mask, pending; 13897d2be074SHaavard Skinnemoen unsigned int pass_count = 0; 13907d2be074SHaavard Skinnemoen 13917d2be074SHaavard Skinnemoen do { 13927d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 13937d2be074SHaavard Skinnemoen mask = mci_readl(host, IMR); 13947d2be074SHaavard Skinnemoen pending = status & mask; 13957d2be074SHaavard Skinnemoen if (!pending) 13967d2be074SHaavard Skinnemoen break; 13977d2be074SHaavard Skinnemoen 13987d2be074SHaavard Skinnemoen if (pending & ATMCI_DATA_ERROR_FLAGS) { 13997d2be074SHaavard Skinnemoen mci_writel(host, IDR, ATMCI_DATA_ERROR_FLAGS 14007d2be074SHaavard Skinnemoen | MCI_RXRDY | MCI_TXRDY); 14017d2be074SHaavard Skinnemoen pending &= mci_readl(host, IMR); 1402965ebf33SHaavard Skinnemoen 14037d2be074SHaavard Skinnemoen host->data_status = status; 1404965ebf33SHaavard Skinnemoen smp_wmb(); 14057d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 14067d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 14077d2be074SHaavard Skinnemoen } 14087d2be074SHaavard Skinnemoen if (pending & MCI_NOTBUSY) { 1409c06ad258SHaavard Skinnemoen mci_writel(host, IDR, 1410c06ad258SHaavard Skinnemoen ATMCI_DATA_ERROR_FLAGS | MCI_NOTBUSY); 1411ca55f46eSHaavard Skinnemoen if (!host->data_status) 1412c06ad258SHaavard Skinnemoen host->data_status = status; 1413965ebf33SHaavard Skinnemoen smp_wmb(); 14147d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_COMPLETE); 14157d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 14167d2be074SHaavard Skinnemoen } 14177d2be074SHaavard Skinnemoen if (pending & MCI_RXRDY) 14187d2be074SHaavard Skinnemoen atmci_read_data_pio(host); 14197d2be074SHaavard Skinnemoen if (pending & MCI_TXRDY) 14207d2be074SHaavard Skinnemoen atmci_write_data_pio(host); 14217d2be074SHaavard Skinnemoen 14227d2be074SHaavard Skinnemoen if (pending & MCI_CMDRDY) 1423965ebf33SHaavard Skinnemoen atmci_cmd_interrupt(host, status); 14247d2be074SHaavard Skinnemoen } while (pass_count++ < 5); 14257d2be074SHaavard Skinnemoen 14267d2be074SHaavard Skinnemoen return pass_count ? IRQ_HANDLED : IRQ_NONE; 14277d2be074SHaavard Skinnemoen } 14287d2be074SHaavard Skinnemoen 14297d2be074SHaavard Skinnemoen static irqreturn_t atmci_detect_interrupt(int irq, void *dev_id) 14307d2be074SHaavard Skinnemoen { 1431965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = dev_id; 14327d2be074SHaavard Skinnemoen 14337d2be074SHaavard Skinnemoen /* 14347d2be074SHaavard Skinnemoen * Disable interrupts until the pin has stabilized and check 14357d2be074SHaavard Skinnemoen * the state then. Use mod_timer() since we may be in the 14367d2be074SHaavard Skinnemoen * middle of the timer routine when this interrupt triggers. 14377d2be074SHaavard Skinnemoen */ 14387d2be074SHaavard Skinnemoen disable_irq_nosync(irq); 1439965ebf33SHaavard Skinnemoen mod_timer(&slot->detect_timer, jiffies + msecs_to_jiffies(20)); 14407d2be074SHaavard Skinnemoen 14417d2be074SHaavard Skinnemoen return IRQ_HANDLED; 14427d2be074SHaavard Skinnemoen } 14437d2be074SHaavard Skinnemoen 1444965ebf33SHaavard Skinnemoen static int __init atmci_init_slot(struct atmel_mci *host, 1445965ebf33SHaavard Skinnemoen struct mci_slot_pdata *slot_data, unsigned int id, 1446965ebf33SHaavard Skinnemoen u32 sdc_reg) 1447965ebf33SHaavard Skinnemoen { 1448965ebf33SHaavard Skinnemoen struct mmc_host *mmc; 1449965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot; 1450965ebf33SHaavard Skinnemoen 1451965ebf33SHaavard Skinnemoen mmc = mmc_alloc_host(sizeof(struct atmel_mci_slot), &host->pdev->dev); 1452965ebf33SHaavard Skinnemoen if (!mmc) 1453965ebf33SHaavard Skinnemoen return -ENOMEM; 1454965ebf33SHaavard Skinnemoen 1455965ebf33SHaavard Skinnemoen slot = mmc_priv(mmc); 1456965ebf33SHaavard Skinnemoen slot->mmc = mmc; 1457965ebf33SHaavard Skinnemoen slot->host = host; 1458965ebf33SHaavard Skinnemoen slot->detect_pin = slot_data->detect_pin; 1459965ebf33SHaavard Skinnemoen slot->wp_pin = slot_data->wp_pin; 1460965ebf33SHaavard Skinnemoen slot->sdc_reg = sdc_reg; 1461965ebf33SHaavard Skinnemoen 1462965ebf33SHaavard Skinnemoen mmc->ops = &atmci_ops; 1463965ebf33SHaavard Skinnemoen mmc->f_min = DIV_ROUND_UP(host->bus_hz, 512); 1464965ebf33SHaavard Skinnemoen mmc->f_max = host->bus_hz / 2; 1465965ebf33SHaavard Skinnemoen mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; 1466965ebf33SHaavard Skinnemoen if (slot_data->bus_width >= 4) 1467965ebf33SHaavard Skinnemoen mmc->caps |= MMC_CAP_4_BIT_DATA; 1468965ebf33SHaavard Skinnemoen 1469965ebf33SHaavard Skinnemoen mmc->max_hw_segs = 64; 1470965ebf33SHaavard Skinnemoen mmc->max_phys_segs = 64; 1471965ebf33SHaavard Skinnemoen mmc->max_req_size = 32768 * 512; 1472965ebf33SHaavard Skinnemoen mmc->max_blk_size = 32768; 1473965ebf33SHaavard Skinnemoen mmc->max_blk_count = 512; 1474965ebf33SHaavard Skinnemoen 1475965ebf33SHaavard Skinnemoen /* Assume card is present initially */ 1476965ebf33SHaavard Skinnemoen set_bit(ATMCI_CARD_PRESENT, &slot->flags); 1477965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->detect_pin)) { 1478965ebf33SHaavard Skinnemoen if (gpio_request(slot->detect_pin, "mmc_detect")) { 1479965ebf33SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "no detect pin available\n"); 1480965ebf33SHaavard Skinnemoen slot->detect_pin = -EBUSY; 1481965ebf33SHaavard Skinnemoen } else if (gpio_get_value(slot->detect_pin)) { 1482965ebf33SHaavard Skinnemoen clear_bit(ATMCI_CARD_PRESENT, &slot->flags); 1483965ebf33SHaavard Skinnemoen } 1484965ebf33SHaavard Skinnemoen } 1485965ebf33SHaavard Skinnemoen 1486965ebf33SHaavard Skinnemoen if (!gpio_is_valid(slot->detect_pin)) 1487965ebf33SHaavard Skinnemoen mmc->caps |= MMC_CAP_NEEDS_POLL; 1488965ebf33SHaavard Skinnemoen 1489965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->wp_pin)) { 1490965ebf33SHaavard Skinnemoen if (gpio_request(slot->wp_pin, "mmc_wp")) { 1491965ebf33SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "no WP pin available\n"); 1492965ebf33SHaavard Skinnemoen slot->wp_pin = -EBUSY; 1493965ebf33SHaavard Skinnemoen } 1494965ebf33SHaavard Skinnemoen } 1495965ebf33SHaavard Skinnemoen 1496965ebf33SHaavard Skinnemoen host->slot[id] = slot; 1497965ebf33SHaavard Skinnemoen mmc_add_host(mmc); 1498965ebf33SHaavard Skinnemoen 1499965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->detect_pin)) { 1500965ebf33SHaavard Skinnemoen int ret; 1501965ebf33SHaavard Skinnemoen 1502965ebf33SHaavard Skinnemoen setup_timer(&slot->detect_timer, atmci_detect_change, 1503965ebf33SHaavard Skinnemoen (unsigned long)slot); 1504965ebf33SHaavard Skinnemoen 1505965ebf33SHaavard Skinnemoen ret = request_irq(gpio_to_irq(slot->detect_pin), 1506965ebf33SHaavard Skinnemoen atmci_detect_interrupt, 1507965ebf33SHaavard Skinnemoen IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING, 1508965ebf33SHaavard Skinnemoen "mmc-detect", slot); 1509965ebf33SHaavard Skinnemoen if (ret) { 1510965ebf33SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 1511965ebf33SHaavard Skinnemoen "could not request IRQ %d for detect pin\n", 1512965ebf33SHaavard Skinnemoen gpio_to_irq(slot->detect_pin)); 1513965ebf33SHaavard Skinnemoen gpio_free(slot->detect_pin); 1514965ebf33SHaavard Skinnemoen slot->detect_pin = -EBUSY; 1515965ebf33SHaavard Skinnemoen } 1516965ebf33SHaavard Skinnemoen } 1517965ebf33SHaavard Skinnemoen 1518965ebf33SHaavard Skinnemoen atmci_init_debugfs(slot); 1519965ebf33SHaavard Skinnemoen 1520965ebf33SHaavard Skinnemoen return 0; 1521965ebf33SHaavard Skinnemoen } 1522965ebf33SHaavard Skinnemoen 1523965ebf33SHaavard Skinnemoen static void __exit atmci_cleanup_slot(struct atmel_mci_slot *slot, 1524965ebf33SHaavard Skinnemoen unsigned int id) 1525965ebf33SHaavard Skinnemoen { 1526965ebf33SHaavard Skinnemoen /* Debugfs stuff is cleaned up by mmc core */ 1527965ebf33SHaavard Skinnemoen 1528965ebf33SHaavard Skinnemoen set_bit(ATMCI_SHUTDOWN, &slot->flags); 1529965ebf33SHaavard Skinnemoen smp_wmb(); 1530965ebf33SHaavard Skinnemoen 1531965ebf33SHaavard Skinnemoen mmc_remove_host(slot->mmc); 1532965ebf33SHaavard Skinnemoen 1533965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->detect_pin)) { 1534965ebf33SHaavard Skinnemoen int pin = slot->detect_pin; 1535965ebf33SHaavard Skinnemoen 1536965ebf33SHaavard Skinnemoen free_irq(gpio_to_irq(pin), slot); 1537965ebf33SHaavard Skinnemoen del_timer_sync(&slot->detect_timer); 1538965ebf33SHaavard Skinnemoen gpio_free(pin); 1539965ebf33SHaavard Skinnemoen } 1540965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->wp_pin)) 1541965ebf33SHaavard Skinnemoen gpio_free(slot->wp_pin); 1542965ebf33SHaavard Skinnemoen 1543965ebf33SHaavard Skinnemoen slot->host->slot[id] = NULL; 1544965ebf33SHaavard Skinnemoen mmc_free_host(slot->mmc); 1545965ebf33SHaavard Skinnemoen } 1546965ebf33SHaavard Skinnemoen 154774465b4fSDan Williams #ifdef CONFIG_MMC_ATMELMCI_DMA 154874465b4fSDan Williams static enum dma_state_client filter(struct dma_chan *chan, void *slave) 154974465b4fSDan Williams { 155074465b4fSDan Williams struct dw_dma_slave *dws = slave; 155174465b4fSDan Williams 155274465b4fSDan Williams if (dws->dma_dev == chan->device->dev) 155374465b4fSDan Williams return DMA_ACK; 155474465b4fSDan Williams else 155574465b4fSDan Williams return DMA_DUP; 155674465b4fSDan Williams } 155774465b4fSDan Williams #endif 155874465b4fSDan Williams 15597d2be074SHaavard Skinnemoen static int __init atmci_probe(struct platform_device *pdev) 15607d2be074SHaavard Skinnemoen { 15617d2be074SHaavard Skinnemoen struct mci_platform_data *pdata; 15627d2be074SHaavard Skinnemoen struct atmel_mci *host; 15637d2be074SHaavard Skinnemoen struct resource *regs; 1564965ebf33SHaavard Skinnemoen unsigned int nr_slots; 15657d2be074SHaavard Skinnemoen int irq; 15667d2be074SHaavard Skinnemoen int ret; 15677d2be074SHaavard Skinnemoen 15687d2be074SHaavard Skinnemoen regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); 15697d2be074SHaavard Skinnemoen if (!regs) 15707d2be074SHaavard Skinnemoen return -ENXIO; 15717d2be074SHaavard Skinnemoen pdata = pdev->dev.platform_data; 15727d2be074SHaavard Skinnemoen if (!pdata) 15737d2be074SHaavard Skinnemoen return -ENXIO; 15747d2be074SHaavard Skinnemoen irq = platform_get_irq(pdev, 0); 15757d2be074SHaavard Skinnemoen if (irq < 0) 15767d2be074SHaavard Skinnemoen return irq; 15777d2be074SHaavard Skinnemoen 1578965ebf33SHaavard Skinnemoen host = kzalloc(sizeof(struct atmel_mci), GFP_KERNEL); 1579965ebf33SHaavard Skinnemoen if (!host) 15807d2be074SHaavard Skinnemoen return -ENOMEM; 15817d2be074SHaavard Skinnemoen 15827d2be074SHaavard Skinnemoen host->pdev = pdev; 1583965ebf33SHaavard Skinnemoen spin_lock_init(&host->lock); 1584965ebf33SHaavard Skinnemoen INIT_LIST_HEAD(&host->queue); 15857d2be074SHaavard Skinnemoen 15867d2be074SHaavard Skinnemoen host->mck = clk_get(&pdev->dev, "mci_clk"); 15877d2be074SHaavard Skinnemoen if (IS_ERR(host->mck)) { 15887d2be074SHaavard Skinnemoen ret = PTR_ERR(host->mck); 15897d2be074SHaavard Skinnemoen goto err_clk_get; 15907d2be074SHaavard Skinnemoen } 15917d2be074SHaavard Skinnemoen 15927d2be074SHaavard Skinnemoen ret = -ENOMEM; 15937d2be074SHaavard Skinnemoen host->regs = ioremap(regs->start, regs->end - regs->start + 1); 15947d2be074SHaavard Skinnemoen if (!host->regs) 15957d2be074SHaavard Skinnemoen goto err_ioremap; 15967d2be074SHaavard Skinnemoen 15977d2be074SHaavard Skinnemoen clk_enable(host->mck); 15987d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 15997d2be074SHaavard Skinnemoen host->bus_hz = clk_get_rate(host->mck); 16007d2be074SHaavard Skinnemoen clk_disable(host->mck); 16017d2be074SHaavard Skinnemoen 16027d2be074SHaavard Skinnemoen host->mapbase = regs->start; 16037d2be074SHaavard Skinnemoen 1604965ebf33SHaavard Skinnemoen tasklet_init(&host->tasklet, atmci_tasklet_func, (unsigned long)host); 16057d2be074SHaavard Skinnemoen 1606965ebf33SHaavard Skinnemoen ret = request_irq(irq, atmci_interrupt, 0, pdev->dev.bus_id, host); 16077d2be074SHaavard Skinnemoen if (ret) 16087d2be074SHaavard Skinnemoen goto err_request_irq; 16097d2be074SHaavard Skinnemoen 161065e8b083SHaavard Skinnemoen #ifdef CONFIG_MMC_ATMELMCI_DMA 161174465b4fSDan Williams if (pdata->dma_slave.dma_dev) { 161274465b4fSDan Williams struct dw_dma_slave *dws = &pdata->dma_slave; 161374465b4fSDan Williams dma_cap_mask_t mask; 161465e8b083SHaavard Skinnemoen 161574465b4fSDan Williams dws->tx_reg = regs->start + MCI_TDR; 161674465b4fSDan Williams dws->rx_reg = regs->start + MCI_RDR; 161765e8b083SHaavard Skinnemoen 161865e8b083SHaavard Skinnemoen /* Try to grab a DMA channel */ 161974465b4fSDan Williams dma_cap_zero(mask); 162074465b4fSDan Williams dma_cap_set(DMA_SLAVE, mask); 162174465b4fSDan Williams host->dma.chan = dma_request_channel(mask, filter, dws); 162265e8b083SHaavard Skinnemoen } 162374465b4fSDan Williams if (!host->dma.chan) 162474465b4fSDan Williams dev_notice(&pdev->dev, "DMA not available, using PIO\n"); 162565e8b083SHaavard Skinnemoen #endif /* CONFIG_MMC_ATMELMCI_DMA */ 162665e8b083SHaavard Skinnemoen 16277d2be074SHaavard Skinnemoen platform_set_drvdata(pdev, host); 16287d2be074SHaavard Skinnemoen 1629965ebf33SHaavard Skinnemoen /* We need at least one slot to succeed */ 1630965ebf33SHaavard Skinnemoen nr_slots = 0; 1631965ebf33SHaavard Skinnemoen ret = -ENODEV; 1632965ebf33SHaavard Skinnemoen if (pdata->slot[0].bus_width) { 1633965ebf33SHaavard Skinnemoen ret = atmci_init_slot(host, &pdata->slot[0], 1634965ebf33SHaavard Skinnemoen MCI_SDCSEL_SLOT_A, 0); 1635965ebf33SHaavard Skinnemoen if (!ret) 1636965ebf33SHaavard Skinnemoen nr_slots++; 16377d2be074SHaavard Skinnemoen } 1638965ebf33SHaavard Skinnemoen if (pdata->slot[1].bus_width) { 1639965ebf33SHaavard Skinnemoen ret = atmci_init_slot(host, &pdata->slot[1], 1640965ebf33SHaavard Skinnemoen MCI_SDCSEL_SLOT_B, 1); 1641965ebf33SHaavard Skinnemoen if (!ret) 1642965ebf33SHaavard Skinnemoen nr_slots++; 16437d2be074SHaavard Skinnemoen } 16447d2be074SHaavard Skinnemoen 1645965ebf33SHaavard Skinnemoen if (!nr_slots) 1646965ebf33SHaavard Skinnemoen goto err_init_slot; 16477d2be074SHaavard Skinnemoen 1648965ebf33SHaavard Skinnemoen dev_info(&pdev->dev, 1649965ebf33SHaavard Skinnemoen "Atmel MCI controller at 0x%08lx irq %d, %u slots\n", 1650965ebf33SHaavard Skinnemoen host->mapbase, irq, nr_slots); 1651deec9ae3SHaavard Skinnemoen 16527d2be074SHaavard Skinnemoen return 0; 16537d2be074SHaavard Skinnemoen 1654965ebf33SHaavard Skinnemoen err_init_slot: 165565e8b083SHaavard Skinnemoen #ifdef CONFIG_MMC_ATMELMCI_DMA 165674465b4fSDan Williams if (host->dma.chan) 165774465b4fSDan Williams dma_release_channel(host->dma.chan); 165865e8b083SHaavard Skinnemoen #endif 1659965ebf33SHaavard Skinnemoen free_irq(irq, host); 16607d2be074SHaavard Skinnemoen err_request_irq: 16617d2be074SHaavard Skinnemoen iounmap(host->regs); 16627d2be074SHaavard Skinnemoen err_ioremap: 16637d2be074SHaavard Skinnemoen clk_put(host->mck); 16647d2be074SHaavard Skinnemoen err_clk_get: 1665965ebf33SHaavard Skinnemoen kfree(host); 16667d2be074SHaavard Skinnemoen return ret; 16677d2be074SHaavard Skinnemoen } 16687d2be074SHaavard Skinnemoen 16697d2be074SHaavard Skinnemoen static int __exit atmci_remove(struct platform_device *pdev) 16707d2be074SHaavard Skinnemoen { 16717d2be074SHaavard Skinnemoen struct atmel_mci *host = platform_get_drvdata(pdev); 1672965ebf33SHaavard Skinnemoen unsigned int i; 16737d2be074SHaavard Skinnemoen 16747d2be074SHaavard Skinnemoen platform_set_drvdata(pdev, NULL); 16757d2be074SHaavard Skinnemoen 1676965ebf33SHaavard Skinnemoen for (i = 0; i < ATMEL_MCI_MAX_NR_SLOTS; i++) { 1677965ebf33SHaavard Skinnemoen if (host->slot[i]) 1678965ebf33SHaavard Skinnemoen atmci_cleanup_slot(host->slot[i], i); 16797d2be074SHaavard Skinnemoen } 16807d2be074SHaavard Skinnemoen 16817d2be074SHaavard Skinnemoen clk_enable(host->mck); 16827d2be074SHaavard Skinnemoen mci_writel(host, IDR, ~0UL); 16837d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIDIS); 16847d2be074SHaavard Skinnemoen mci_readl(host, SR); 16857d2be074SHaavard Skinnemoen clk_disable(host->mck); 16867d2be074SHaavard Skinnemoen 168765e8b083SHaavard Skinnemoen #ifdef CONFIG_MMC_ATMELMCI_DMA 168874465b4fSDan Williams if (host->dma.chan) 168974465b4fSDan Williams dma_release_channel(host->dma.chan); 169065e8b083SHaavard Skinnemoen #endif 169165e8b083SHaavard Skinnemoen 1692965ebf33SHaavard Skinnemoen free_irq(platform_get_irq(pdev, 0), host); 16937d2be074SHaavard Skinnemoen iounmap(host->regs); 16947d2be074SHaavard Skinnemoen 16957d2be074SHaavard Skinnemoen clk_put(host->mck); 1696965ebf33SHaavard Skinnemoen kfree(host); 16977d2be074SHaavard Skinnemoen 16987d2be074SHaavard Skinnemoen return 0; 16997d2be074SHaavard Skinnemoen } 17007d2be074SHaavard Skinnemoen 17017d2be074SHaavard Skinnemoen static struct platform_driver atmci_driver = { 17027d2be074SHaavard Skinnemoen .remove = __exit_p(atmci_remove), 17037d2be074SHaavard Skinnemoen .driver = { 17047d2be074SHaavard Skinnemoen .name = "atmel_mci", 17057d2be074SHaavard Skinnemoen }, 17067d2be074SHaavard Skinnemoen }; 17077d2be074SHaavard Skinnemoen 17087d2be074SHaavard Skinnemoen static int __init atmci_init(void) 17097d2be074SHaavard Skinnemoen { 17107d2be074SHaavard Skinnemoen return platform_driver_probe(&atmci_driver, atmci_probe); 17117d2be074SHaavard Skinnemoen } 17127d2be074SHaavard Skinnemoen 17137d2be074SHaavard Skinnemoen static void __exit atmci_exit(void) 17147d2be074SHaavard Skinnemoen { 17157d2be074SHaavard Skinnemoen platform_driver_unregister(&atmci_driver); 17167d2be074SHaavard Skinnemoen } 17177d2be074SHaavard Skinnemoen 171874465b4fSDan Williams late_initcall(atmci_init); /* try to load after dma driver when built-in */ 17197d2be074SHaavard Skinnemoen module_exit(atmci_exit); 17207d2be074SHaavard Skinnemoen 17217d2be074SHaavard Skinnemoen MODULE_DESCRIPTION("Atmel Multimedia Card Interface driver"); 17227d2be074SHaavard Skinnemoen MODULE_AUTHOR("Haavard Skinnemoen <haavard.skinnemoen@atmel.com>"); 17237d2be074SHaavard Skinnemoen MODULE_LICENSE("GPL v2"); 1724