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> 28c42aa775SNicolas Ferre #include <linux/atmel-mci.h> 297d2be074SHaavard Skinnemoen 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; 59665e8b083SHaavard Skinnemoen if (chan) { 59765e8b083SHaavard Skinnemoen dma_chan_get(chan); 59865e8b083SHaavard Skinnemoen host->data_chan = chan; 59965e8b083SHaavard Skinnemoen } 60065e8b083SHaavard Skinnemoen 60165e8b083SHaavard Skinnemoen if (!chan) 60265e8b083SHaavard Skinnemoen return -ENODEV; 60365e8b083SHaavard Skinnemoen 60465e8b083SHaavard Skinnemoen if (data->flags & MMC_DATA_READ) 60565e8b083SHaavard Skinnemoen direction = DMA_FROM_DEVICE; 60665e8b083SHaavard Skinnemoen else 60765e8b083SHaavard Skinnemoen direction = DMA_TO_DEVICE; 60865e8b083SHaavard Skinnemoen 60965e8b083SHaavard Skinnemoen desc = chan->device->device_prep_slave_sg(chan, 61065e8b083SHaavard Skinnemoen data->sg, data->sg_len, direction, 61165e8b083SHaavard Skinnemoen DMA_PREP_INTERRUPT | DMA_CTRL_ACK); 61265e8b083SHaavard Skinnemoen if (!desc) 61365e8b083SHaavard Skinnemoen return -ENOMEM; 61465e8b083SHaavard Skinnemoen 61565e8b083SHaavard Skinnemoen host->dma.data_desc = desc; 61665e8b083SHaavard Skinnemoen desc->callback = atmci_dma_complete; 61765e8b083SHaavard Skinnemoen desc->callback_param = host; 61865e8b083SHaavard Skinnemoen desc->tx_submit(desc); 61965e8b083SHaavard Skinnemoen 62065e8b083SHaavard Skinnemoen /* Go! */ 62165e8b083SHaavard Skinnemoen chan->device->device_issue_pending(chan); 62265e8b083SHaavard Skinnemoen 62365e8b083SHaavard Skinnemoen return 0; 62465e8b083SHaavard Skinnemoen } 62565e8b083SHaavard Skinnemoen 62665e8b083SHaavard Skinnemoen #else /* CONFIG_MMC_ATMELMCI_DMA */ 62765e8b083SHaavard Skinnemoen 62865e8b083SHaavard Skinnemoen static int atmci_submit_data_dma(struct atmel_mci *host, struct mmc_data *data) 62965e8b083SHaavard Skinnemoen { 63065e8b083SHaavard Skinnemoen return -ENOSYS; 63165e8b083SHaavard Skinnemoen } 63265e8b083SHaavard Skinnemoen 63365e8b083SHaavard Skinnemoen static void atmci_stop_dma(struct atmel_mci *host) 63465e8b083SHaavard Skinnemoen { 63565e8b083SHaavard Skinnemoen /* Data transfer was stopped by the interrupt handler */ 63665e8b083SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 63765e8b083SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 63865e8b083SHaavard Skinnemoen } 63965e8b083SHaavard Skinnemoen 64065e8b083SHaavard Skinnemoen #endif /* CONFIG_MMC_ATMELMCI_DMA */ 64165e8b083SHaavard Skinnemoen 6427d2be074SHaavard Skinnemoen /* 6437d2be074SHaavard Skinnemoen * Returns a mask of interrupt flags to be enabled after the whole 6447d2be074SHaavard Skinnemoen * request has been prepared. 6457d2be074SHaavard Skinnemoen */ 646965ebf33SHaavard Skinnemoen static u32 atmci_submit_data(struct atmel_mci *host, struct mmc_data *data) 6477d2be074SHaavard Skinnemoen { 6487d2be074SHaavard Skinnemoen u32 iflags; 6497d2be074SHaavard Skinnemoen 6507d2be074SHaavard Skinnemoen data->error = -EINPROGRESS; 6517d2be074SHaavard Skinnemoen 6527d2be074SHaavard Skinnemoen WARN_ON(host->data); 6537d2be074SHaavard Skinnemoen host->sg = NULL; 6547d2be074SHaavard Skinnemoen host->data = data; 6557d2be074SHaavard Skinnemoen 6567d2be074SHaavard Skinnemoen iflags = ATMCI_DATA_ERROR_FLAGS; 65765e8b083SHaavard Skinnemoen if (atmci_submit_data_dma(host, data)) { 65865e8b083SHaavard Skinnemoen host->data_chan = NULL; 659965ebf33SHaavard Skinnemoen 660965ebf33SHaavard Skinnemoen /* 661965ebf33SHaavard Skinnemoen * Errata: MMC data write operation with less than 12 662965ebf33SHaavard Skinnemoen * bytes is impossible. 663965ebf33SHaavard Skinnemoen * 664965ebf33SHaavard Skinnemoen * Errata: MCI Transmit Data Register (TDR) FIFO 665965ebf33SHaavard Skinnemoen * corruption when length is not multiple of 4. 666965ebf33SHaavard Skinnemoen */ 667965ebf33SHaavard Skinnemoen if (data->blocks * data->blksz < 12 668965ebf33SHaavard Skinnemoen || (data->blocks * data->blksz) & 3) 669965ebf33SHaavard Skinnemoen host->need_reset = true; 670965ebf33SHaavard Skinnemoen 6717d2be074SHaavard Skinnemoen host->sg = data->sg; 6727d2be074SHaavard Skinnemoen host->pio_offset = 0; 6737d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_READ) 6747d2be074SHaavard Skinnemoen iflags |= MCI_RXRDY; 6757d2be074SHaavard Skinnemoen else 6767d2be074SHaavard Skinnemoen iflags |= MCI_TXRDY; 67765e8b083SHaavard Skinnemoen } 6787d2be074SHaavard Skinnemoen 6797d2be074SHaavard Skinnemoen return iflags; 6807d2be074SHaavard Skinnemoen } 6817d2be074SHaavard Skinnemoen 682965ebf33SHaavard Skinnemoen static void atmci_start_request(struct atmel_mci *host, 683965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot) 6847d2be074SHaavard Skinnemoen { 685965ebf33SHaavard Skinnemoen struct mmc_request *mrq; 6867d2be074SHaavard Skinnemoen struct mmc_command *cmd; 687965ebf33SHaavard Skinnemoen struct mmc_data *data; 6887d2be074SHaavard Skinnemoen u32 iflags; 689965ebf33SHaavard Skinnemoen u32 cmdflags; 690965ebf33SHaavard Skinnemoen 691965ebf33SHaavard Skinnemoen mrq = slot->mrq; 692965ebf33SHaavard Skinnemoen host->cur_slot = slot; 693965ebf33SHaavard Skinnemoen host->mrq = mrq; 694965ebf33SHaavard Skinnemoen 695965ebf33SHaavard Skinnemoen host->pending_events = 0; 696965ebf33SHaavard Skinnemoen host->completed_events = 0; 697ca55f46eSHaavard Skinnemoen host->data_status = 0; 698965ebf33SHaavard Skinnemoen 699965ebf33SHaavard Skinnemoen if (host->need_reset) { 700965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 701965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 702965ebf33SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 703965ebf33SHaavard Skinnemoen host->need_reset = false; 704965ebf33SHaavard Skinnemoen } 705965ebf33SHaavard Skinnemoen mci_writel(host, SDCR, slot->sdc_reg); 7067d2be074SHaavard Skinnemoen 7077d2be074SHaavard Skinnemoen iflags = mci_readl(host, IMR); 7087d2be074SHaavard Skinnemoen if (iflags) 709965ebf33SHaavard Skinnemoen dev_warn(&slot->mmc->class_dev, "WARNING: IMR=0x%08x\n", 710965ebf33SHaavard Skinnemoen iflags); 7117d2be074SHaavard Skinnemoen 712965ebf33SHaavard Skinnemoen if (unlikely(test_and_clear_bit(ATMCI_CARD_NEED_INIT, &slot->flags))) { 713965ebf33SHaavard Skinnemoen /* Send init sequence (74 clock cycles) */ 714965ebf33SHaavard Skinnemoen mci_writel(host, CMDR, MCI_CMDR_SPCMD_INIT); 715965ebf33SHaavard Skinnemoen while (!(mci_readl(host, SR) & MCI_CMDRDY)) 716965ebf33SHaavard Skinnemoen cpu_relax(); 7177d2be074SHaavard Skinnemoen } 7187d2be074SHaavard Skinnemoen data = mrq->data; 7197d2be074SHaavard Skinnemoen if (data) { 720965ebf33SHaavard Skinnemoen atmci_set_timeout(host, slot, data); 721a252e3e3SHaavard Skinnemoen 722a252e3e3SHaavard Skinnemoen /* Must set block count/size before sending command */ 723a252e3e3SHaavard Skinnemoen mci_writel(host, BLKR, MCI_BCNT(data->blocks) 724a252e3e3SHaavard Skinnemoen | MCI_BLKLEN(data->blksz)); 725965ebf33SHaavard Skinnemoen dev_vdbg(&slot->mmc->class_dev, "BLKR=0x%08x\n", 726965ebf33SHaavard Skinnemoen MCI_BCNT(data->blocks) | MCI_BLKLEN(data->blksz)); 7277d2be074SHaavard Skinnemoen } 7287d2be074SHaavard Skinnemoen 7297d2be074SHaavard Skinnemoen iflags = MCI_CMDRDY; 7307d2be074SHaavard Skinnemoen cmd = mrq->cmd; 731965ebf33SHaavard Skinnemoen cmdflags = atmci_prepare_command(slot->mmc, cmd); 7327d2be074SHaavard Skinnemoen atmci_start_command(host, cmd, cmdflags); 7337d2be074SHaavard Skinnemoen 7347d2be074SHaavard Skinnemoen if (data) 735965ebf33SHaavard Skinnemoen iflags |= atmci_submit_data(host, data); 7367d2be074SHaavard Skinnemoen 7377d2be074SHaavard Skinnemoen if (mrq->stop) { 738965ebf33SHaavard Skinnemoen host->stop_cmdr = atmci_prepare_command(slot->mmc, mrq->stop); 7397d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_STOP_XFER; 7407d2be074SHaavard Skinnemoen if (!(data->flags & MMC_DATA_WRITE)) 7417d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_TRDIR_READ; 7427d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_STREAM) 7437d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_STREAM; 7447d2be074SHaavard Skinnemoen else 7457d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_MULTI_BLOCK; 7467d2be074SHaavard Skinnemoen } 7477d2be074SHaavard Skinnemoen 7487d2be074SHaavard Skinnemoen /* 7497d2be074SHaavard Skinnemoen * We could have enabled interrupts earlier, but I suspect 7507d2be074SHaavard Skinnemoen * that would open up a nice can of interesting race 7517d2be074SHaavard Skinnemoen * conditions (e.g. command and data complete, but stop not 7527d2be074SHaavard Skinnemoen * prepared yet.) 7537d2be074SHaavard Skinnemoen */ 7547d2be074SHaavard Skinnemoen mci_writel(host, IER, iflags); 755965ebf33SHaavard Skinnemoen } 7567d2be074SHaavard Skinnemoen 757965ebf33SHaavard Skinnemoen static void atmci_queue_request(struct atmel_mci *host, 758965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot, struct mmc_request *mrq) 759965ebf33SHaavard Skinnemoen { 760965ebf33SHaavard Skinnemoen dev_vdbg(&slot->mmc->class_dev, "queue request: state=%d\n", 761965ebf33SHaavard Skinnemoen host->state); 762965ebf33SHaavard Skinnemoen 763965ebf33SHaavard Skinnemoen spin_lock_bh(&host->lock); 764965ebf33SHaavard Skinnemoen slot->mrq = mrq; 765965ebf33SHaavard Skinnemoen if (host->state == STATE_IDLE) { 766965ebf33SHaavard Skinnemoen host->state = STATE_SENDING_CMD; 767965ebf33SHaavard Skinnemoen atmci_start_request(host, slot); 768965ebf33SHaavard Skinnemoen } else { 769965ebf33SHaavard Skinnemoen list_add_tail(&slot->queue_node, &host->queue); 770965ebf33SHaavard Skinnemoen } 771965ebf33SHaavard Skinnemoen spin_unlock_bh(&host->lock); 772965ebf33SHaavard Skinnemoen } 773965ebf33SHaavard Skinnemoen 774965ebf33SHaavard Skinnemoen static void atmci_request(struct mmc_host *mmc, struct mmc_request *mrq) 775965ebf33SHaavard Skinnemoen { 776965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = mmc_priv(mmc); 777965ebf33SHaavard Skinnemoen struct atmel_mci *host = slot->host; 778965ebf33SHaavard Skinnemoen struct mmc_data *data; 779965ebf33SHaavard Skinnemoen 780965ebf33SHaavard Skinnemoen WARN_ON(slot->mrq); 781965ebf33SHaavard Skinnemoen 782965ebf33SHaavard Skinnemoen /* 783965ebf33SHaavard Skinnemoen * We may "know" the card is gone even though there's still an 784965ebf33SHaavard Skinnemoen * electrical connection. If so, we really need to communicate 785965ebf33SHaavard Skinnemoen * this to the MMC core since there won't be any more 786965ebf33SHaavard Skinnemoen * interrupts as the card is completely removed. Otherwise, 787965ebf33SHaavard Skinnemoen * the MMC core might believe the card is still there even 788965ebf33SHaavard Skinnemoen * though the card was just removed very slowly. 789965ebf33SHaavard Skinnemoen */ 790965ebf33SHaavard Skinnemoen if (!test_bit(ATMCI_CARD_PRESENT, &slot->flags)) { 791965ebf33SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 792965ebf33SHaavard Skinnemoen mmc_request_done(mmc, mrq); 7937d2be074SHaavard Skinnemoen return; 794965ebf33SHaavard Skinnemoen } 7957d2be074SHaavard Skinnemoen 796965ebf33SHaavard Skinnemoen /* We don't support multiple blocks of weird lengths. */ 797965ebf33SHaavard Skinnemoen data = mrq->data; 798965ebf33SHaavard Skinnemoen if (data && data->blocks > 1 && data->blksz & 3) { 7997d2be074SHaavard Skinnemoen mrq->cmd->error = -EINVAL; 8007d2be074SHaavard Skinnemoen mmc_request_done(mmc, mrq); 8017d2be074SHaavard Skinnemoen } 8027d2be074SHaavard Skinnemoen 803965ebf33SHaavard Skinnemoen atmci_queue_request(host, slot, mrq); 804965ebf33SHaavard Skinnemoen } 805965ebf33SHaavard Skinnemoen 8067d2be074SHaavard Skinnemoen static void atmci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) 8077d2be074SHaavard Skinnemoen { 808965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = mmc_priv(mmc); 809965ebf33SHaavard Skinnemoen struct atmel_mci *host = slot->host; 810965ebf33SHaavard Skinnemoen unsigned int i; 8117d2be074SHaavard Skinnemoen 812965ebf33SHaavard Skinnemoen slot->sdc_reg &= ~MCI_SDCBUS_MASK; 813945533b5SHaavard Skinnemoen switch (ios->bus_width) { 814945533b5SHaavard Skinnemoen case MMC_BUS_WIDTH_1: 815965ebf33SHaavard Skinnemoen slot->sdc_reg |= MCI_SDCBUS_1BIT; 816945533b5SHaavard Skinnemoen break; 817945533b5SHaavard Skinnemoen case MMC_BUS_WIDTH_4: 818965ebf33SHaavard Skinnemoen slot->sdc_reg = MCI_SDCBUS_4BIT; 819945533b5SHaavard Skinnemoen break; 820945533b5SHaavard Skinnemoen } 821945533b5SHaavard Skinnemoen 8227d2be074SHaavard Skinnemoen if (ios->clock) { 823965ebf33SHaavard Skinnemoen unsigned int clock_min = ~0U; 8247d2be074SHaavard Skinnemoen u32 clkdiv; 8257d2be074SHaavard Skinnemoen 826965ebf33SHaavard Skinnemoen spin_lock_bh(&host->lock); 827965ebf33SHaavard Skinnemoen if (!host->mode_reg) { 828945533b5SHaavard Skinnemoen clk_enable(host->mck); 829965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 830965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 831965ebf33SHaavard Skinnemoen } 832945533b5SHaavard Skinnemoen 833965ebf33SHaavard Skinnemoen /* 834965ebf33SHaavard Skinnemoen * Use mirror of ios->clock to prevent race with mmc 835965ebf33SHaavard Skinnemoen * core ios update when finding the minimum. 836965ebf33SHaavard Skinnemoen */ 837965ebf33SHaavard Skinnemoen slot->clock = ios->clock; 838965ebf33SHaavard Skinnemoen for (i = 0; i < ATMEL_MCI_MAX_NR_SLOTS; i++) { 839965ebf33SHaavard Skinnemoen if (host->slot[i] && host->slot[i]->clock 840965ebf33SHaavard Skinnemoen && host->slot[i]->clock < clock_min) 841965ebf33SHaavard Skinnemoen clock_min = host->slot[i]->clock; 842965ebf33SHaavard Skinnemoen } 843965ebf33SHaavard Skinnemoen 844965ebf33SHaavard Skinnemoen /* Calculate clock divider */ 845965ebf33SHaavard Skinnemoen clkdiv = DIV_ROUND_UP(host->bus_hz, 2 * clock_min) - 1; 8467d2be074SHaavard Skinnemoen if (clkdiv > 255) { 8477d2be074SHaavard Skinnemoen dev_warn(&mmc->class_dev, 8487d2be074SHaavard Skinnemoen "clock %u too slow; using %lu\n", 849965ebf33SHaavard Skinnemoen clock_min, host->bus_hz / (2 * 256)); 8507d2be074SHaavard Skinnemoen clkdiv = 255; 8517d2be074SHaavard Skinnemoen } 8527d2be074SHaavard Skinnemoen 853965ebf33SHaavard Skinnemoen /* 854965ebf33SHaavard Skinnemoen * WRPROOF and RDPROOF prevent overruns/underruns by 855965ebf33SHaavard Skinnemoen * stopping the clock when the FIFO is full/empty. 856965ebf33SHaavard Skinnemoen * This state is not expected to last for long. 857965ebf33SHaavard Skinnemoen */ 8587d2be074SHaavard Skinnemoen host->mode_reg = MCI_MR_CLKDIV(clkdiv) | MCI_MR_WRPROOF 8597d2be074SHaavard Skinnemoen | MCI_MR_RDPROOF; 8607d2be074SHaavard Skinnemoen 861965ebf33SHaavard Skinnemoen if (list_empty(&host->queue)) 862945533b5SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 863965ebf33SHaavard Skinnemoen else 864965ebf33SHaavard Skinnemoen host->need_clock_update = true; 865965ebf33SHaavard Skinnemoen 866965ebf33SHaavard Skinnemoen spin_unlock_bh(&host->lock); 867945533b5SHaavard Skinnemoen } else { 868965ebf33SHaavard Skinnemoen bool any_slot_active = false; 869965ebf33SHaavard Skinnemoen 870965ebf33SHaavard Skinnemoen spin_lock_bh(&host->lock); 871965ebf33SHaavard Skinnemoen slot->clock = 0; 872965ebf33SHaavard Skinnemoen for (i = 0; i < ATMEL_MCI_MAX_NR_SLOTS; i++) { 873965ebf33SHaavard Skinnemoen if (host->slot[i] && host->slot[i]->clock) { 874965ebf33SHaavard Skinnemoen any_slot_active = true; 875965ebf33SHaavard Skinnemoen break; 876965ebf33SHaavard Skinnemoen } 877965ebf33SHaavard Skinnemoen } 878965ebf33SHaavard Skinnemoen if (!any_slot_active) { 879945533b5SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIDIS); 880945533b5SHaavard Skinnemoen if (host->mode_reg) { 881945533b5SHaavard Skinnemoen mci_readl(host, MR); 882945533b5SHaavard Skinnemoen clk_disable(host->mck); 883945533b5SHaavard Skinnemoen } 884945533b5SHaavard Skinnemoen host->mode_reg = 0; 8857d2be074SHaavard Skinnemoen } 886965ebf33SHaavard Skinnemoen spin_unlock_bh(&host->lock); 887965ebf33SHaavard Skinnemoen } 8887d2be074SHaavard Skinnemoen 8897d2be074SHaavard Skinnemoen switch (ios->power_mode) { 890965ebf33SHaavard Skinnemoen case MMC_POWER_UP: 891965ebf33SHaavard Skinnemoen set_bit(ATMCI_CARD_NEED_INIT, &slot->flags); 892965ebf33SHaavard Skinnemoen break; 8937d2be074SHaavard Skinnemoen default: 8947d2be074SHaavard Skinnemoen /* 8957d2be074SHaavard Skinnemoen * TODO: None of the currently available AVR32-based 8967d2be074SHaavard Skinnemoen * boards allow MMC power to be turned off. Implement 8977d2be074SHaavard Skinnemoen * power control when this can be tested properly. 898965ebf33SHaavard Skinnemoen * 899965ebf33SHaavard Skinnemoen * We also need to hook this into the clock management 900965ebf33SHaavard Skinnemoen * somehow so that newly inserted cards aren't 901965ebf33SHaavard Skinnemoen * subjected to a fast clock before we have a chance 902965ebf33SHaavard Skinnemoen * to figure out what the maximum rate is. Currently, 903965ebf33SHaavard Skinnemoen * there's no way to avoid this, and there never will 904965ebf33SHaavard Skinnemoen * be for boards that don't support power control. 9057d2be074SHaavard Skinnemoen */ 9067d2be074SHaavard Skinnemoen break; 9077d2be074SHaavard Skinnemoen } 9087d2be074SHaavard Skinnemoen } 9097d2be074SHaavard Skinnemoen 9107d2be074SHaavard Skinnemoen static int atmci_get_ro(struct mmc_host *mmc) 9117d2be074SHaavard Skinnemoen { 912965ebf33SHaavard Skinnemoen int read_only = -ENOSYS; 913965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = mmc_priv(mmc); 9147d2be074SHaavard Skinnemoen 915965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->wp_pin)) { 916965ebf33SHaavard Skinnemoen read_only = gpio_get_value(slot->wp_pin); 9177d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "card is %s\n", 9187d2be074SHaavard Skinnemoen read_only ? "read-only" : "read-write"); 9197d2be074SHaavard Skinnemoen } 9207d2be074SHaavard Skinnemoen 9217d2be074SHaavard Skinnemoen return read_only; 9227d2be074SHaavard Skinnemoen } 9237d2be074SHaavard Skinnemoen 924965ebf33SHaavard Skinnemoen static int atmci_get_cd(struct mmc_host *mmc) 925965ebf33SHaavard Skinnemoen { 926965ebf33SHaavard Skinnemoen int present = -ENOSYS; 927965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = mmc_priv(mmc); 928965ebf33SHaavard Skinnemoen 929965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->detect_pin)) { 930965ebf33SHaavard Skinnemoen present = !gpio_get_value(slot->detect_pin); 931965ebf33SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "card is %spresent\n", 932965ebf33SHaavard Skinnemoen present ? "" : "not "); 933965ebf33SHaavard Skinnemoen } 934965ebf33SHaavard Skinnemoen 935965ebf33SHaavard Skinnemoen return present; 936965ebf33SHaavard Skinnemoen } 937965ebf33SHaavard Skinnemoen 938965ebf33SHaavard Skinnemoen static const struct mmc_host_ops atmci_ops = { 9397d2be074SHaavard Skinnemoen .request = atmci_request, 9407d2be074SHaavard Skinnemoen .set_ios = atmci_set_ios, 9417d2be074SHaavard Skinnemoen .get_ro = atmci_get_ro, 942965ebf33SHaavard Skinnemoen .get_cd = atmci_get_cd, 9437d2be074SHaavard Skinnemoen }; 9447d2be074SHaavard Skinnemoen 945965ebf33SHaavard Skinnemoen /* Called with host->lock held */ 946965ebf33SHaavard Skinnemoen static void atmci_request_end(struct atmel_mci *host, struct mmc_request *mrq) 947965ebf33SHaavard Skinnemoen __releases(&host->lock) 948965ebf33SHaavard Skinnemoen __acquires(&host->lock) 949965ebf33SHaavard Skinnemoen { 950965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = NULL; 951965ebf33SHaavard Skinnemoen struct mmc_host *prev_mmc = host->cur_slot->mmc; 952965ebf33SHaavard Skinnemoen 953965ebf33SHaavard Skinnemoen WARN_ON(host->cmd || host->data); 954965ebf33SHaavard Skinnemoen 955965ebf33SHaavard Skinnemoen /* 956965ebf33SHaavard Skinnemoen * Update the MMC clock rate if necessary. This may be 957965ebf33SHaavard Skinnemoen * necessary if set_ios() is called when a different slot is 958965ebf33SHaavard Skinnemoen * busy transfering data. 959965ebf33SHaavard Skinnemoen */ 960965ebf33SHaavard Skinnemoen if (host->need_clock_update) 961965ebf33SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 962965ebf33SHaavard Skinnemoen 963965ebf33SHaavard Skinnemoen host->cur_slot->mrq = NULL; 964965ebf33SHaavard Skinnemoen host->mrq = NULL; 965965ebf33SHaavard Skinnemoen if (!list_empty(&host->queue)) { 966965ebf33SHaavard Skinnemoen slot = list_entry(host->queue.next, 967965ebf33SHaavard Skinnemoen struct atmel_mci_slot, queue_node); 968965ebf33SHaavard Skinnemoen list_del(&slot->queue_node); 969965ebf33SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, "list not empty: %s is next\n", 970965ebf33SHaavard Skinnemoen mmc_hostname(slot->mmc)); 971965ebf33SHaavard Skinnemoen host->state = STATE_SENDING_CMD; 972965ebf33SHaavard Skinnemoen atmci_start_request(host, slot); 973965ebf33SHaavard Skinnemoen } else { 974965ebf33SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, "list empty\n"); 975965ebf33SHaavard Skinnemoen host->state = STATE_IDLE; 976965ebf33SHaavard Skinnemoen } 977965ebf33SHaavard Skinnemoen 978965ebf33SHaavard Skinnemoen spin_unlock(&host->lock); 979965ebf33SHaavard Skinnemoen mmc_request_done(prev_mmc, mrq); 980965ebf33SHaavard Skinnemoen spin_lock(&host->lock); 981965ebf33SHaavard Skinnemoen } 982965ebf33SHaavard Skinnemoen 9837d2be074SHaavard Skinnemoen static void atmci_command_complete(struct atmel_mci *host, 984c06ad258SHaavard Skinnemoen struct mmc_command *cmd) 9857d2be074SHaavard Skinnemoen { 986c06ad258SHaavard Skinnemoen u32 status = host->cmd_status; 987c06ad258SHaavard Skinnemoen 9887d2be074SHaavard Skinnemoen /* Read the response from the card (up to 16 bytes) */ 9897d2be074SHaavard Skinnemoen cmd->resp[0] = mci_readl(host, RSPR); 9907d2be074SHaavard Skinnemoen cmd->resp[1] = mci_readl(host, RSPR); 9917d2be074SHaavard Skinnemoen cmd->resp[2] = mci_readl(host, RSPR); 9927d2be074SHaavard Skinnemoen cmd->resp[3] = mci_readl(host, RSPR); 9937d2be074SHaavard Skinnemoen 9947d2be074SHaavard Skinnemoen if (status & MCI_RTOE) 9957d2be074SHaavard Skinnemoen cmd->error = -ETIMEDOUT; 9967d2be074SHaavard Skinnemoen else if ((cmd->flags & MMC_RSP_CRC) && (status & MCI_RCRCE)) 9977d2be074SHaavard Skinnemoen cmd->error = -EILSEQ; 9987d2be074SHaavard Skinnemoen else if (status & (MCI_RINDE | MCI_RDIRE | MCI_RENDE)) 9997d2be074SHaavard Skinnemoen cmd->error = -EIO; 10007d2be074SHaavard Skinnemoen else 10017d2be074SHaavard Skinnemoen cmd->error = 0; 10027d2be074SHaavard Skinnemoen 10037d2be074SHaavard Skinnemoen if (cmd->error) { 1004965ebf33SHaavard Skinnemoen dev_dbg(&host->pdev->dev, 10057d2be074SHaavard Skinnemoen "command error: status=0x%08x\n", status); 10067d2be074SHaavard Skinnemoen 10077d2be074SHaavard Skinnemoen if (cmd->data) { 10087d2be074SHaavard Skinnemoen host->data = NULL; 100965e8b083SHaavard Skinnemoen atmci_stop_dma(host); 10107d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_NOTBUSY 10117d2be074SHaavard Skinnemoen | MCI_TXRDY | MCI_RXRDY 10127d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS); 10137d2be074SHaavard Skinnemoen } 10147d2be074SHaavard Skinnemoen } 10157d2be074SHaavard Skinnemoen } 10167d2be074SHaavard Skinnemoen 10177d2be074SHaavard Skinnemoen static void atmci_detect_change(unsigned long data) 10187d2be074SHaavard Skinnemoen { 1019965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = (struct atmel_mci_slot *)data; 1020965ebf33SHaavard Skinnemoen bool present; 1021965ebf33SHaavard Skinnemoen bool present_old; 10227d2be074SHaavard Skinnemoen 10237d2be074SHaavard Skinnemoen /* 1024965ebf33SHaavard Skinnemoen * atmci_cleanup_slot() sets the ATMCI_SHUTDOWN flag before 1025965ebf33SHaavard Skinnemoen * freeing the interrupt. We must not re-enable the interrupt 1026965ebf33SHaavard Skinnemoen * if it has been freed, and if we're shutting down, it 1027965ebf33SHaavard Skinnemoen * doesn't really matter whether the card is present or not. 10287d2be074SHaavard Skinnemoen */ 10297d2be074SHaavard Skinnemoen smp_rmb(); 1030965ebf33SHaavard Skinnemoen if (test_bit(ATMCI_SHUTDOWN, &slot->flags)) 10317d2be074SHaavard Skinnemoen return; 10327d2be074SHaavard Skinnemoen 1033965ebf33SHaavard Skinnemoen enable_irq(gpio_to_irq(slot->detect_pin)); 1034965ebf33SHaavard Skinnemoen present = !gpio_get_value(slot->detect_pin); 1035965ebf33SHaavard Skinnemoen present_old = test_bit(ATMCI_CARD_PRESENT, &slot->flags); 10367d2be074SHaavard Skinnemoen 1037965ebf33SHaavard Skinnemoen dev_vdbg(&slot->mmc->class_dev, "detect change: %d (was %d)\n", 1038965ebf33SHaavard Skinnemoen present, present_old); 10397d2be074SHaavard Skinnemoen 1040965ebf33SHaavard Skinnemoen if (present != present_old) { 1041965ebf33SHaavard Skinnemoen struct atmel_mci *host = slot->host; 1042965ebf33SHaavard Skinnemoen struct mmc_request *mrq; 1043965ebf33SHaavard Skinnemoen 1044965ebf33SHaavard Skinnemoen dev_dbg(&slot->mmc->class_dev, "card %s\n", 10457d2be074SHaavard Skinnemoen present ? "inserted" : "removed"); 10467d2be074SHaavard Skinnemoen 1047965ebf33SHaavard Skinnemoen spin_lock(&host->lock); 1048965ebf33SHaavard Skinnemoen 1049965ebf33SHaavard Skinnemoen if (!present) 1050965ebf33SHaavard Skinnemoen clear_bit(ATMCI_CARD_PRESENT, &slot->flags); 1051965ebf33SHaavard Skinnemoen else 1052965ebf33SHaavard Skinnemoen set_bit(ATMCI_CARD_PRESENT, &slot->flags); 10537d2be074SHaavard Skinnemoen 10547d2be074SHaavard Skinnemoen /* Clean up queue if present */ 1055965ebf33SHaavard Skinnemoen mrq = slot->mrq; 10567d2be074SHaavard Skinnemoen if (mrq) { 1057965ebf33SHaavard Skinnemoen if (mrq == host->mrq) { 10587d2be074SHaavard Skinnemoen /* 10597d2be074SHaavard Skinnemoen * Reset controller to terminate any ongoing 10607d2be074SHaavard Skinnemoen * commands or data transfers. 10617d2be074SHaavard Skinnemoen */ 10627d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 1063965ebf33SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 1064965ebf33SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 10657d2be074SHaavard Skinnemoen 10667d2be074SHaavard Skinnemoen host->data = NULL; 10677d2be074SHaavard Skinnemoen host->cmd = NULL; 1068c06ad258SHaavard Skinnemoen 1069c06ad258SHaavard Skinnemoen switch (host->state) { 1070965ebf33SHaavard Skinnemoen case STATE_IDLE: 1071965ebf33SHaavard Skinnemoen break; 1072c06ad258SHaavard Skinnemoen case STATE_SENDING_CMD: 1073c06ad258SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 1074c06ad258SHaavard Skinnemoen if (!mrq->data) 1075c06ad258SHaavard Skinnemoen break; 1076c06ad258SHaavard Skinnemoen /* fall through */ 1077c06ad258SHaavard Skinnemoen case STATE_SENDING_DATA: 1078c06ad258SHaavard Skinnemoen mrq->data->error = -ENOMEDIUM; 107965e8b083SHaavard Skinnemoen atmci_stop_dma(host); 1080c06ad258SHaavard Skinnemoen break; 1081c06ad258SHaavard Skinnemoen case STATE_DATA_BUSY: 1082c06ad258SHaavard Skinnemoen case STATE_DATA_ERROR: 1083c06ad258SHaavard Skinnemoen if (mrq->data->error == -EINPROGRESS) 1084c06ad258SHaavard Skinnemoen mrq->data->error = -ENOMEDIUM; 1085c06ad258SHaavard Skinnemoen if (!mrq->stop) 1086c06ad258SHaavard Skinnemoen break; 1087c06ad258SHaavard Skinnemoen /* fall through */ 1088c06ad258SHaavard Skinnemoen case STATE_SENDING_STOP: 1089c06ad258SHaavard Skinnemoen mrq->stop->error = -ENOMEDIUM; 1090c06ad258SHaavard Skinnemoen break; 1091c06ad258SHaavard Skinnemoen } 1092c06ad258SHaavard Skinnemoen 1093965ebf33SHaavard Skinnemoen atmci_request_end(host, mrq); 1094965ebf33SHaavard Skinnemoen } else { 1095965ebf33SHaavard Skinnemoen list_del(&slot->queue_node); 1096965ebf33SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 1097965ebf33SHaavard Skinnemoen if (mrq->data) 1098965ebf33SHaavard Skinnemoen mrq->data->error = -ENOMEDIUM; 1099965ebf33SHaavard Skinnemoen if (mrq->stop) 1100965ebf33SHaavard Skinnemoen mrq->stop->error = -ENOMEDIUM; 11017d2be074SHaavard Skinnemoen 1102965ebf33SHaavard Skinnemoen spin_unlock(&host->lock); 1103965ebf33SHaavard Skinnemoen mmc_request_done(slot->mmc, mrq); 1104965ebf33SHaavard Skinnemoen spin_lock(&host->lock); 1105965ebf33SHaavard Skinnemoen } 1106965ebf33SHaavard Skinnemoen } 1107965ebf33SHaavard Skinnemoen spin_unlock(&host->lock); 1108965ebf33SHaavard Skinnemoen 1109965ebf33SHaavard Skinnemoen mmc_detect_change(slot->mmc, 0); 11107d2be074SHaavard Skinnemoen } 11117d2be074SHaavard Skinnemoen } 11127d2be074SHaavard Skinnemoen 11137d2be074SHaavard Skinnemoen static void atmci_tasklet_func(unsigned long priv) 11147d2be074SHaavard Skinnemoen { 1115965ebf33SHaavard Skinnemoen struct atmel_mci *host = (struct atmel_mci *)priv; 11167d2be074SHaavard Skinnemoen struct mmc_request *mrq = host->mrq; 11177d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 1118c06ad258SHaavard Skinnemoen struct mmc_command *cmd = host->cmd; 1119c06ad258SHaavard Skinnemoen enum atmel_mci_state state = host->state; 1120c06ad258SHaavard Skinnemoen enum atmel_mci_state prev_state; 1121c06ad258SHaavard Skinnemoen u32 status; 1122c06ad258SHaavard Skinnemoen 1123965ebf33SHaavard Skinnemoen spin_lock(&host->lock); 1124965ebf33SHaavard Skinnemoen 1125c06ad258SHaavard Skinnemoen state = host->state; 11267d2be074SHaavard Skinnemoen 1127965ebf33SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, 1128c06ad258SHaavard Skinnemoen "tasklet: state %u pending/completed/mask %lx/%lx/%x\n", 1129c06ad258SHaavard Skinnemoen state, host->pending_events, host->completed_events, 11307d2be074SHaavard Skinnemoen mci_readl(host, IMR)); 11317d2be074SHaavard Skinnemoen 1132c06ad258SHaavard Skinnemoen do { 1133c06ad258SHaavard Skinnemoen prev_state = state; 1134c06ad258SHaavard Skinnemoen 1135c06ad258SHaavard Skinnemoen switch (state) { 1136965ebf33SHaavard Skinnemoen case STATE_IDLE: 1137965ebf33SHaavard Skinnemoen break; 1138965ebf33SHaavard Skinnemoen 1139c06ad258SHaavard Skinnemoen case STATE_SENDING_CMD: 1140c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1141c06ad258SHaavard Skinnemoen EVENT_CMD_COMPLETE)) 1142c06ad258SHaavard Skinnemoen break; 1143c06ad258SHaavard Skinnemoen 11447d2be074SHaavard Skinnemoen host->cmd = NULL; 11457d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_CMD_COMPLETE); 1146c06ad258SHaavard Skinnemoen atmci_command_complete(host, mrq->cmd); 1147c06ad258SHaavard Skinnemoen if (!mrq->data || cmd->error) { 1148965ebf33SHaavard Skinnemoen atmci_request_end(host, host->mrq); 1149965ebf33SHaavard Skinnemoen goto unlock; 11507d2be074SHaavard Skinnemoen } 1151c06ad258SHaavard Skinnemoen 1152c06ad258SHaavard Skinnemoen prev_state = state = STATE_SENDING_DATA; 1153c06ad258SHaavard Skinnemoen /* fall through */ 1154c06ad258SHaavard Skinnemoen 1155c06ad258SHaavard Skinnemoen case STATE_SENDING_DATA: 1156c06ad258SHaavard Skinnemoen if (atmci_test_and_clear_pending(host, 1157c06ad258SHaavard Skinnemoen EVENT_DATA_ERROR)) { 115865e8b083SHaavard Skinnemoen atmci_stop_dma(host); 1159c06ad258SHaavard Skinnemoen if (data->stop) 1160965ebf33SHaavard Skinnemoen send_stop_cmd(host, data); 1161c06ad258SHaavard Skinnemoen state = STATE_DATA_ERROR; 1162c06ad258SHaavard Skinnemoen break; 11637d2be074SHaavard Skinnemoen } 11647d2be074SHaavard Skinnemoen 1165c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1166c06ad258SHaavard Skinnemoen EVENT_XFER_COMPLETE)) 1167c06ad258SHaavard Skinnemoen break; 11687d2be074SHaavard Skinnemoen 1169c06ad258SHaavard Skinnemoen atmci_set_completed(host, EVENT_XFER_COMPLETE); 1170c06ad258SHaavard Skinnemoen prev_state = state = STATE_DATA_BUSY; 1171c06ad258SHaavard Skinnemoen /* fall through */ 1172c06ad258SHaavard Skinnemoen 1173c06ad258SHaavard Skinnemoen case STATE_DATA_BUSY: 1174c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1175c06ad258SHaavard Skinnemoen EVENT_DATA_COMPLETE)) 1176c06ad258SHaavard Skinnemoen break; 1177c06ad258SHaavard Skinnemoen 1178c06ad258SHaavard Skinnemoen host->data = NULL; 11797d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_DATA_COMPLETE); 1180c06ad258SHaavard Skinnemoen status = host->data_status; 1181c06ad258SHaavard Skinnemoen if (unlikely(status & ATMCI_DATA_ERROR_FLAGS)) { 11827d2be074SHaavard Skinnemoen if (status & MCI_DTOE) { 1183965ebf33SHaavard Skinnemoen dev_dbg(&host->pdev->dev, 11847d2be074SHaavard Skinnemoen "data timeout error\n"); 11857d2be074SHaavard Skinnemoen data->error = -ETIMEDOUT; 11867d2be074SHaavard Skinnemoen } else if (status & MCI_DCRCE) { 1187965ebf33SHaavard Skinnemoen dev_dbg(&host->pdev->dev, 1188c06ad258SHaavard Skinnemoen "data CRC error\n"); 11897d2be074SHaavard Skinnemoen data->error = -EILSEQ; 11907d2be074SHaavard Skinnemoen } else { 1191965ebf33SHaavard Skinnemoen dev_dbg(&host->pdev->dev, 11927d2be074SHaavard Skinnemoen "data FIFO error (status=%08x)\n", 11937d2be074SHaavard Skinnemoen status); 11947d2be074SHaavard Skinnemoen data->error = -EIO; 11957d2be074SHaavard Skinnemoen } 1196c06ad258SHaavard Skinnemoen } else { 11977d2be074SHaavard Skinnemoen data->bytes_xfered = data->blocks * data->blksz; 11987d2be074SHaavard Skinnemoen data->error = 0; 11997d2be074SHaavard Skinnemoen } 12007d2be074SHaavard Skinnemoen 1201c06ad258SHaavard Skinnemoen if (!data->stop) { 1202965ebf33SHaavard Skinnemoen atmci_request_end(host, host->mrq); 1203965ebf33SHaavard Skinnemoen goto unlock; 12047d2be074SHaavard Skinnemoen } 12057d2be074SHaavard Skinnemoen 1206c06ad258SHaavard Skinnemoen prev_state = state = STATE_SENDING_STOP; 1207c06ad258SHaavard Skinnemoen if (!data->error) 1208965ebf33SHaavard Skinnemoen send_stop_cmd(host, data); 1209c06ad258SHaavard Skinnemoen /* fall through */ 1210c06ad258SHaavard Skinnemoen 1211c06ad258SHaavard Skinnemoen case STATE_SENDING_STOP: 1212c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1213c06ad258SHaavard Skinnemoen EVENT_CMD_COMPLETE)) 1214c06ad258SHaavard Skinnemoen break; 1215c06ad258SHaavard Skinnemoen 1216c06ad258SHaavard Skinnemoen host->cmd = NULL; 1217c06ad258SHaavard Skinnemoen atmci_command_complete(host, mrq->stop); 1218965ebf33SHaavard Skinnemoen atmci_request_end(host, host->mrq); 1219965ebf33SHaavard Skinnemoen goto unlock; 1220c06ad258SHaavard Skinnemoen 1221c06ad258SHaavard Skinnemoen case STATE_DATA_ERROR: 1222c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 1223c06ad258SHaavard Skinnemoen EVENT_XFER_COMPLETE)) 1224c06ad258SHaavard Skinnemoen break; 1225c06ad258SHaavard Skinnemoen 1226c06ad258SHaavard Skinnemoen state = STATE_DATA_BUSY; 1227c06ad258SHaavard Skinnemoen break; 1228c06ad258SHaavard Skinnemoen } 1229c06ad258SHaavard Skinnemoen } while (state != prev_state); 1230c06ad258SHaavard Skinnemoen 1231c06ad258SHaavard Skinnemoen host->state = state; 1232965ebf33SHaavard Skinnemoen 1233965ebf33SHaavard Skinnemoen unlock: 1234965ebf33SHaavard Skinnemoen spin_unlock(&host->lock); 12357d2be074SHaavard Skinnemoen } 12367d2be074SHaavard Skinnemoen 12377d2be074SHaavard Skinnemoen static void atmci_read_data_pio(struct atmel_mci *host) 12387d2be074SHaavard Skinnemoen { 12397d2be074SHaavard Skinnemoen struct scatterlist *sg = host->sg; 12407d2be074SHaavard Skinnemoen void *buf = sg_virt(sg); 12417d2be074SHaavard Skinnemoen unsigned int offset = host->pio_offset; 12427d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 12437d2be074SHaavard Skinnemoen u32 value; 12447d2be074SHaavard Skinnemoen u32 status; 12457d2be074SHaavard Skinnemoen unsigned int nbytes = 0; 12467d2be074SHaavard Skinnemoen 12477d2be074SHaavard Skinnemoen do { 12487d2be074SHaavard Skinnemoen value = mci_readl(host, RDR); 12497d2be074SHaavard Skinnemoen if (likely(offset + 4 <= sg->length)) { 12507d2be074SHaavard Skinnemoen put_unaligned(value, (u32 *)(buf + offset)); 12517d2be074SHaavard Skinnemoen 12527d2be074SHaavard Skinnemoen offset += 4; 12537d2be074SHaavard Skinnemoen nbytes += 4; 12547d2be074SHaavard Skinnemoen 12557d2be074SHaavard Skinnemoen if (offset == sg->length) { 12565e7184aeSHaavard Skinnemoen flush_dcache_page(sg_page(sg)); 12577d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 12587d2be074SHaavard Skinnemoen if (!sg) 12597d2be074SHaavard Skinnemoen goto done; 12607d2be074SHaavard Skinnemoen 12617d2be074SHaavard Skinnemoen offset = 0; 12627d2be074SHaavard Skinnemoen buf = sg_virt(sg); 12637d2be074SHaavard Skinnemoen } 12647d2be074SHaavard Skinnemoen } else { 12657d2be074SHaavard Skinnemoen unsigned int remaining = sg->length - offset; 12667d2be074SHaavard Skinnemoen memcpy(buf + offset, &value, remaining); 12677d2be074SHaavard Skinnemoen nbytes += remaining; 12687d2be074SHaavard Skinnemoen 12697d2be074SHaavard Skinnemoen flush_dcache_page(sg_page(sg)); 12707d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 12717d2be074SHaavard Skinnemoen if (!sg) 12727d2be074SHaavard Skinnemoen goto done; 12737d2be074SHaavard Skinnemoen 12747d2be074SHaavard Skinnemoen offset = 4 - remaining; 12757d2be074SHaavard Skinnemoen buf = sg_virt(sg); 12767d2be074SHaavard Skinnemoen memcpy(buf, (u8 *)&value + remaining, offset); 12777d2be074SHaavard Skinnemoen nbytes += offset; 12787d2be074SHaavard Skinnemoen } 12797d2be074SHaavard Skinnemoen 12807d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 12817d2be074SHaavard Skinnemoen if (status & ATMCI_DATA_ERROR_FLAGS) { 12827d2be074SHaavard Skinnemoen mci_writel(host, IDR, (MCI_NOTBUSY | MCI_RXRDY 12837d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS)); 12847d2be074SHaavard Skinnemoen host->data_status = status; 1285965ebf33SHaavard Skinnemoen data->bytes_xfered += nbytes; 1286965ebf33SHaavard Skinnemoen smp_wmb(); 12877d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 12887d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 1289965ebf33SHaavard Skinnemoen return; 12907d2be074SHaavard Skinnemoen } 12917d2be074SHaavard Skinnemoen } while (status & MCI_RXRDY); 12927d2be074SHaavard Skinnemoen 12937d2be074SHaavard Skinnemoen host->pio_offset = offset; 12947d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 12957d2be074SHaavard Skinnemoen 12967d2be074SHaavard Skinnemoen return; 12977d2be074SHaavard Skinnemoen 12987d2be074SHaavard Skinnemoen done: 12997d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_RXRDY); 13007d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 13017d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 1302965ebf33SHaavard Skinnemoen smp_wmb(); 1303c06ad258SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 13047d2be074SHaavard Skinnemoen } 13057d2be074SHaavard Skinnemoen 13067d2be074SHaavard Skinnemoen static void atmci_write_data_pio(struct atmel_mci *host) 13077d2be074SHaavard Skinnemoen { 13087d2be074SHaavard Skinnemoen struct scatterlist *sg = host->sg; 13097d2be074SHaavard Skinnemoen void *buf = sg_virt(sg); 13107d2be074SHaavard Skinnemoen unsigned int offset = host->pio_offset; 13117d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 13127d2be074SHaavard Skinnemoen u32 value; 13137d2be074SHaavard Skinnemoen u32 status; 13147d2be074SHaavard Skinnemoen unsigned int nbytes = 0; 13157d2be074SHaavard Skinnemoen 13167d2be074SHaavard Skinnemoen do { 13177d2be074SHaavard Skinnemoen if (likely(offset + 4 <= sg->length)) { 13187d2be074SHaavard Skinnemoen value = get_unaligned((u32 *)(buf + offset)); 13197d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 13207d2be074SHaavard Skinnemoen 13217d2be074SHaavard Skinnemoen offset += 4; 13227d2be074SHaavard Skinnemoen nbytes += 4; 13237d2be074SHaavard Skinnemoen if (offset == sg->length) { 13247d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 13257d2be074SHaavard Skinnemoen if (!sg) 13267d2be074SHaavard Skinnemoen goto done; 13277d2be074SHaavard Skinnemoen 13287d2be074SHaavard Skinnemoen offset = 0; 13297d2be074SHaavard Skinnemoen buf = sg_virt(sg); 13307d2be074SHaavard Skinnemoen } 13317d2be074SHaavard Skinnemoen } else { 13327d2be074SHaavard Skinnemoen unsigned int remaining = sg->length - offset; 13337d2be074SHaavard Skinnemoen 13347d2be074SHaavard Skinnemoen value = 0; 13357d2be074SHaavard Skinnemoen memcpy(&value, buf + offset, remaining); 13367d2be074SHaavard Skinnemoen nbytes += remaining; 13377d2be074SHaavard Skinnemoen 13387d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 13397d2be074SHaavard Skinnemoen if (!sg) { 13407d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 13417d2be074SHaavard Skinnemoen goto done; 13427d2be074SHaavard Skinnemoen } 13437d2be074SHaavard Skinnemoen 13447d2be074SHaavard Skinnemoen offset = 4 - remaining; 13457d2be074SHaavard Skinnemoen buf = sg_virt(sg); 13467d2be074SHaavard Skinnemoen memcpy((u8 *)&value + remaining, buf, offset); 13477d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 13487d2be074SHaavard Skinnemoen nbytes += offset; 13497d2be074SHaavard Skinnemoen } 13507d2be074SHaavard Skinnemoen 13517d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 13527d2be074SHaavard Skinnemoen if (status & ATMCI_DATA_ERROR_FLAGS) { 13537d2be074SHaavard Skinnemoen mci_writel(host, IDR, (MCI_NOTBUSY | MCI_TXRDY 13547d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS)); 13557d2be074SHaavard Skinnemoen host->data_status = status; 1356965ebf33SHaavard Skinnemoen data->bytes_xfered += nbytes; 1357965ebf33SHaavard Skinnemoen smp_wmb(); 13587d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 13597d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 1360965ebf33SHaavard Skinnemoen return; 13617d2be074SHaavard Skinnemoen } 13627d2be074SHaavard Skinnemoen } while (status & MCI_TXRDY); 13637d2be074SHaavard Skinnemoen 13647d2be074SHaavard Skinnemoen host->pio_offset = offset; 13657d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 13667d2be074SHaavard Skinnemoen 13677d2be074SHaavard Skinnemoen return; 13687d2be074SHaavard Skinnemoen 13697d2be074SHaavard Skinnemoen done: 13707d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_TXRDY); 13717d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 13727d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 1373965ebf33SHaavard Skinnemoen smp_wmb(); 1374c06ad258SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 13757d2be074SHaavard Skinnemoen } 13767d2be074SHaavard Skinnemoen 1377965ebf33SHaavard Skinnemoen static void atmci_cmd_interrupt(struct atmel_mci *host, u32 status) 13787d2be074SHaavard Skinnemoen { 13797d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_CMDRDY); 13807d2be074SHaavard Skinnemoen 13817d2be074SHaavard Skinnemoen host->cmd_status = status; 1382965ebf33SHaavard Skinnemoen smp_wmb(); 13837d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_CMD_COMPLETE); 13847d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 13857d2be074SHaavard Skinnemoen } 13867d2be074SHaavard Skinnemoen 13877d2be074SHaavard Skinnemoen static irqreturn_t atmci_interrupt(int irq, void *dev_id) 13887d2be074SHaavard Skinnemoen { 1389965ebf33SHaavard Skinnemoen struct atmel_mci *host = dev_id; 13907d2be074SHaavard Skinnemoen u32 status, mask, pending; 13917d2be074SHaavard Skinnemoen unsigned int pass_count = 0; 13927d2be074SHaavard Skinnemoen 13937d2be074SHaavard Skinnemoen do { 13947d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 13957d2be074SHaavard Skinnemoen mask = mci_readl(host, IMR); 13967d2be074SHaavard Skinnemoen pending = status & mask; 13977d2be074SHaavard Skinnemoen if (!pending) 13987d2be074SHaavard Skinnemoen break; 13997d2be074SHaavard Skinnemoen 14007d2be074SHaavard Skinnemoen if (pending & ATMCI_DATA_ERROR_FLAGS) { 14017d2be074SHaavard Skinnemoen mci_writel(host, IDR, ATMCI_DATA_ERROR_FLAGS 14027d2be074SHaavard Skinnemoen | MCI_RXRDY | MCI_TXRDY); 14037d2be074SHaavard Skinnemoen pending &= mci_readl(host, IMR); 1404965ebf33SHaavard Skinnemoen 14057d2be074SHaavard Skinnemoen host->data_status = status; 1406965ebf33SHaavard Skinnemoen smp_wmb(); 14077d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 14087d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 14097d2be074SHaavard Skinnemoen } 14107d2be074SHaavard Skinnemoen if (pending & MCI_NOTBUSY) { 1411c06ad258SHaavard Skinnemoen mci_writel(host, IDR, 1412c06ad258SHaavard Skinnemoen ATMCI_DATA_ERROR_FLAGS | MCI_NOTBUSY); 1413ca55f46eSHaavard Skinnemoen if (!host->data_status) 1414c06ad258SHaavard Skinnemoen host->data_status = status; 1415965ebf33SHaavard Skinnemoen smp_wmb(); 14167d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_COMPLETE); 14177d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 14187d2be074SHaavard Skinnemoen } 14197d2be074SHaavard Skinnemoen if (pending & MCI_RXRDY) 14207d2be074SHaavard Skinnemoen atmci_read_data_pio(host); 14217d2be074SHaavard Skinnemoen if (pending & MCI_TXRDY) 14227d2be074SHaavard Skinnemoen atmci_write_data_pio(host); 14237d2be074SHaavard Skinnemoen 14247d2be074SHaavard Skinnemoen if (pending & MCI_CMDRDY) 1425965ebf33SHaavard Skinnemoen atmci_cmd_interrupt(host, status); 14267d2be074SHaavard Skinnemoen } while (pass_count++ < 5); 14277d2be074SHaavard Skinnemoen 14287d2be074SHaavard Skinnemoen return pass_count ? IRQ_HANDLED : IRQ_NONE; 14297d2be074SHaavard Skinnemoen } 14307d2be074SHaavard Skinnemoen 14317d2be074SHaavard Skinnemoen static irqreturn_t atmci_detect_interrupt(int irq, void *dev_id) 14327d2be074SHaavard Skinnemoen { 1433965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot = dev_id; 14347d2be074SHaavard Skinnemoen 14357d2be074SHaavard Skinnemoen /* 14367d2be074SHaavard Skinnemoen * Disable interrupts until the pin has stabilized and check 14377d2be074SHaavard Skinnemoen * the state then. Use mod_timer() since we may be in the 14387d2be074SHaavard Skinnemoen * middle of the timer routine when this interrupt triggers. 14397d2be074SHaavard Skinnemoen */ 14407d2be074SHaavard Skinnemoen disable_irq_nosync(irq); 1441965ebf33SHaavard Skinnemoen mod_timer(&slot->detect_timer, jiffies + msecs_to_jiffies(20)); 14427d2be074SHaavard Skinnemoen 14437d2be074SHaavard Skinnemoen return IRQ_HANDLED; 14447d2be074SHaavard Skinnemoen } 14457d2be074SHaavard Skinnemoen 144665e8b083SHaavard Skinnemoen #ifdef CONFIG_MMC_ATMELMCI_DMA 144765e8b083SHaavard Skinnemoen 144865e8b083SHaavard Skinnemoen static inline struct atmel_mci * 144965e8b083SHaavard Skinnemoen dma_client_to_atmel_mci(struct dma_client *client) 145065e8b083SHaavard Skinnemoen { 145165e8b083SHaavard Skinnemoen return container_of(client, struct atmel_mci, dma.client); 145265e8b083SHaavard Skinnemoen } 145365e8b083SHaavard Skinnemoen 145465e8b083SHaavard Skinnemoen static enum dma_state_client atmci_dma_event(struct dma_client *client, 145565e8b083SHaavard Skinnemoen struct dma_chan *chan, enum dma_state state) 145665e8b083SHaavard Skinnemoen { 145765e8b083SHaavard Skinnemoen struct atmel_mci *host; 145865e8b083SHaavard Skinnemoen enum dma_state_client ret = DMA_NAK; 145965e8b083SHaavard Skinnemoen 146065e8b083SHaavard Skinnemoen host = dma_client_to_atmel_mci(client); 146165e8b083SHaavard Skinnemoen 146265e8b083SHaavard Skinnemoen switch (state) { 146365e8b083SHaavard Skinnemoen case DMA_RESOURCE_AVAILABLE: 146465e8b083SHaavard Skinnemoen spin_lock_bh(&host->lock); 146565e8b083SHaavard Skinnemoen if (!host->dma.chan) { 146665e8b083SHaavard Skinnemoen host->dma.chan = chan; 146765e8b083SHaavard Skinnemoen ret = DMA_ACK; 146865e8b083SHaavard Skinnemoen } 146965e8b083SHaavard Skinnemoen spin_unlock_bh(&host->lock); 147065e8b083SHaavard Skinnemoen 147165e8b083SHaavard Skinnemoen if (ret == DMA_ACK) 147265e8b083SHaavard Skinnemoen dev_info(&host->pdev->dev, 147365e8b083SHaavard Skinnemoen "Using %s for DMA transfers\n", 147465e8b083SHaavard Skinnemoen chan->dev.bus_id); 147565e8b083SHaavard Skinnemoen break; 147665e8b083SHaavard Skinnemoen 147765e8b083SHaavard Skinnemoen case DMA_RESOURCE_REMOVED: 147865e8b083SHaavard Skinnemoen spin_lock_bh(&host->lock); 147965e8b083SHaavard Skinnemoen if (host->dma.chan == chan) { 148065e8b083SHaavard Skinnemoen host->dma.chan = NULL; 148165e8b083SHaavard Skinnemoen ret = DMA_ACK; 148265e8b083SHaavard Skinnemoen } 148365e8b083SHaavard Skinnemoen spin_unlock_bh(&host->lock); 148465e8b083SHaavard Skinnemoen 148565e8b083SHaavard Skinnemoen if (ret == DMA_ACK) 148665e8b083SHaavard Skinnemoen dev_info(&host->pdev->dev, 148765e8b083SHaavard Skinnemoen "Lost %s, falling back to PIO\n", 148865e8b083SHaavard Skinnemoen chan->dev.bus_id); 148965e8b083SHaavard Skinnemoen break; 149065e8b083SHaavard Skinnemoen 149165e8b083SHaavard Skinnemoen default: 149265e8b083SHaavard Skinnemoen break; 149365e8b083SHaavard Skinnemoen } 149465e8b083SHaavard Skinnemoen 149565e8b083SHaavard Skinnemoen 149665e8b083SHaavard Skinnemoen return ret; 149765e8b083SHaavard Skinnemoen } 149865e8b083SHaavard Skinnemoen #endif /* CONFIG_MMC_ATMELMCI_DMA */ 149965e8b083SHaavard Skinnemoen 1500965ebf33SHaavard Skinnemoen static int __init atmci_init_slot(struct atmel_mci *host, 1501965ebf33SHaavard Skinnemoen struct mci_slot_pdata *slot_data, unsigned int id, 1502965ebf33SHaavard Skinnemoen u32 sdc_reg) 1503965ebf33SHaavard Skinnemoen { 1504965ebf33SHaavard Skinnemoen struct mmc_host *mmc; 1505965ebf33SHaavard Skinnemoen struct atmel_mci_slot *slot; 1506965ebf33SHaavard Skinnemoen 1507965ebf33SHaavard Skinnemoen mmc = mmc_alloc_host(sizeof(struct atmel_mci_slot), &host->pdev->dev); 1508965ebf33SHaavard Skinnemoen if (!mmc) 1509965ebf33SHaavard Skinnemoen return -ENOMEM; 1510965ebf33SHaavard Skinnemoen 1511965ebf33SHaavard Skinnemoen slot = mmc_priv(mmc); 1512965ebf33SHaavard Skinnemoen slot->mmc = mmc; 1513965ebf33SHaavard Skinnemoen slot->host = host; 1514965ebf33SHaavard Skinnemoen slot->detect_pin = slot_data->detect_pin; 1515965ebf33SHaavard Skinnemoen slot->wp_pin = slot_data->wp_pin; 1516965ebf33SHaavard Skinnemoen slot->sdc_reg = sdc_reg; 1517965ebf33SHaavard Skinnemoen 1518965ebf33SHaavard Skinnemoen mmc->ops = &atmci_ops; 1519965ebf33SHaavard Skinnemoen mmc->f_min = DIV_ROUND_UP(host->bus_hz, 512); 1520965ebf33SHaavard Skinnemoen mmc->f_max = host->bus_hz / 2; 1521965ebf33SHaavard Skinnemoen mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; 1522965ebf33SHaavard Skinnemoen if (slot_data->bus_width >= 4) 1523965ebf33SHaavard Skinnemoen mmc->caps |= MMC_CAP_4_BIT_DATA; 1524965ebf33SHaavard Skinnemoen 1525965ebf33SHaavard Skinnemoen mmc->max_hw_segs = 64; 1526965ebf33SHaavard Skinnemoen mmc->max_phys_segs = 64; 1527965ebf33SHaavard Skinnemoen mmc->max_req_size = 32768 * 512; 1528965ebf33SHaavard Skinnemoen mmc->max_blk_size = 32768; 1529965ebf33SHaavard Skinnemoen mmc->max_blk_count = 512; 1530965ebf33SHaavard Skinnemoen 1531965ebf33SHaavard Skinnemoen /* Assume card is present initially */ 1532965ebf33SHaavard Skinnemoen set_bit(ATMCI_CARD_PRESENT, &slot->flags); 1533965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->detect_pin)) { 1534965ebf33SHaavard Skinnemoen if (gpio_request(slot->detect_pin, "mmc_detect")) { 1535965ebf33SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "no detect pin available\n"); 1536965ebf33SHaavard Skinnemoen slot->detect_pin = -EBUSY; 1537965ebf33SHaavard Skinnemoen } else if (gpio_get_value(slot->detect_pin)) { 1538965ebf33SHaavard Skinnemoen clear_bit(ATMCI_CARD_PRESENT, &slot->flags); 1539965ebf33SHaavard Skinnemoen } 1540965ebf33SHaavard Skinnemoen } 1541965ebf33SHaavard Skinnemoen 1542965ebf33SHaavard Skinnemoen if (!gpio_is_valid(slot->detect_pin)) 1543965ebf33SHaavard Skinnemoen mmc->caps |= MMC_CAP_NEEDS_POLL; 1544965ebf33SHaavard Skinnemoen 1545965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->wp_pin)) { 1546965ebf33SHaavard Skinnemoen if (gpio_request(slot->wp_pin, "mmc_wp")) { 1547965ebf33SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "no WP pin available\n"); 1548965ebf33SHaavard Skinnemoen slot->wp_pin = -EBUSY; 1549965ebf33SHaavard Skinnemoen } 1550965ebf33SHaavard Skinnemoen } 1551965ebf33SHaavard Skinnemoen 1552965ebf33SHaavard Skinnemoen host->slot[id] = slot; 1553965ebf33SHaavard Skinnemoen mmc_add_host(mmc); 1554965ebf33SHaavard Skinnemoen 1555965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->detect_pin)) { 1556965ebf33SHaavard Skinnemoen int ret; 1557965ebf33SHaavard Skinnemoen 1558965ebf33SHaavard Skinnemoen setup_timer(&slot->detect_timer, atmci_detect_change, 1559965ebf33SHaavard Skinnemoen (unsigned long)slot); 1560965ebf33SHaavard Skinnemoen 1561965ebf33SHaavard Skinnemoen ret = request_irq(gpio_to_irq(slot->detect_pin), 1562965ebf33SHaavard Skinnemoen atmci_detect_interrupt, 1563965ebf33SHaavard Skinnemoen IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING, 1564965ebf33SHaavard Skinnemoen "mmc-detect", slot); 1565965ebf33SHaavard Skinnemoen if (ret) { 1566965ebf33SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 1567965ebf33SHaavard Skinnemoen "could not request IRQ %d for detect pin\n", 1568965ebf33SHaavard Skinnemoen gpio_to_irq(slot->detect_pin)); 1569965ebf33SHaavard Skinnemoen gpio_free(slot->detect_pin); 1570965ebf33SHaavard Skinnemoen slot->detect_pin = -EBUSY; 1571965ebf33SHaavard Skinnemoen } 1572965ebf33SHaavard Skinnemoen } 1573965ebf33SHaavard Skinnemoen 1574965ebf33SHaavard Skinnemoen atmci_init_debugfs(slot); 1575965ebf33SHaavard Skinnemoen 1576965ebf33SHaavard Skinnemoen return 0; 1577965ebf33SHaavard Skinnemoen } 1578965ebf33SHaavard Skinnemoen 1579965ebf33SHaavard Skinnemoen static void __exit atmci_cleanup_slot(struct atmel_mci_slot *slot, 1580965ebf33SHaavard Skinnemoen unsigned int id) 1581965ebf33SHaavard Skinnemoen { 1582965ebf33SHaavard Skinnemoen /* Debugfs stuff is cleaned up by mmc core */ 1583965ebf33SHaavard Skinnemoen 1584965ebf33SHaavard Skinnemoen set_bit(ATMCI_SHUTDOWN, &slot->flags); 1585965ebf33SHaavard Skinnemoen smp_wmb(); 1586965ebf33SHaavard Skinnemoen 1587965ebf33SHaavard Skinnemoen mmc_remove_host(slot->mmc); 1588965ebf33SHaavard Skinnemoen 1589965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->detect_pin)) { 1590965ebf33SHaavard Skinnemoen int pin = slot->detect_pin; 1591965ebf33SHaavard Skinnemoen 1592965ebf33SHaavard Skinnemoen free_irq(gpio_to_irq(pin), slot); 1593965ebf33SHaavard Skinnemoen del_timer_sync(&slot->detect_timer); 1594965ebf33SHaavard Skinnemoen gpio_free(pin); 1595965ebf33SHaavard Skinnemoen } 1596965ebf33SHaavard Skinnemoen if (gpio_is_valid(slot->wp_pin)) 1597965ebf33SHaavard Skinnemoen gpio_free(slot->wp_pin); 1598965ebf33SHaavard Skinnemoen 1599965ebf33SHaavard Skinnemoen slot->host->slot[id] = NULL; 1600965ebf33SHaavard Skinnemoen mmc_free_host(slot->mmc); 1601965ebf33SHaavard Skinnemoen } 1602965ebf33SHaavard Skinnemoen 16037d2be074SHaavard Skinnemoen static int __init atmci_probe(struct platform_device *pdev) 16047d2be074SHaavard Skinnemoen { 16057d2be074SHaavard Skinnemoen struct mci_platform_data *pdata; 16067d2be074SHaavard Skinnemoen struct atmel_mci *host; 16077d2be074SHaavard Skinnemoen struct resource *regs; 1608965ebf33SHaavard Skinnemoen unsigned int nr_slots; 16097d2be074SHaavard Skinnemoen int irq; 16107d2be074SHaavard Skinnemoen int ret; 16117d2be074SHaavard Skinnemoen 16127d2be074SHaavard Skinnemoen regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); 16137d2be074SHaavard Skinnemoen if (!regs) 16147d2be074SHaavard Skinnemoen return -ENXIO; 16157d2be074SHaavard Skinnemoen pdata = pdev->dev.platform_data; 16167d2be074SHaavard Skinnemoen if (!pdata) 16177d2be074SHaavard Skinnemoen return -ENXIO; 16187d2be074SHaavard Skinnemoen irq = platform_get_irq(pdev, 0); 16197d2be074SHaavard Skinnemoen if (irq < 0) 16207d2be074SHaavard Skinnemoen return irq; 16217d2be074SHaavard Skinnemoen 1622965ebf33SHaavard Skinnemoen host = kzalloc(sizeof(struct atmel_mci), GFP_KERNEL); 1623965ebf33SHaavard Skinnemoen if (!host) 16247d2be074SHaavard Skinnemoen return -ENOMEM; 16257d2be074SHaavard Skinnemoen 16267d2be074SHaavard Skinnemoen host->pdev = pdev; 1627965ebf33SHaavard Skinnemoen spin_lock_init(&host->lock); 1628965ebf33SHaavard Skinnemoen INIT_LIST_HEAD(&host->queue); 16297d2be074SHaavard Skinnemoen 16307d2be074SHaavard Skinnemoen host->mck = clk_get(&pdev->dev, "mci_clk"); 16317d2be074SHaavard Skinnemoen if (IS_ERR(host->mck)) { 16327d2be074SHaavard Skinnemoen ret = PTR_ERR(host->mck); 16337d2be074SHaavard Skinnemoen goto err_clk_get; 16347d2be074SHaavard Skinnemoen } 16357d2be074SHaavard Skinnemoen 16367d2be074SHaavard Skinnemoen ret = -ENOMEM; 16377d2be074SHaavard Skinnemoen host->regs = ioremap(regs->start, regs->end - regs->start + 1); 16387d2be074SHaavard Skinnemoen if (!host->regs) 16397d2be074SHaavard Skinnemoen goto err_ioremap; 16407d2be074SHaavard Skinnemoen 16417d2be074SHaavard Skinnemoen clk_enable(host->mck); 16427d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 16437d2be074SHaavard Skinnemoen host->bus_hz = clk_get_rate(host->mck); 16447d2be074SHaavard Skinnemoen clk_disable(host->mck); 16457d2be074SHaavard Skinnemoen 16467d2be074SHaavard Skinnemoen host->mapbase = regs->start; 16477d2be074SHaavard Skinnemoen 1648965ebf33SHaavard Skinnemoen tasklet_init(&host->tasklet, atmci_tasklet_func, (unsigned long)host); 16497d2be074SHaavard Skinnemoen 1650965ebf33SHaavard Skinnemoen ret = request_irq(irq, atmci_interrupt, 0, pdev->dev.bus_id, host); 16517d2be074SHaavard Skinnemoen if (ret) 16527d2be074SHaavard Skinnemoen goto err_request_irq; 16537d2be074SHaavard Skinnemoen 165465e8b083SHaavard Skinnemoen #ifdef CONFIG_MMC_ATMELMCI_DMA 165565e8b083SHaavard Skinnemoen if (pdata->dma_slave) { 165665e8b083SHaavard Skinnemoen struct dma_slave *slave = pdata->dma_slave; 165765e8b083SHaavard Skinnemoen 165865e8b083SHaavard Skinnemoen slave->tx_reg = regs->start + MCI_TDR; 165965e8b083SHaavard Skinnemoen slave->rx_reg = regs->start + MCI_RDR; 166065e8b083SHaavard Skinnemoen 166165e8b083SHaavard Skinnemoen /* Try to grab a DMA channel */ 166265e8b083SHaavard Skinnemoen host->dma.client.event_callback = atmci_dma_event; 166365e8b083SHaavard Skinnemoen dma_cap_set(DMA_SLAVE, host->dma.client.cap_mask); 166465e8b083SHaavard Skinnemoen host->dma.client.slave = slave; 166565e8b083SHaavard Skinnemoen 166665e8b083SHaavard Skinnemoen dma_async_client_register(&host->dma.client); 166765e8b083SHaavard Skinnemoen dma_async_client_chan_request(&host->dma.client); 166865e8b083SHaavard Skinnemoen } else { 166965e8b083SHaavard Skinnemoen dev_notice(&pdev->dev, "DMA not available, using PIO\n"); 167065e8b083SHaavard Skinnemoen } 167165e8b083SHaavard Skinnemoen #endif /* CONFIG_MMC_ATMELMCI_DMA */ 167265e8b083SHaavard Skinnemoen 16737d2be074SHaavard Skinnemoen platform_set_drvdata(pdev, host); 16747d2be074SHaavard Skinnemoen 1675965ebf33SHaavard Skinnemoen /* We need at least one slot to succeed */ 1676965ebf33SHaavard Skinnemoen nr_slots = 0; 1677965ebf33SHaavard Skinnemoen ret = -ENODEV; 1678965ebf33SHaavard Skinnemoen if (pdata->slot[0].bus_width) { 1679965ebf33SHaavard Skinnemoen ret = atmci_init_slot(host, &pdata->slot[0], 1680965ebf33SHaavard Skinnemoen MCI_SDCSEL_SLOT_A, 0); 1681965ebf33SHaavard Skinnemoen if (!ret) 1682965ebf33SHaavard Skinnemoen nr_slots++; 16837d2be074SHaavard Skinnemoen } 1684965ebf33SHaavard Skinnemoen if (pdata->slot[1].bus_width) { 1685965ebf33SHaavard Skinnemoen ret = atmci_init_slot(host, &pdata->slot[1], 1686965ebf33SHaavard Skinnemoen MCI_SDCSEL_SLOT_B, 1); 1687965ebf33SHaavard Skinnemoen if (!ret) 1688965ebf33SHaavard Skinnemoen nr_slots++; 16897d2be074SHaavard Skinnemoen } 16907d2be074SHaavard Skinnemoen 1691965ebf33SHaavard Skinnemoen if (!nr_slots) 1692965ebf33SHaavard Skinnemoen goto err_init_slot; 16937d2be074SHaavard Skinnemoen 1694965ebf33SHaavard Skinnemoen dev_info(&pdev->dev, 1695965ebf33SHaavard Skinnemoen "Atmel MCI controller at 0x%08lx irq %d, %u slots\n", 1696965ebf33SHaavard Skinnemoen host->mapbase, irq, nr_slots); 1697deec9ae3SHaavard Skinnemoen 16987d2be074SHaavard Skinnemoen return 0; 16997d2be074SHaavard Skinnemoen 1700965ebf33SHaavard Skinnemoen err_init_slot: 170165e8b083SHaavard Skinnemoen #ifdef CONFIG_MMC_ATMELMCI_DMA 170265e8b083SHaavard Skinnemoen if (pdata->dma_slave) 170365e8b083SHaavard Skinnemoen dma_async_client_unregister(&host->dma.client); 170465e8b083SHaavard Skinnemoen #endif 1705965ebf33SHaavard Skinnemoen free_irq(irq, host); 17067d2be074SHaavard Skinnemoen err_request_irq: 17077d2be074SHaavard Skinnemoen iounmap(host->regs); 17087d2be074SHaavard Skinnemoen err_ioremap: 17097d2be074SHaavard Skinnemoen clk_put(host->mck); 17107d2be074SHaavard Skinnemoen err_clk_get: 1711965ebf33SHaavard Skinnemoen kfree(host); 17127d2be074SHaavard Skinnemoen return ret; 17137d2be074SHaavard Skinnemoen } 17147d2be074SHaavard Skinnemoen 17157d2be074SHaavard Skinnemoen static int __exit atmci_remove(struct platform_device *pdev) 17167d2be074SHaavard Skinnemoen { 17177d2be074SHaavard Skinnemoen struct atmel_mci *host = platform_get_drvdata(pdev); 1718965ebf33SHaavard Skinnemoen unsigned int i; 17197d2be074SHaavard Skinnemoen 17207d2be074SHaavard Skinnemoen platform_set_drvdata(pdev, NULL); 17217d2be074SHaavard Skinnemoen 1722965ebf33SHaavard Skinnemoen for (i = 0; i < ATMEL_MCI_MAX_NR_SLOTS; i++) { 1723965ebf33SHaavard Skinnemoen if (host->slot[i]) 1724965ebf33SHaavard Skinnemoen atmci_cleanup_slot(host->slot[i], i); 17257d2be074SHaavard Skinnemoen } 17267d2be074SHaavard Skinnemoen 17277d2be074SHaavard Skinnemoen clk_enable(host->mck); 17287d2be074SHaavard Skinnemoen mci_writel(host, IDR, ~0UL); 17297d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIDIS); 17307d2be074SHaavard Skinnemoen mci_readl(host, SR); 17317d2be074SHaavard Skinnemoen clk_disable(host->mck); 17327d2be074SHaavard Skinnemoen 173365e8b083SHaavard Skinnemoen #ifdef CONFIG_MMC_ATMELMCI_DMA 173465e8b083SHaavard Skinnemoen if (host->dma.client.slave) 173565e8b083SHaavard Skinnemoen dma_async_client_unregister(&host->dma.client); 173665e8b083SHaavard Skinnemoen #endif 173765e8b083SHaavard Skinnemoen 1738965ebf33SHaavard Skinnemoen free_irq(platform_get_irq(pdev, 0), host); 17397d2be074SHaavard Skinnemoen iounmap(host->regs); 17407d2be074SHaavard Skinnemoen 17417d2be074SHaavard Skinnemoen clk_put(host->mck); 1742965ebf33SHaavard Skinnemoen kfree(host); 17437d2be074SHaavard Skinnemoen 17447d2be074SHaavard Skinnemoen return 0; 17457d2be074SHaavard Skinnemoen } 17467d2be074SHaavard Skinnemoen 17477d2be074SHaavard Skinnemoen static struct platform_driver atmci_driver = { 17487d2be074SHaavard Skinnemoen .remove = __exit_p(atmci_remove), 17497d2be074SHaavard Skinnemoen .driver = { 17507d2be074SHaavard Skinnemoen .name = "atmel_mci", 17517d2be074SHaavard Skinnemoen }, 17527d2be074SHaavard Skinnemoen }; 17537d2be074SHaavard Skinnemoen 17547d2be074SHaavard Skinnemoen static int __init atmci_init(void) 17557d2be074SHaavard Skinnemoen { 17567d2be074SHaavard Skinnemoen return platform_driver_probe(&atmci_driver, atmci_probe); 17577d2be074SHaavard Skinnemoen } 17587d2be074SHaavard Skinnemoen 17597d2be074SHaavard Skinnemoen static void __exit atmci_exit(void) 17607d2be074SHaavard Skinnemoen { 17617d2be074SHaavard Skinnemoen platform_driver_unregister(&atmci_driver); 17627d2be074SHaavard Skinnemoen } 17637d2be074SHaavard Skinnemoen 17647d2be074SHaavard Skinnemoen module_init(atmci_init); 17657d2be074SHaavard Skinnemoen module_exit(atmci_exit); 17667d2be074SHaavard Skinnemoen 17677d2be074SHaavard Skinnemoen MODULE_DESCRIPTION("Atmel Multimedia Card Interface driver"); 17687d2be074SHaavard Skinnemoen MODULE_AUTHOR("Haavard Skinnemoen <haavard.skinnemoen@atmel.com>"); 17697d2be074SHaavard Skinnemoen MODULE_LICENSE("GPL v2"); 1770