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> 14fbfca4b8SBen Nizette #include <linux/err.h> 153c26e170SDavid Brownell #include <linux/gpio.h> 167d2be074SHaavard Skinnemoen #include <linux/init.h> 177d2be074SHaavard Skinnemoen #include <linux/interrupt.h> 187d2be074SHaavard Skinnemoen #include <linux/ioport.h> 197d2be074SHaavard Skinnemoen #include <linux/module.h> 207d2be074SHaavard Skinnemoen #include <linux/platform_device.h> 217d2be074SHaavard Skinnemoen #include <linux/scatterlist.h> 22deec9ae3SHaavard Skinnemoen #include <linux/seq_file.h> 23deec9ae3SHaavard Skinnemoen #include <linux/stat.h> 247d2be074SHaavard Skinnemoen 257d2be074SHaavard Skinnemoen #include <linux/mmc/host.h> 267d2be074SHaavard Skinnemoen 277d2be074SHaavard Skinnemoen #include <asm/atmel-mci.h> 287d2be074SHaavard Skinnemoen #include <asm/io.h> 297d2be074SHaavard Skinnemoen #include <asm/unaligned.h> 307d2be074SHaavard Skinnemoen 313663b736SHaavard Skinnemoen #include <mach/board.h> 327d2be074SHaavard Skinnemoen 337d2be074SHaavard Skinnemoen #include "atmel-mci-regs.h" 347d2be074SHaavard Skinnemoen 357d2be074SHaavard Skinnemoen #define ATMCI_DATA_ERROR_FLAGS (MCI_DCRCE | MCI_DTOE | MCI_OVRE | MCI_UNRE) 367d2be074SHaavard Skinnemoen 377d2be074SHaavard Skinnemoen enum { 387d2be074SHaavard Skinnemoen EVENT_CMD_COMPLETE = 0, 397d2be074SHaavard Skinnemoen EVENT_XFER_COMPLETE, 40c06ad258SHaavard Skinnemoen EVENT_DATA_COMPLETE, 41c06ad258SHaavard Skinnemoen EVENT_DATA_ERROR, 42c06ad258SHaavard Skinnemoen }; 43c06ad258SHaavard Skinnemoen 44c06ad258SHaavard Skinnemoen enum atmel_mci_state { 45c06ad258SHaavard Skinnemoen STATE_SENDING_CMD = 0, 46c06ad258SHaavard Skinnemoen STATE_SENDING_DATA, 47c06ad258SHaavard Skinnemoen STATE_DATA_BUSY, 48c06ad258SHaavard Skinnemoen STATE_SENDING_STOP, 49c06ad258SHaavard Skinnemoen STATE_DATA_ERROR, 507d2be074SHaavard Skinnemoen }; 517d2be074SHaavard Skinnemoen 527d2be074SHaavard Skinnemoen struct atmel_mci { 537d2be074SHaavard Skinnemoen struct mmc_host *mmc; 547d2be074SHaavard Skinnemoen void __iomem *regs; 557d2be074SHaavard Skinnemoen 567d2be074SHaavard Skinnemoen struct scatterlist *sg; 577d2be074SHaavard Skinnemoen unsigned int pio_offset; 587d2be074SHaavard Skinnemoen 597d2be074SHaavard Skinnemoen struct mmc_request *mrq; 607d2be074SHaavard Skinnemoen struct mmc_command *cmd; 617d2be074SHaavard Skinnemoen struct mmc_data *data; 627d2be074SHaavard Skinnemoen 637d2be074SHaavard Skinnemoen u32 cmd_status; 647d2be074SHaavard Skinnemoen u32 data_status; 657d2be074SHaavard Skinnemoen u32 stop_cmdr; 667d2be074SHaavard Skinnemoen 677d2be074SHaavard Skinnemoen u32 mode_reg; 687d2be074SHaavard Skinnemoen u32 sdc_reg; 697d2be074SHaavard Skinnemoen 707d2be074SHaavard Skinnemoen struct tasklet_struct tasklet; 717d2be074SHaavard Skinnemoen unsigned long pending_events; 727d2be074SHaavard Skinnemoen unsigned long completed_events; 73c06ad258SHaavard Skinnemoen enum atmel_mci_state state; 747d2be074SHaavard Skinnemoen 757d2be074SHaavard Skinnemoen int present; 767d2be074SHaavard Skinnemoen int detect_pin; 777d2be074SHaavard Skinnemoen int wp_pin; 787d2be074SHaavard Skinnemoen 797d2be074SHaavard Skinnemoen /* For detect pin debouncing */ 807d2be074SHaavard Skinnemoen struct timer_list detect_timer; 817d2be074SHaavard Skinnemoen 827d2be074SHaavard Skinnemoen unsigned long bus_hz; 837d2be074SHaavard Skinnemoen unsigned long mapbase; 847d2be074SHaavard Skinnemoen struct clk *mck; 857d2be074SHaavard Skinnemoen struct platform_device *pdev; 867d2be074SHaavard Skinnemoen }; 877d2be074SHaavard Skinnemoen 887d2be074SHaavard Skinnemoen #define atmci_test_and_clear_pending(host, event) \ 897d2be074SHaavard Skinnemoen test_and_clear_bit(event, &host->pending_events) 907d2be074SHaavard Skinnemoen #define atmci_set_completed(host, event) \ 917d2be074SHaavard Skinnemoen set_bit(event, &host->completed_events) 927d2be074SHaavard Skinnemoen #define atmci_set_pending(host, event) \ 937d2be074SHaavard Skinnemoen set_bit(event, &host->pending_events) 947d2be074SHaavard Skinnemoen 95deec9ae3SHaavard Skinnemoen /* 96deec9ae3SHaavard Skinnemoen * The debugfs stuff below is mostly optimized away when 97deec9ae3SHaavard Skinnemoen * CONFIG_DEBUG_FS is not set. 98deec9ae3SHaavard Skinnemoen */ 99deec9ae3SHaavard Skinnemoen static int atmci_req_show(struct seq_file *s, void *v) 100deec9ae3SHaavard Skinnemoen { 101deec9ae3SHaavard Skinnemoen struct atmel_mci *host = s->private; 102deec9ae3SHaavard Skinnemoen struct mmc_request *mrq = host->mrq; 103deec9ae3SHaavard Skinnemoen struct mmc_command *cmd; 104deec9ae3SHaavard Skinnemoen struct mmc_command *stop; 105deec9ae3SHaavard Skinnemoen struct mmc_data *data; 106deec9ae3SHaavard Skinnemoen 107deec9ae3SHaavard Skinnemoen /* Make sure we get a consistent snapshot */ 108deec9ae3SHaavard Skinnemoen spin_lock_irq(&host->mmc->lock); 109deec9ae3SHaavard Skinnemoen 110deec9ae3SHaavard Skinnemoen if (mrq) { 111deec9ae3SHaavard Skinnemoen cmd = mrq->cmd; 112deec9ae3SHaavard Skinnemoen data = mrq->data; 113deec9ae3SHaavard Skinnemoen stop = mrq->stop; 114deec9ae3SHaavard Skinnemoen 115deec9ae3SHaavard Skinnemoen if (cmd) 116deec9ae3SHaavard Skinnemoen seq_printf(s, 117deec9ae3SHaavard Skinnemoen "CMD%u(0x%x) flg %x rsp %x %x %x %x err %d\n", 118deec9ae3SHaavard Skinnemoen cmd->opcode, cmd->arg, cmd->flags, 119deec9ae3SHaavard Skinnemoen cmd->resp[0], cmd->resp[1], cmd->resp[2], 120deec9ae3SHaavard Skinnemoen cmd->resp[2], cmd->error); 121deec9ae3SHaavard Skinnemoen if (data) 122deec9ae3SHaavard Skinnemoen seq_printf(s, "DATA %u / %u * %u flg %x err %d\n", 123deec9ae3SHaavard Skinnemoen data->bytes_xfered, data->blocks, 124deec9ae3SHaavard Skinnemoen data->blksz, data->flags, data->error); 125deec9ae3SHaavard Skinnemoen if (stop) 126deec9ae3SHaavard Skinnemoen seq_printf(s, 127deec9ae3SHaavard Skinnemoen "CMD%u(0x%x) flg %x rsp %x %x %x %x err %d\n", 128deec9ae3SHaavard Skinnemoen stop->opcode, stop->arg, stop->flags, 129deec9ae3SHaavard Skinnemoen stop->resp[0], stop->resp[1], stop->resp[2], 130deec9ae3SHaavard Skinnemoen stop->resp[2], stop->error); 131deec9ae3SHaavard Skinnemoen } 132deec9ae3SHaavard Skinnemoen 133deec9ae3SHaavard Skinnemoen spin_unlock_irq(&host->mmc->lock); 134deec9ae3SHaavard Skinnemoen 135deec9ae3SHaavard Skinnemoen return 0; 136deec9ae3SHaavard Skinnemoen } 137deec9ae3SHaavard Skinnemoen 138deec9ae3SHaavard Skinnemoen static int atmci_req_open(struct inode *inode, struct file *file) 139deec9ae3SHaavard Skinnemoen { 140deec9ae3SHaavard Skinnemoen return single_open(file, atmci_req_show, inode->i_private); 141deec9ae3SHaavard Skinnemoen } 142deec9ae3SHaavard Skinnemoen 143deec9ae3SHaavard Skinnemoen static const struct file_operations atmci_req_fops = { 144deec9ae3SHaavard Skinnemoen .owner = THIS_MODULE, 145deec9ae3SHaavard Skinnemoen .open = atmci_req_open, 146deec9ae3SHaavard Skinnemoen .read = seq_read, 147deec9ae3SHaavard Skinnemoen .llseek = seq_lseek, 148deec9ae3SHaavard Skinnemoen .release = single_release, 149deec9ae3SHaavard Skinnemoen }; 150deec9ae3SHaavard Skinnemoen 151deec9ae3SHaavard Skinnemoen static void atmci_show_status_reg(struct seq_file *s, 152deec9ae3SHaavard Skinnemoen const char *regname, u32 value) 153deec9ae3SHaavard Skinnemoen { 154deec9ae3SHaavard Skinnemoen static const char *sr_bit[] = { 155deec9ae3SHaavard Skinnemoen [0] = "CMDRDY", 156deec9ae3SHaavard Skinnemoen [1] = "RXRDY", 157deec9ae3SHaavard Skinnemoen [2] = "TXRDY", 158deec9ae3SHaavard Skinnemoen [3] = "BLKE", 159deec9ae3SHaavard Skinnemoen [4] = "DTIP", 160deec9ae3SHaavard Skinnemoen [5] = "NOTBUSY", 161deec9ae3SHaavard Skinnemoen [8] = "SDIOIRQA", 162deec9ae3SHaavard Skinnemoen [9] = "SDIOIRQB", 163deec9ae3SHaavard Skinnemoen [16] = "RINDE", 164deec9ae3SHaavard Skinnemoen [17] = "RDIRE", 165deec9ae3SHaavard Skinnemoen [18] = "RCRCE", 166deec9ae3SHaavard Skinnemoen [19] = "RENDE", 167deec9ae3SHaavard Skinnemoen [20] = "RTOE", 168deec9ae3SHaavard Skinnemoen [21] = "DCRCE", 169deec9ae3SHaavard Skinnemoen [22] = "DTOE", 170deec9ae3SHaavard Skinnemoen [30] = "OVRE", 171deec9ae3SHaavard Skinnemoen [31] = "UNRE", 172deec9ae3SHaavard Skinnemoen }; 173deec9ae3SHaavard Skinnemoen unsigned int i; 174deec9ae3SHaavard Skinnemoen 175deec9ae3SHaavard Skinnemoen seq_printf(s, "%s:\t0x%08x", regname, value); 176deec9ae3SHaavard Skinnemoen for (i = 0; i < ARRAY_SIZE(sr_bit); i++) { 177deec9ae3SHaavard Skinnemoen if (value & (1 << i)) { 178deec9ae3SHaavard Skinnemoen if (sr_bit[i]) 179deec9ae3SHaavard Skinnemoen seq_printf(s, " %s", sr_bit[i]); 180deec9ae3SHaavard Skinnemoen else 181deec9ae3SHaavard Skinnemoen seq_puts(s, " UNKNOWN"); 182deec9ae3SHaavard Skinnemoen } 183deec9ae3SHaavard Skinnemoen } 184deec9ae3SHaavard Skinnemoen seq_putc(s, '\n'); 185deec9ae3SHaavard Skinnemoen } 186deec9ae3SHaavard Skinnemoen 187deec9ae3SHaavard Skinnemoen static int atmci_regs_show(struct seq_file *s, void *v) 188deec9ae3SHaavard Skinnemoen { 189deec9ae3SHaavard Skinnemoen struct atmel_mci *host = s->private; 190deec9ae3SHaavard Skinnemoen u32 *buf; 191deec9ae3SHaavard Skinnemoen 192deec9ae3SHaavard Skinnemoen buf = kmalloc(MCI_REGS_SIZE, GFP_KERNEL); 193deec9ae3SHaavard Skinnemoen if (!buf) 194deec9ae3SHaavard Skinnemoen return -ENOMEM; 195deec9ae3SHaavard Skinnemoen 196deec9ae3SHaavard Skinnemoen /* Grab a more or less consistent snapshot */ 197deec9ae3SHaavard Skinnemoen spin_lock_irq(&host->mmc->lock); 19887e60f2bSHaavard Skinnemoen clk_enable(host->mck); 199deec9ae3SHaavard Skinnemoen memcpy_fromio(buf, host->regs, MCI_REGS_SIZE); 20087e60f2bSHaavard Skinnemoen clk_disable(host->mck); 201deec9ae3SHaavard Skinnemoen spin_unlock_irq(&host->mmc->lock); 202deec9ae3SHaavard Skinnemoen 203deec9ae3SHaavard Skinnemoen seq_printf(s, "MR:\t0x%08x%s%s CLKDIV=%u\n", 204deec9ae3SHaavard Skinnemoen buf[MCI_MR / 4], 205deec9ae3SHaavard Skinnemoen buf[MCI_MR / 4] & MCI_MR_RDPROOF ? " RDPROOF" : "", 206deec9ae3SHaavard Skinnemoen buf[MCI_MR / 4] & MCI_MR_WRPROOF ? " WRPROOF" : "", 207deec9ae3SHaavard Skinnemoen buf[MCI_MR / 4] & 0xff); 208deec9ae3SHaavard Skinnemoen seq_printf(s, "DTOR:\t0x%08x\n", buf[MCI_DTOR / 4]); 209deec9ae3SHaavard Skinnemoen seq_printf(s, "SDCR:\t0x%08x\n", buf[MCI_SDCR / 4]); 210deec9ae3SHaavard Skinnemoen seq_printf(s, "ARGR:\t0x%08x\n", buf[MCI_ARGR / 4]); 211deec9ae3SHaavard Skinnemoen seq_printf(s, "BLKR:\t0x%08x BCNT=%u BLKLEN=%u\n", 212deec9ae3SHaavard Skinnemoen buf[MCI_BLKR / 4], 213deec9ae3SHaavard Skinnemoen buf[MCI_BLKR / 4] & 0xffff, 214deec9ae3SHaavard Skinnemoen (buf[MCI_BLKR / 4] >> 16) & 0xffff); 215deec9ae3SHaavard Skinnemoen 216deec9ae3SHaavard Skinnemoen /* Don't read RSPR and RDR; it will consume the data there */ 217deec9ae3SHaavard Skinnemoen 218deec9ae3SHaavard Skinnemoen atmci_show_status_reg(s, "SR", buf[MCI_SR / 4]); 219deec9ae3SHaavard Skinnemoen atmci_show_status_reg(s, "IMR", buf[MCI_IMR / 4]); 220deec9ae3SHaavard Skinnemoen 221b17339a1SHaavard Skinnemoen kfree(buf); 222b17339a1SHaavard Skinnemoen 223deec9ae3SHaavard Skinnemoen return 0; 224deec9ae3SHaavard Skinnemoen } 225deec9ae3SHaavard Skinnemoen 226deec9ae3SHaavard Skinnemoen static int atmci_regs_open(struct inode *inode, struct file *file) 227deec9ae3SHaavard Skinnemoen { 228deec9ae3SHaavard Skinnemoen return single_open(file, atmci_regs_show, inode->i_private); 229deec9ae3SHaavard Skinnemoen } 230deec9ae3SHaavard Skinnemoen 231deec9ae3SHaavard Skinnemoen static const struct file_operations atmci_regs_fops = { 232deec9ae3SHaavard Skinnemoen .owner = THIS_MODULE, 233deec9ae3SHaavard Skinnemoen .open = atmci_regs_open, 234deec9ae3SHaavard Skinnemoen .read = seq_read, 235deec9ae3SHaavard Skinnemoen .llseek = seq_lseek, 236deec9ae3SHaavard Skinnemoen .release = single_release, 237deec9ae3SHaavard Skinnemoen }; 238deec9ae3SHaavard Skinnemoen 239deec9ae3SHaavard Skinnemoen static void atmci_init_debugfs(struct atmel_mci *host) 240deec9ae3SHaavard Skinnemoen { 241deec9ae3SHaavard Skinnemoen struct mmc_host *mmc; 242deec9ae3SHaavard Skinnemoen struct dentry *root; 243deec9ae3SHaavard Skinnemoen struct dentry *node; 244deec9ae3SHaavard Skinnemoen 245deec9ae3SHaavard Skinnemoen mmc = host->mmc; 246deec9ae3SHaavard Skinnemoen root = mmc->debugfs_root; 247deec9ae3SHaavard Skinnemoen if (!root) 248deec9ae3SHaavard Skinnemoen return; 249deec9ae3SHaavard Skinnemoen 250deec9ae3SHaavard Skinnemoen node = debugfs_create_file("regs", S_IRUSR, root, host, 251deec9ae3SHaavard Skinnemoen &atmci_regs_fops); 252deec9ae3SHaavard Skinnemoen if (IS_ERR(node)) 253deec9ae3SHaavard Skinnemoen return; 254deec9ae3SHaavard Skinnemoen if (!node) 255deec9ae3SHaavard Skinnemoen goto err; 256deec9ae3SHaavard Skinnemoen 257deec9ae3SHaavard Skinnemoen node = debugfs_create_file("req", S_IRUSR, root, host, &atmci_req_fops); 258deec9ae3SHaavard Skinnemoen if (!node) 259deec9ae3SHaavard Skinnemoen goto err; 260deec9ae3SHaavard Skinnemoen 261c06ad258SHaavard Skinnemoen node = debugfs_create_u32("state", S_IRUSR, root, (u32 *)&host->state); 262c06ad258SHaavard Skinnemoen if (!node) 263c06ad258SHaavard Skinnemoen goto err; 264c06ad258SHaavard Skinnemoen 265deec9ae3SHaavard Skinnemoen node = debugfs_create_x32("pending_events", S_IRUSR, root, 266deec9ae3SHaavard Skinnemoen (u32 *)&host->pending_events); 267deec9ae3SHaavard Skinnemoen if (!node) 268deec9ae3SHaavard Skinnemoen goto err; 269deec9ae3SHaavard Skinnemoen 270deec9ae3SHaavard Skinnemoen node = debugfs_create_x32("completed_events", S_IRUSR, root, 271deec9ae3SHaavard Skinnemoen (u32 *)&host->completed_events); 272deec9ae3SHaavard Skinnemoen if (!node) 273deec9ae3SHaavard Skinnemoen goto err; 274deec9ae3SHaavard Skinnemoen 275deec9ae3SHaavard Skinnemoen return; 276deec9ae3SHaavard Skinnemoen 277deec9ae3SHaavard Skinnemoen err: 278deec9ae3SHaavard Skinnemoen dev_err(&host->pdev->dev, 279deec9ae3SHaavard Skinnemoen "failed to initialize debugfs for controller\n"); 280deec9ae3SHaavard Skinnemoen } 2817d2be074SHaavard Skinnemoen 2827d2be074SHaavard Skinnemoen static void atmci_enable(struct atmel_mci *host) 2837d2be074SHaavard Skinnemoen { 2847d2be074SHaavard Skinnemoen clk_enable(host->mck); 2857d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 2867d2be074SHaavard Skinnemoen mci_writel(host, MR, host->mode_reg); 2877d2be074SHaavard Skinnemoen mci_writel(host, SDCR, host->sdc_reg); 2887d2be074SHaavard Skinnemoen } 2897d2be074SHaavard Skinnemoen 2907d2be074SHaavard Skinnemoen static void atmci_disable(struct atmel_mci *host) 2917d2be074SHaavard Skinnemoen { 2927d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 2937d2be074SHaavard Skinnemoen 2947d2be074SHaavard Skinnemoen /* Stall until write is complete, then disable the bus clock */ 2957d2be074SHaavard Skinnemoen mci_readl(host, SR); 2967d2be074SHaavard Skinnemoen clk_disable(host->mck); 2977d2be074SHaavard Skinnemoen } 2987d2be074SHaavard Skinnemoen 2997d2be074SHaavard Skinnemoen static inline unsigned int ns_to_clocks(struct atmel_mci *host, 3007d2be074SHaavard Skinnemoen unsigned int ns) 3017d2be074SHaavard Skinnemoen { 3027d2be074SHaavard Skinnemoen return (ns * (host->bus_hz / 1000000) + 999) / 1000; 3037d2be074SHaavard Skinnemoen } 3047d2be074SHaavard Skinnemoen 3057d2be074SHaavard Skinnemoen static void atmci_set_timeout(struct atmel_mci *host, 3067d2be074SHaavard Skinnemoen struct mmc_data *data) 3077d2be074SHaavard Skinnemoen { 3087d2be074SHaavard Skinnemoen static unsigned dtomul_to_shift[] = { 3097d2be074SHaavard Skinnemoen 0, 4, 7, 8, 10, 12, 16, 20 3107d2be074SHaavard Skinnemoen }; 3117d2be074SHaavard Skinnemoen unsigned timeout; 3127d2be074SHaavard Skinnemoen unsigned dtocyc; 3137d2be074SHaavard Skinnemoen unsigned dtomul; 3147d2be074SHaavard Skinnemoen 3157d2be074SHaavard Skinnemoen timeout = ns_to_clocks(host, data->timeout_ns) + data->timeout_clks; 3167d2be074SHaavard Skinnemoen 3177d2be074SHaavard Skinnemoen for (dtomul = 0; dtomul < 8; dtomul++) { 3187d2be074SHaavard Skinnemoen unsigned shift = dtomul_to_shift[dtomul]; 3197d2be074SHaavard Skinnemoen dtocyc = (timeout + (1 << shift) - 1) >> shift; 3207d2be074SHaavard Skinnemoen if (dtocyc < 15) 3217d2be074SHaavard Skinnemoen break; 3227d2be074SHaavard Skinnemoen } 3237d2be074SHaavard Skinnemoen 3247d2be074SHaavard Skinnemoen if (dtomul >= 8) { 3257d2be074SHaavard Skinnemoen dtomul = 7; 3267d2be074SHaavard Skinnemoen dtocyc = 15; 3277d2be074SHaavard Skinnemoen } 3287d2be074SHaavard Skinnemoen 3297d2be074SHaavard Skinnemoen dev_vdbg(&host->mmc->class_dev, "setting timeout to %u cycles\n", 3307d2be074SHaavard Skinnemoen dtocyc << dtomul_to_shift[dtomul]); 3317d2be074SHaavard Skinnemoen mci_writel(host, DTOR, (MCI_DTOMUL(dtomul) | MCI_DTOCYC(dtocyc))); 3327d2be074SHaavard Skinnemoen } 3337d2be074SHaavard Skinnemoen 3347d2be074SHaavard Skinnemoen /* 3357d2be074SHaavard Skinnemoen * Return mask with command flags to be enabled for this command. 3367d2be074SHaavard Skinnemoen */ 3377d2be074SHaavard Skinnemoen static u32 atmci_prepare_command(struct mmc_host *mmc, 3387d2be074SHaavard Skinnemoen struct mmc_command *cmd) 3397d2be074SHaavard Skinnemoen { 3407d2be074SHaavard Skinnemoen struct mmc_data *data; 3417d2be074SHaavard Skinnemoen u32 cmdr; 3427d2be074SHaavard Skinnemoen 3437d2be074SHaavard Skinnemoen cmd->error = -EINPROGRESS; 3447d2be074SHaavard Skinnemoen 3457d2be074SHaavard Skinnemoen cmdr = MCI_CMDR_CMDNB(cmd->opcode); 3467d2be074SHaavard Skinnemoen 3477d2be074SHaavard Skinnemoen if (cmd->flags & MMC_RSP_PRESENT) { 3487d2be074SHaavard Skinnemoen if (cmd->flags & MMC_RSP_136) 3497d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_RSPTYP_136BIT; 3507d2be074SHaavard Skinnemoen else 3517d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_RSPTYP_48BIT; 3527d2be074SHaavard Skinnemoen } 3537d2be074SHaavard Skinnemoen 3547d2be074SHaavard Skinnemoen /* 3557d2be074SHaavard Skinnemoen * This should really be MAXLAT_5 for CMD2 and ACMD41, but 3567d2be074SHaavard Skinnemoen * it's too difficult to determine whether this is an ACMD or 3577d2be074SHaavard Skinnemoen * not. Better make it 64. 3587d2be074SHaavard Skinnemoen */ 3597d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_MAXLAT_64CYC; 3607d2be074SHaavard Skinnemoen 3617d2be074SHaavard Skinnemoen if (mmc->ios.bus_mode == MMC_BUSMODE_OPENDRAIN) 3627d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_OPDCMD; 3637d2be074SHaavard Skinnemoen 3647d2be074SHaavard Skinnemoen data = cmd->data; 3657d2be074SHaavard Skinnemoen if (data) { 3667d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_START_XFER; 3677d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_STREAM) 3687d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_STREAM; 3697d2be074SHaavard Skinnemoen else if (data->blocks > 1) 3707d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_MULTI_BLOCK; 3717d2be074SHaavard Skinnemoen else 3727d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_BLOCK; 3737d2be074SHaavard Skinnemoen 3747d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_READ) 3757d2be074SHaavard Skinnemoen cmdr |= MCI_CMDR_TRDIR_READ; 3767d2be074SHaavard Skinnemoen } 3777d2be074SHaavard Skinnemoen 3787d2be074SHaavard Skinnemoen return cmdr; 3797d2be074SHaavard Skinnemoen } 3807d2be074SHaavard Skinnemoen 3817d2be074SHaavard Skinnemoen static void atmci_start_command(struct atmel_mci *host, 3827d2be074SHaavard Skinnemoen struct mmc_command *cmd, 3837d2be074SHaavard Skinnemoen u32 cmd_flags) 3847d2be074SHaavard Skinnemoen { 3857d2be074SHaavard Skinnemoen WARN_ON(host->cmd); 3867d2be074SHaavard Skinnemoen host->cmd = cmd; 3877d2be074SHaavard Skinnemoen 3887d2be074SHaavard Skinnemoen dev_vdbg(&host->mmc->class_dev, 3897d2be074SHaavard Skinnemoen "start command: ARGR=0x%08x CMDR=0x%08x\n", 3907d2be074SHaavard Skinnemoen cmd->arg, cmd_flags); 3917d2be074SHaavard Skinnemoen 3927d2be074SHaavard Skinnemoen mci_writel(host, ARGR, cmd->arg); 3937d2be074SHaavard Skinnemoen mci_writel(host, CMDR, cmd_flags); 3947d2be074SHaavard Skinnemoen } 3957d2be074SHaavard Skinnemoen 3967d2be074SHaavard Skinnemoen static void send_stop_cmd(struct mmc_host *mmc, struct mmc_data *data) 3977d2be074SHaavard Skinnemoen { 3987d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 3997d2be074SHaavard Skinnemoen 4007d2be074SHaavard Skinnemoen atmci_start_command(host, data->stop, host->stop_cmdr); 4017d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_CMDRDY); 4027d2be074SHaavard Skinnemoen } 4037d2be074SHaavard Skinnemoen 4047d2be074SHaavard Skinnemoen static void atmci_request_end(struct mmc_host *mmc, struct mmc_request *mrq) 4057d2be074SHaavard Skinnemoen { 4067d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 4077d2be074SHaavard Skinnemoen 4087d2be074SHaavard Skinnemoen WARN_ON(host->cmd || host->data); 4097d2be074SHaavard Skinnemoen host->mrq = NULL; 4107d2be074SHaavard Skinnemoen 4117d2be074SHaavard Skinnemoen atmci_disable(host); 4127d2be074SHaavard Skinnemoen 4137d2be074SHaavard Skinnemoen mmc_request_done(mmc, mrq); 4147d2be074SHaavard Skinnemoen } 4157d2be074SHaavard Skinnemoen 4167d2be074SHaavard Skinnemoen /* 4177d2be074SHaavard Skinnemoen * Returns a mask of interrupt flags to be enabled after the whole 4187d2be074SHaavard Skinnemoen * request has been prepared. 4197d2be074SHaavard Skinnemoen */ 4207d2be074SHaavard Skinnemoen static u32 atmci_submit_data(struct mmc_host *mmc, struct mmc_data *data) 4217d2be074SHaavard Skinnemoen { 4227d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 4237d2be074SHaavard Skinnemoen u32 iflags; 4247d2be074SHaavard Skinnemoen 4257d2be074SHaavard Skinnemoen data->error = -EINPROGRESS; 4267d2be074SHaavard Skinnemoen 4277d2be074SHaavard Skinnemoen WARN_ON(host->data); 4287d2be074SHaavard Skinnemoen host->sg = NULL; 4297d2be074SHaavard Skinnemoen host->data = data; 4307d2be074SHaavard Skinnemoen 4317d2be074SHaavard Skinnemoen dev_vdbg(&mmc->class_dev, "BLKR=0x%08x\n", 4327d2be074SHaavard Skinnemoen MCI_BCNT(data->blocks) | MCI_BLKLEN(data->blksz)); 4337d2be074SHaavard Skinnemoen 4347d2be074SHaavard Skinnemoen iflags = ATMCI_DATA_ERROR_FLAGS; 4357d2be074SHaavard Skinnemoen host->sg = data->sg; 4367d2be074SHaavard Skinnemoen host->pio_offset = 0; 4377d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_READ) 4387d2be074SHaavard Skinnemoen iflags |= MCI_RXRDY; 4397d2be074SHaavard Skinnemoen else 4407d2be074SHaavard Skinnemoen iflags |= MCI_TXRDY; 4417d2be074SHaavard Skinnemoen 4427d2be074SHaavard Skinnemoen return iflags; 4437d2be074SHaavard Skinnemoen } 4447d2be074SHaavard Skinnemoen 4457d2be074SHaavard Skinnemoen static void atmci_request(struct mmc_host *mmc, struct mmc_request *mrq) 4467d2be074SHaavard Skinnemoen { 4477d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 4487d2be074SHaavard Skinnemoen struct mmc_data *data; 4497d2be074SHaavard Skinnemoen struct mmc_command *cmd; 4507d2be074SHaavard Skinnemoen u32 iflags; 4517d2be074SHaavard Skinnemoen u32 cmdflags = 0; 4527d2be074SHaavard Skinnemoen 4537d2be074SHaavard Skinnemoen iflags = mci_readl(host, IMR); 4547d2be074SHaavard Skinnemoen if (iflags) 4557d2be074SHaavard Skinnemoen dev_warn(&mmc->class_dev, "WARNING: IMR=0x%08x\n", 4567d2be074SHaavard Skinnemoen mci_readl(host, IMR)); 4577d2be074SHaavard Skinnemoen 4587d2be074SHaavard Skinnemoen WARN_ON(host->mrq != NULL); 4597d2be074SHaavard Skinnemoen 4607d2be074SHaavard Skinnemoen /* 4617d2be074SHaavard Skinnemoen * We may "know" the card is gone even though there's still an 4627d2be074SHaavard Skinnemoen * electrical connection. If so, we really need to communicate 4637d2be074SHaavard Skinnemoen * this to the MMC core since there won't be any more 4647d2be074SHaavard Skinnemoen * interrupts as the card is completely removed. Otherwise, 4657d2be074SHaavard Skinnemoen * the MMC core might believe the card is still there even 4667d2be074SHaavard Skinnemoen * though the card was just removed very slowly. 4677d2be074SHaavard Skinnemoen */ 4687d2be074SHaavard Skinnemoen if (!host->present) { 4697d2be074SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 4707d2be074SHaavard Skinnemoen mmc_request_done(mmc, mrq); 4717d2be074SHaavard Skinnemoen return; 4727d2be074SHaavard Skinnemoen } 4737d2be074SHaavard Skinnemoen 4747d2be074SHaavard Skinnemoen host->mrq = mrq; 4757d2be074SHaavard Skinnemoen host->pending_events = 0; 4767d2be074SHaavard Skinnemoen host->completed_events = 0; 477c06ad258SHaavard Skinnemoen host->state = STATE_SENDING_CMD; 4787d2be074SHaavard Skinnemoen 4797d2be074SHaavard Skinnemoen atmci_enable(host); 4807d2be074SHaavard Skinnemoen 4817d2be074SHaavard Skinnemoen /* We don't support multiple blocks of weird lengths. */ 4827d2be074SHaavard Skinnemoen data = mrq->data; 4837d2be074SHaavard Skinnemoen if (data) { 4847d2be074SHaavard Skinnemoen if (data->blocks > 1 && data->blksz & 3) 4857d2be074SHaavard Skinnemoen goto fail; 4867d2be074SHaavard Skinnemoen atmci_set_timeout(host, data); 487a252e3e3SHaavard Skinnemoen 488a252e3e3SHaavard Skinnemoen /* Must set block count/size before sending command */ 489a252e3e3SHaavard Skinnemoen mci_writel(host, BLKR, MCI_BCNT(data->blocks) 490a252e3e3SHaavard Skinnemoen | MCI_BLKLEN(data->blksz)); 4917d2be074SHaavard Skinnemoen } 4927d2be074SHaavard Skinnemoen 4937d2be074SHaavard Skinnemoen iflags = MCI_CMDRDY; 4947d2be074SHaavard Skinnemoen cmd = mrq->cmd; 4957d2be074SHaavard Skinnemoen cmdflags = atmci_prepare_command(mmc, cmd); 4967d2be074SHaavard Skinnemoen atmci_start_command(host, cmd, cmdflags); 4977d2be074SHaavard Skinnemoen 4987d2be074SHaavard Skinnemoen if (data) 4997d2be074SHaavard Skinnemoen iflags |= atmci_submit_data(mmc, data); 5007d2be074SHaavard Skinnemoen 5017d2be074SHaavard Skinnemoen if (mrq->stop) { 5027d2be074SHaavard Skinnemoen host->stop_cmdr = atmci_prepare_command(mmc, mrq->stop); 5037d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_STOP_XFER; 5047d2be074SHaavard Skinnemoen if (!(data->flags & MMC_DATA_WRITE)) 5057d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_TRDIR_READ; 5067d2be074SHaavard Skinnemoen if (data->flags & MMC_DATA_STREAM) 5077d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_STREAM; 5087d2be074SHaavard Skinnemoen else 5097d2be074SHaavard Skinnemoen host->stop_cmdr |= MCI_CMDR_MULTI_BLOCK; 5107d2be074SHaavard Skinnemoen } 5117d2be074SHaavard Skinnemoen 5127d2be074SHaavard Skinnemoen /* 5137d2be074SHaavard Skinnemoen * We could have enabled interrupts earlier, but I suspect 5147d2be074SHaavard Skinnemoen * that would open up a nice can of interesting race 5157d2be074SHaavard Skinnemoen * conditions (e.g. command and data complete, but stop not 5167d2be074SHaavard Skinnemoen * prepared yet.) 5177d2be074SHaavard Skinnemoen */ 5187d2be074SHaavard Skinnemoen mci_writel(host, IER, iflags); 5197d2be074SHaavard Skinnemoen 5207d2be074SHaavard Skinnemoen return; 5217d2be074SHaavard Skinnemoen 5227d2be074SHaavard Skinnemoen fail: 5237d2be074SHaavard Skinnemoen atmci_disable(host); 5247d2be074SHaavard Skinnemoen host->mrq = NULL; 5257d2be074SHaavard Skinnemoen mrq->cmd->error = -EINVAL; 5267d2be074SHaavard Skinnemoen mmc_request_done(mmc, mrq); 5277d2be074SHaavard Skinnemoen } 5287d2be074SHaavard Skinnemoen 5297d2be074SHaavard Skinnemoen static void atmci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) 5307d2be074SHaavard Skinnemoen { 5317d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 5327d2be074SHaavard Skinnemoen 5337d2be074SHaavard Skinnemoen if (ios->clock) { 5347d2be074SHaavard Skinnemoen u32 clkdiv; 5357d2be074SHaavard Skinnemoen 5367d2be074SHaavard Skinnemoen /* Set clock rate */ 5377d2be074SHaavard Skinnemoen clkdiv = DIV_ROUND_UP(host->bus_hz, 2 * ios->clock) - 1; 5387d2be074SHaavard Skinnemoen if (clkdiv > 255) { 5397d2be074SHaavard Skinnemoen dev_warn(&mmc->class_dev, 5407d2be074SHaavard Skinnemoen "clock %u too slow; using %lu\n", 5417d2be074SHaavard Skinnemoen ios->clock, host->bus_hz / (2 * 256)); 5427d2be074SHaavard Skinnemoen clkdiv = 255; 5437d2be074SHaavard Skinnemoen } 5447d2be074SHaavard Skinnemoen 5457d2be074SHaavard Skinnemoen host->mode_reg = MCI_MR_CLKDIV(clkdiv) | MCI_MR_WRPROOF 5467d2be074SHaavard Skinnemoen | MCI_MR_RDPROOF; 5477d2be074SHaavard Skinnemoen } 5487d2be074SHaavard Skinnemoen 5497d2be074SHaavard Skinnemoen switch (ios->bus_width) { 5507d2be074SHaavard Skinnemoen case MMC_BUS_WIDTH_1: 5517d2be074SHaavard Skinnemoen host->sdc_reg = 0; 5527d2be074SHaavard Skinnemoen break; 5537d2be074SHaavard Skinnemoen case MMC_BUS_WIDTH_4: 5547d2be074SHaavard Skinnemoen host->sdc_reg = MCI_SDCBUS_4BIT; 5557d2be074SHaavard Skinnemoen break; 5567d2be074SHaavard Skinnemoen } 5577d2be074SHaavard Skinnemoen 5587d2be074SHaavard Skinnemoen switch (ios->power_mode) { 5597d2be074SHaavard Skinnemoen case MMC_POWER_ON: 5607d2be074SHaavard Skinnemoen /* Send init sequence (74 clock cycles) */ 5617d2be074SHaavard Skinnemoen atmci_enable(host); 5627d2be074SHaavard Skinnemoen mci_writel(host, CMDR, MCI_CMDR_SPCMD_INIT); 5637d2be074SHaavard Skinnemoen while (!(mci_readl(host, SR) & MCI_CMDRDY)) 5647d2be074SHaavard Skinnemoen cpu_relax(); 5657d2be074SHaavard Skinnemoen atmci_disable(host); 5667d2be074SHaavard Skinnemoen break; 5677d2be074SHaavard Skinnemoen default: 5687d2be074SHaavard Skinnemoen /* 5697d2be074SHaavard Skinnemoen * TODO: None of the currently available AVR32-based 5707d2be074SHaavard Skinnemoen * boards allow MMC power to be turned off. Implement 5717d2be074SHaavard Skinnemoen * power control when this can be tested properly. 5727d2be074SHaavard Skinnemoen */ 5737d2be074SHaavard Skinnemoen break; 5747d2be074SHaavard Skinnemoen } 5757d2be074SHaavard Skinnemoen } 5767d2be074SHaavard Skinnemoen 5777d2be074SHaavard Skinnemoen static int atmci_get_ro(struct mmc_host *mmc) 5787d2be074SHaavard Skinnemoen { 5797d2be074SHaavard Skinnemoen int read_only = 0; 5807d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 5817d2be074SHaavard Skinnemoen 5823c26e170SDavid Brownell if (gpio_is_valid(host->wp_pin)) { 5837d2be074SHaavard Skinnemoen read_only = gpio_get_value(host->wp_pin); 5847d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "card is %s\n", 5857d2be074SHaavard Skinnemoen read_only ? "read-only" : "read-write"); 5867d2be074SHaavard Skinnemoen } else { 5877d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 5887d2be074SHaavard Skinnemoen "no pin for checking read-only switch." 5897d2be074SHaavard Skinnemoen " Assuming write-enable.\n"); 5907d2be074SHaavard Skinnemoen } 5917d2be074SHaavard Skinnemoen 5927d2be074SHaavard Skinnemoen return read_only; 5937d2be074SHaavard Skinnemoen } 5947d2be074SHaavard Skinnemoen 5957d2be074SHaavard Skinnemoen static struct mmc_host_ops atmci_ops = { 5967d2be074SHaavard Skinnemoen .request = atmci_request, 5977d2be074SHaavard Skinnemoen .set_ios = atmci_set_ios, 5987d2be074SHaavard Skinnemoen .get_ro = atmci_get_ro, 5997d2be074SHaavard Skinnemoen }; 6007d2be074SHaavard Skinnemoen 6017d2be074SHaavard Skinnemoen static void atmci_command_complete(struct atmel_mci *host, 602c06ad258SHaavard Skinnemoen struct mmc_command *cmd) 6037d2be074SHaavard Skinnemoen { 604c06ad258SHaavard Skinnemoen u32 status = host->cmd_status; 605c06ad258SHaavard Skinnemoen 6067d2be074SHaavard Skinnemoen /* Read the response from the card (up to 16 bytes) */ 6077d2be074SHaavard Skinnemoen cmd->resp[0] = mci_readl(host, RSPR); 6087d2be074SHaavard Skinnemoen cmd->resp[1] = mci_readl(host, RSPR); 6097d2be074SHaavard Skinnemoen cmd->resp[2] = mci_readl(host, RSPR); 6107d2be074SHaavard Skinnemoen cmd->resp[3] = mci_readl(host, RSPR); 6117d2be074SHaavard Skinnemoen 6127d2be074SHaavard Skinnemoen if (status & MCI_RTOE) 6137d2be074SHaavard Skinnemoen cmd->error = -ETIMEDOUT; 6147d2be074SHaavard Skinnemoen else if ((cmd->flags & MMC_RSP_CRC) && (status & MCI_RCRCE)) 6157d2be074SHaavard Skinnemoen cmd->error = -EILSEQ; 6167d2be074SHaavard Skinnemoen else if (status & (MCI_RINDE | MCI_RDIRE | MCI_RENDE)) 6177d2be074SHaavard Skinnemoen cmd->error = -EIO; 6187d2be074SHaavard Skinnemoen else 6197d2be074SHaavard Skinnemoen cmd->error = 0; 6207d2be074SHaavard Skinnemoen 6217d2be074SHaavard Skinnemoen if (cmd->error) { 6227d2be074SHaavard Skinnemoen dev_dbg(&host->mmc->class_dev, 6237d2be074SHaavard Skinnemoen "command error: status=0x%08x\n", status); 6247d2be074SHaavard Skinnemoen 6257d2be074SHaavard Skinnemoen if (cmd->data) { 6267d2be074SHaavard Skinnemoen host->data = NULL; 6277d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_NOTBUSY 6287d2be074SHaavard Skinnemoen | MCI_TXRDY | MCI_RXRDY 6297d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS); 6307d2be074SHaavard Skinnemoen } 6317d2be074SHaavard Skinnemoen } 6327d2be074SHaavard Skinnemoen } 6337d2be074SHaavard Skinnemoen 6347d2be074SHaavard Skinnemoen static void atmci_detect_change(unsigned long data) 6357d2be074SHaavard Skinnemoen { 6367d2be074SHaavard Skinnemoen struct atmel_mci *host = (struct atmel_mci *)data; 6377d2be074SHaavard Skinnemoen struct mmc_request *mrq = host->mrq; 6387d2be074SHaavard Skinnemoen int present; 6397d2be074SHaavard Skinnemoen 6407d2be074SHaavard Skinnemoen /* 6417d2be074SHaavard Skinnemoen * atmci_remove() sets detect_pin to -1 before freeing the 6427d2be074SHaavard Skinnemoen * interrupt. We must not re-enable the interrupt if it has 6437d2be074SHaavard Skinnemoen * been freed. 6447d2be074SHaavard Skinnemoen */ 6457d2be074SHaavard Skinnemoen smp_rmb(); 6463c26e170SDavid Brownell if (!gpio_is_valid(host->detect_pin)) 6477d2be074SHaavard Skinnemoen return; 6487d2be074SHaavard Skinnemoen 6497d2be074SHaavard Skinnemoen enable_irq(gpio_to_irq(host->detect_pin)); 6507d2be074SHaavard Skinnemoen present = !gpio_get_value(host->detect_pin); 6517d2be074SHaavard Skinnemoen 6527d2be074SHaavard Skinnemoen dev_vdbg(&host->pdev->dev, "detect change: %d (was %d)\n", 6537d2be074SHaavard Skinnemoen present, host->present); 6547d2be074SHaavard Skinnemoen 6557d2be074SHaavard Skinnemoen if (present != host->present) { 6567d2be074SHaavard Skinnemoen dev_dbg(&host->mmc->class_dev, "card %s\n", 6577d2be074SHaavard Skinnemoen present ? "inserted" : "removed"); 6587d2be074SHaavard Skinnemoen host->present = present; 6597d2be074SHaavard Skinnemoen 6607d2be074SHaavard Skinnemoen /* Reset controller if card is gone */ 6617d2be074SHaavard Skinnemoen if (!present) { 6627d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 6637d2be074SHaavard Skinnemoen mci_writel(host, IDR, ~0UL); 6647d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIEN); 6657d2be074SHaavard Skinnemoen } 6667d2be074SHaavard Skinnemoen 6677d2be074SHaavard Skinnemoen /* Clean up queue if present */ 6687d2be074SHaavard Skinnemoen if (mrq) { 6697d2be074SHaavard Skinnemoen /* 6707d2be074SHaavard Skinnemoen * Reset controller to terminate any ongoing 6717d2be074SHaavard Skinnemoen * commands or data transfers. 6727d2be074SHaavard Skinnemoen */ 6737d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 674c06ad258SHaavard Skinnemoen mci_readl(host, SR); 6757d2be074SHaavard Skinnemoen 6767d2be074SHaavard Skinnemoen host->data = NULL; 6777d2be074SHaavard Skinnemoen host->cmd = NULL; 678c06ad258SHaavard Skinnemoen 679c06ad258SHaavard Skinnemoen switch (host->state) { 680c06ad258SHaavard Skinnemoen case STATE_SENDING_CMD: 681c06ad258SHaavard Skinnemoen mrq->cmd->error = -ENOMEDIUM; 682c06ad258SHaavard Skinnemoen if (!mrq->data) 683c06ad258SHaavard Skinnemoen break; 684c06ad258SHaavard Skinnemoen /* fall through */ 685c06ad258SHaavard Skinnemoen case STATE_SENDING_DATA: 686c06ad258SHaavard Skinnemoen mrq->data->error = -ENOMEDIUM; 687c06ad258SHaavard Skinnemoen break; 688c06ad258SHaavard Skinnemoen case STATE_DATA_BUSY: 689c06ad258SHaavard Skinnemoen case STATE_DATA_ERROR: 690c06ad258SHaavard Skinnemoen if (mrq->data->error == -EINPROGRESS) 691c06ad258SHaavard Skinnemoen mrq->data->error = -ENOMEDIUM; 692c06ad258SHaavard Skinnemoen if (!mrq->stop) 693c06ad258SHaavard Skinnemoen break; 694c06ad258SHaavard Skinnemoen /* fall through */ 695c06ad258SHaavard Skinnemoen case STATE_SENDING_STOP: 696c06ad258SHaavard Skinnemoen mrq->stop->error = -ENOMEDIUM; 697c06ad258SHaavard Skinnemoen break; 698c06ad258SHaavard Skinnemoen } 699c06ad258SHaavard Skinnemoen 7007d2be074SHaavard Skinnemoen atmci_request_end(host->mmc, mrq); 7017d2be074SHaavard Skinnemoen } 7027d2be074SHaavard Skinnemoen 7037d2be074SHaavard Skinnemoen mmc_detect_change(host->mmc, 0); 7047d2be074SHaavard Skinnemoen } 7057d2be074SHaavard Skinnemoen } 7067d2be074SHaavard Skinnemoen 7077d2be074SHaavard Skinnemoen static void atmci_tasklet_func(unsigned long priv) 7087d2be074SHaavard Skinnemoen { 7097d2be074SHaavard Skinnemoen struct mmc_host *mmc = (struct mmc_host *)priv; 7107d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 7117d2be074SHaavard Skinnemoen struct mmc_request *mrq = host->mrq; 7127d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 713c06ad258SHaavard Skinnemoen struct mmc_command *cmd = host->cmd; 714c06ad258SHaavard Skinnemoen enum atmel_mci_state state = host->state; 715c06ad258SHaavard Skinnemoen enum atmel_mci_state prev_state; 716c06ad258SHaavard Skinnemoen u32 status; 717c06ad258SHaavard Skinnemoen 718c06ad258SHaavard Skinnemoen state = host->state; 7197d2be074SHaavard Skinnemoen 7207d2be074SHaavard Skinnemoen dev_vdbg(&mmc->class_dev, 721c06ad258SHaavard Skinnemoen "tasklet: state %u pending/completed/mask %lx/%lx/%x\n", 722c06ad258SHaavard Skinnemoen state, host->pending_events, host->completed_events, 7237d2be074SHaavard Skinnemoen mci_readl(host, IMR)); 7247d2be074SHaavard Skinnemoen 725c06ad258SHaavard Skinnemoen do { 726c06ad258SHaavard Skinnemoen prev_state = state; 727c06ad258SHaavard Skinnemoen 728c06ad258SHaavard Skinnemoen switch (state) { 729c06ad258SHaavard Skinnemoen case STATE_SENDING_CMD: 730c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 731c06ad258SHaavard Skinnemoen EVENT_CMD_COMPLETE)) 732c06ad258SHaavard Skinnemoen break; 733c06ad258SHaavard Skinnemoen 7347d2be074SHaavard Skinnemoen host->cmd = NULL; 7357d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_CMD_COMPLETE); 736c06ad258SHaavard Skinnemoen atmci_command_complete(host, mrq->cmd); 737c06ad258SHaavard Skinnemoen if (!mrq->data || cmd->error) { 738c06ad258SHaavard Skinnemoen atmci_request_end(mmc, host->mrq); 739c06ad258SHaavard Skinnemoen break; 7407d2be074SHaavard Skinnemoen } 741c06ad258SHaavard Skinnemoen 742c06ad258SHaavard Skinnemoen prev_state = state = STATE_SENDING_DATA; 743c06ad258SHaavard Skinnemoen /* fall through */ 744c06ad258SHaavard Skinnemoen 745c06ad258SHaavard Skinnemoen case STATE_SENDING_DATA: 746c06ad258SHaavard Skinnemoen if (atmci_test_and_clear_pending(host, 747c06ad258SHaavard Skinnemoen EVENT_DATA_ERROR)) { 748c06ad258SHaavard Skinnemoen if (data->stop) 749c06ad258SHaavard Skinnemoen send_stop_cmd(host->mmc, data); 750c06ad258SHaavard Skinnemoen state = STATE_DATA_ERROR; 751c06ad258SHaavard Skinnemoen break; 7527d2be074SHaavard Skinnemoen } 7537d2be074SHaavard Skinnemoen 754c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 755c06ad258SHaavard Skinnemoen EVENT_XFER_COMPLETE)) 756c06ad258SHaavard Skinnemoen break; 7577d2be074SHaavard Skinnemoen 758c06ad258SHaavard Skinnemoen atmci_set_completed(host, EVENT_XFER_COMPLETE); 759c06ad258SHaavard Skinnemoen prev_state = state = STATE_DATA_BUSY; 760c06ad258SHaavard Skinnemoen /* fall through */ 761c06ad258SHaavard Skinnemoen 762c06ad258SHaavard Skinnemoen case STATE_DATA_BUSY: 763c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 764c06ad258SHaavard Skinnemoen EVENT_DATA_COMPLETE)) 765c06ad258SHaavard Skinnemoen break; 766c06ad258SHaavard Skinnemoen 767c06ad258SHaavard Skinnemoen host->data = NULL; 7687d2be074SHaavard Skinnemoen atmci_set_completed(host, EVENT_DATA_COMPLETE); 769c06ad258SHaavard Skinnemoen status = host->data_status; 770c06ad258SHaavard Skinnemoen if (unlikely(status & ATMCI_DATA_ERROR_FLAGS)) { 7717d2be074SHaavard Skinnemoen if (status & MCI_DTOE) { 7727d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 7737d2be074SHaavard Skinnemoen "data timeout error\n"); 7747d2be074SHaavard Skinnemoen data->error = -ETIMEDOUT; 7757d2be074SHaavard Skinnemoen } else if (status & MCI_DCRCE) { 776c06ad258SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 777c06ad258SHaavard Skinnemoen "data CRC error\n"); 7787d2be074SHaavard Skinnemoen data->error = -EILSEQ; 7797d2be074SHaavard Skinnemoen } else { 7807d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 7817d2be074SHaavard Skinnemoen "data FIFO error (status=%08x)\n", 7827d2be074SHaavard Skinnemoen status); 7837d2be074SHaavard Skinnemoen data->error = -EIO; 7847d2be074SHaavard Skinnemoen } 785c06ad258SHaavard Skinnemoen } else { 7867d2be074SHaavard Skinnemoen data->bytes_xfered = data->blocks * data->blksz; 7877d2be074SHaavard Skinnemoen data->error = 0; 7887d2be074SHaavard Skinnemoen } 7897d2be074SHaavard Skinnemoen 790c06ad258SHaavard Skinnemoen if (!data->stop) { 791c06ad258SHaavard Skinnemoen atmci_request_end(mmc, host->mrq); 792c06ad258SHaavard Skinnemoen prev_state = state; 793c06ad258SHaavard Skinnemoen break; 7947d2be074SHaavard Skinnemoen } 7957d2be074SHaavard Skinnemoen 796c06ad258SHaavard Skinnemoen prev_state = state = STATE_SENDING_STOP; 797c06ad258SHaavard Skinnemoen if (!data->error) 798c06ad258SHaavard Skinnemoen send_stop_cmd(host->mmc, data); 799c06ad258SHaavard Skinnemoen /* fall through */ 800c06ad258SHaavard Skinnemoen 801c06ad258SHaavard Skinnemoen case STATE_SENDING_STOP: 802c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 803c06ad258SHaavard Skinnemoen EVENT_CMD_COMPLETE)) 804c06ad258SHaavard Skinnemoen break; 805c06ad258SHaavard Skinnemoen 806c06ad258SHaavard Skinnemoen host->cmd = NULL; 807c06ad258SHaavard Skinnemoen atmci_command_complete(host, mrq->stop); 8087d2be074SHaavard Skinnemoen atmci_request_end(mmc, host->mrq); 809c06ad258SHaavard Skinnemoen prev_state = state; 810c06ad258SHaavard Skinnemoen break; 811c06ad258SHaavard Skinnemoen 812c06ad258SHaavard Skinnemoen case STATE_DATA_ERROR: 813c06ad258SHaavard Skinnemoen if (!atmci_test_and_clear_pending(host, 814c06ad258SHaavard Skinnemoen EVENT_XFER_COMPLETE)) 815c06ad258SHaavard Skinnemoen break; 816c06ad258SHaavard Skinnemoen 817c06ad258SHaavard Skinnemoen state = STATE_DATA_BUSY; 818c06ad258SHaavard Skinnemoen break; 819c06ad258SHaavard Skinnemoen } 820c06ad258SHaavard Skinnemoen } while (state != prev_state); 821c06ad258SHaavard Skinnemoen 822c06ad258SHaavard Skinnemoen host->state = state; 8237d2be074SHaavard Skinnemoen } 8247d2be074SHaavard Skinnemoen 8257d2be074SHaavard Skinnemoen static void atmci_read_data_pio(struct atmel_mci *host) 8267d2be074SHaavard Skinnemoen { 8277d2be074SHaavard Skinnemoen struct scatterlist *sg = host->sg; 8287d2be074SHaavard Skinnemoen void *buf = sg_virt(sg); 8297d2be074SHaavard Skinnemoen unsigned int offset = host->pio_offset; 8307d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 8317d2be074SHaavard Skinnemoen u32 value; 8327d2be074SHaavard Skinnemoen u32 status; 8337d2be074SHaavard Skinnemoen unsigned int nbytes = 0; 8347d2be074SHaavard Skinnemoen 8357d2be074SHaavard Skinnemoen do { 8367d2be074SHaavard Skinnemoen value = mci_readl(host, RDR); 8377d2be074SHaavard Skinnemoen if (likely(offset + 4 <= sg->length)) { 8387d2be074SHaavard Skinnemoen put_unaligned(value, (u32 *)(buf + offset)); 8397d2be074SHaavard Skinnemoen 8407d2be074SHaavard Skinnemoen offset += 4; 8417d2be074SHaavard Skinnemoen nbytes += 4; 8427d2be074SHaavard Skinnemoen 8437d2be074SHaavard Skinnemoen if (offset == sg->length) { 8447d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 8457d2be074SHaavard Skinnemoen if (!sg) 8467d2be074SHaavard Skinnemoen goto done; 8477d2be074SHaavard Skinnemoen 8487d2be074SHaavard Skinnemoen offset = 0; 8497d2be074SHaavard Skinnemoen buf = sg_virt(sg); 8507d2be074SHaavard Skinnemoen } 8517d2be074SHaavard Skinnemoen } else { 8527d2be074SHaavard Skinnemoen unsigned int remaining = sg->length - offset; 8537d2be074SHaavard Skinnemoen memcpy(buf + offset, &value, remaining); 8547d2be074SHaavard Skinnemoen nbytes += remaining; 8557d2be074SHaavard Skinnemoen 8567d2be074SHaavard Skinnemoen flush_dcache_page(sg_page(sg)); 8577d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 8587d2be074SHaavard Skinnemoen if (!sg) 8597d2be074SHaavard Skinnemoen goto done; 8607d2be074SHaavard Skinnemoen 8617d2be074SHaavard Skinnemoen offset = 4 - remaining; 8627d2be074SHaavard Skinnemoen buf = sg_virt(sg); 8637d2be074SHaavard Skinnemoen memcpy(buf, (u8 *)&value + remaining, offset); 8647d2be074SHaavard Skinnemoen nbytes += offset; 8657d2be074SHaavard Skinnemoen } 8667d2be074SHaavard Skinnemoen 8677d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 8687d2be074SHaavard Skinnemoen if (status & ATMCI_DATA_ERROR_FLAGS) { 8697d2be074SHaavard Skinnemoen mci_writel(host, IDR, (MCI_NOTBUSY | MCI_RXRDY 8707d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS)); 8717d2be074SHaavard Skinnemoen host->data_status = status; 8727d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 8737d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 8747d2be074SHaavard Skinnemoen break; 8757d2be074SHaavard Skinnemoen } 8767d2be074SHaavard Skinnemoen } while (status & MCI_RXRDY); 8777d2be074SHaavard Skinnemoen 8787d2be074SHaavard Skinnemoen host->pio_offset = offset; 8797d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 8807d2be074SHaavard Skinnemoen 8817d2be074SHaavard Skinnemoen return; 8827d2be074SHaavard Skinnemoen 8837d2be074SHaavard Skinnemoen done: 8847d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_RXRDY); 8857d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 8867d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 887c06ad258SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 8887d2be074SHaavard Skinnemoen } 8897d2be074SHaavard Skinnemoen 8907d2be074SHaavard Skinnemoen static void atmci_write_data_pio(struct atmel_mci *host) 8917d2be074SHaavard Skinnemoen { 8927d2be074SHaavard Skinnemoen struct scatterlist *sg = host->sg; 8937d2be074SHaavard Skinnemoen void *buf = sg_virt(sg); 8947d2be074SHaavard Skinnemoen unsigned int offset = host->pio_offset; 8957d2be074SHaavard Skinnemoen struct mmc_data *data = host->data; 8967d2be074SHaavard Skinnemoen u32 value; 8977d2be074SHaavard Skinnemoen u32 status; 8987d2be074SHaavard Skinnemoen unsigned int nbytes = 0; 8997d2be074SHaavard Skinnemoen 9007d2be074SHaavard Skinnemoen do { 9017d2be074SHaavard Skinnemoen if (likely(offset + 4 <= sg->length)) { 9027d2be074SHaavard Skinnemoen value = get_unaligned((u32 *)(buf + offset)); 9037d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 9047d2be074SHaavard Skinnemoen 9057d2be074SHaavard Skinnemoen offset += 4; 9067d2be074SHaavard Skinnemoen nbytes += 4; 9077d2be074SHaavard Skinnemoen if (offset == sg->length) { 9087d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 9097d2be074SHaavard Skinnemoen if (!sg) 9107d2be074SHaavard Skinnemoen goto done; 9117d2be074SHaavard Skinnemoen 9127d2be074SHaavard Skinnemoen offset = 0; 9137d2be074SHaavard Skinnemoen buf = sg_virt(sg); 9147d2be074SHaavard Skinnemoen } 9157d2be074SHaavard Skinnemoen } else { 9167d2be074SHaavard Skinnemoen unsigned int remaining = sg->length - offset; 9177d2be074SHaavard Skinnemoen 9187d2be074SHaavard Skinnemoen value = 0; 9197d2be074SHaavard Skinnemoen memcpy(&value, buf + offset, remaining); 9207d2be074SHaavard Skinnemoen nbytes += remaining; 9217d2be074SHaavard Skinnemoen 9227d2be074SHaavard Skinnemoen host->sg = sg = sg_next(sg); 9237d2be074SHaavard Skinnemoen if (!sg) { 9247d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 9257d2be074SHaavard Skinnemoen goto done; 9267d2be074SHaavard Skinnemoen } 9277d2be074SHaavard Skinnemoen 9287d2be074SHaavard Skinnemoen offset = 4 - remaining; 9297d2be074SHaavard Skinnemoen buf = sg_virt(sg); 9307d2be074SHaavard Skinnemoen memcpy((u8 *)&value + remaining, buf, offset); 9317d2be074SHaavard Skinnemoen mci_writel(host, TDR, value); 9327d2be074SHaavard Skinnemoen nbytes += offset; 9337d2be074SHaavard Skinnemoen } 9347d2be074SHaavard Skinnemoen 9357d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 9367d2be074SHaavard Skinnemoen if (status & ATMCI_DATA_ERROR_FLAGS) { 9377d2be074SHaavard Skinnemoen mci_writel(host, IDR, (MCI_NOTBUSY | MCI_TXRDY 9387d2be074SHaavard Skinnemoen | ATMCI_DATA_ERROR_FLAGS)); 9397d2be074SHaavard Skinnemoen host->data_status = status; 9407d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 9417d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 9427d2be074SHaavard Skinnemoen break; 9437d2be074SHaavard Skinnemoen } 9447d2be074SHaavard Skinnemoen } while (status & MCI_TXRDY); 9457d2be074SHaavard Skinnemoen 9467d2be074SHaavard Skinnemoen host->pio_offset = offset; 9477d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 9487d2be074SHaavard Skinnemoen 9497d2be074SHaavard Skinnemoen return; 9507d2be074SHaavard Skinnemoen 9517d2be074SHaavard Skinnemoen done: 9527d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_TXRDY); 9537d2be074SHaavard Skinnemoen mci_writel(host, IER, MCI_NOTBUSY); 9547d2be074SHaavard Skinnemoen data->bytes_xfered += nbytes; 955c06ad258SHaavard Skinnemoen atmci_set_pending(host, EVENT_XFER_COMPLETE); 9567d2be074SHaavard Skinnemoen } 9577d2be074SHaavard Skinnemoen 9587d2be074SHaavard Skinnemoen static void atmci_cmd_interrupt(struct mmc_host *mmc, u32 status) 9597d2be074SHaavard Skinnemoen { 9607d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 9617d2be074SHaavard Skinnemoen 9627d2be074SHaavard Skinnemoen mci_writel(host, IDR, MCI_CMDRDY); 9637d2be074SHaavard Skinnemoen 9647d2be074SHaavard Skinnemoen host->cmd_status = status; 9657d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_CMD_COMPLETE); 9667d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 9677d2be074SHaavard Skinnemoen } 9687d2be074SHaavard Skinnemoen 9697d2be074SHaavard Skinnemoen static irqreturn_t atmci_interrupt(int irq, void *dev_id) 9707d2be074SHaavard Skinnemoen { 9717d2be074SHaavard Skinnemoen struct mmc_host *mmc = dev_id; 9727d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 9737d2be074SHaavard Skinnemoen u32 status, mask, pending; 9747d2be074SHaavard Skinnemoen unsigned int pass_count = 0; 9757d2be074SHaavard Skinnemoen 9767d2be074SHaavard Skinnemoen spin_lock(&mmc->lock); 9777d2be074SHaavard Skinnemoen 9787d2be074SHaavard Skinnemoen do { 9797d2be074SHaavard Skinnemoen status = mci_readl(host, SR); 9807d2be074SHaavard Skinnemoen mask = mci_readl(host, IMR); 9817d2be074SHaavard Skinnemoen pending = status & mask; 9827d2be074SHaavard Skinnemoen if (!pending) 9837d2be074SHaavard Skinnemoen break; 9847d2be074SHaavard Skinnemoen 9857d2be074SHaavard Skinnemoen if (pending & ATMCI_DATA_ERROR_FLAGS) { 9867d2be074SHaavard Skinnemoen mci_writel(host, IDR, ATMCI_DATA_ERROR_FLAGS 9877d2be074SHaavard Skinnemoen | MCI_RXRDY | MCI_TXRDY); 9887d2be074SHaavard Skinnemoen pending &= mci_readl(host, IMR); 9897d2be074SHaavard Skinnemoen host->data_status = status; 9907d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_ERROR); 9917d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 9927d2be074SHaavard Skinnemoen } 9937d2be074SHaavard Skinnemoen if (pending & MCI_NOTBUSY) { 994c06ad258SHaavard Skinnemoen mci_writel(host, IDR, 995c06ad258SHaavard Skinnemoen ATMCI_DATA_ERROR_FLAGS | MCI_NOTBUSY); 996c06ad258SHaavard Skinnemoen host->data_status = status; 9977d2be074SHaavard Skinnemoen atmci_set_pending(host, EVENT_DATA_COMPLETE); 9987d2be074SHaavard Skinnemoen tasklet_schedule(&host->tasklet); 9997d2be074SHaavard Skinnemoen } 10007d2be074SHaavard Skinnemoen if (pending & MCI_RXRDY) 10017d2be074SHaavard Skinnemoen atmci_read_data_pio(host); 10027d2be074SHaavard Skinnemoen if (pending & MCI_TXRDY) 10037d2be074SHaavard Skinnemoen atmci_write_data_pio(host); 10047d2be074SHaavard Skinnemoen 10057d2be074SHaavard Skinnemoen if (pending & MCI_CMDRDY) 10067d2be074SHaavard Skinnemoen atmci_cmd_interrupt(mmc, status); 10077d2be074SHaavard Skinnemoen } while (pass_count++ < 5); 10087d2be074SHaavard Skinnemoen 10097d2be074SHaavard Skinnemoen spin_unlock(&mmc->lock); 10107d2be074SHaavard Skinnemoen 10117d2be074SHaavard Skinnemoen return pass_count ? IRQ_HANDLED : IRQ_NONE; 10127d2be074SHaavard Skinnemoen } 10137d2be074SHaavard Skinnemoen 10147d2be074SHaavard Skinnemoen static irqreturn_t atmci_detect_interrupt(int irq, void *dev_id) 10157d2be074SHaavard Skinnemoen { 10167d2be074SHaavard Skinnemoen struct mmc_host *mmc = dev_id; 10177d2be074SHaavard Skinnemoen struct atmel_mci *host = mmc_priv(mmc); 10187d2be074SHaavard Skinnemoen 10197d2be074SHaavard Skinnemoen /* 10207d2be074SHaavard Skinnemoen * Disable interrupts until the pin has stabilized and check 10217d2be074SHaavard Skinnemoen * the state then. Use mod_timer() since we may be in the 10227d2be074SHaavard Skinnemoen * middle of the timer routine when this interrupt triggers. 10237d2be074SHaavard Skinnemoen */ 10247d2be074SHaavard Skinnemoen disable_irq_nosync(irq); 10257d2be074SHaavard Skinnemoen mod_timer(&host->detect_timer, jiffies + msecs_to_jiffies(20)); 10267d2be074SHaavard Skinnemoen 10277d2be074SHaavard Skinnemoen return IRQ_HANDLED; 10287d2be074SHaavard Skinnemoen } 10297d2be074SHaavard Skinnemoen 10307d2be074SHaavard Skinnemoen static int __init atmci_probe(struct platform_device *pdev) 10317d2be074SHaavard Skinnemoen { 10327d2be074SHaavard Skinnemoen struct mci_platform_data *pdata; 10337d2be074SHaavard Skinnemoen struct atmel_mci *host; 10347d2be074SHaavard Skinnemoen struct mmc_host *mmc; 10357d2be074SHaavard Skinnemoen struct resource *regs; 10367d2be074SHaavard Skinnemoen int irq; 10377d2be074SHaavard Skinnemoen int ret; 10387d2be074SHaavard Skinnemoen 10397d2be074SHaavard Skinnemoen regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); 10407d2be074SHaavard Skinnemoen if (!regs) 10417d2be074SHaavard Skinnemoen return -ENXIO; 10427d2be074SHaavard Skinnemoen pdata = pdev->dev.platform_data; 10437d2be074SHaavard Skinnemoen if (!pdata) 10447d2be074SHaavard Skinnemoen return -ENXIO; 10457d2be074SHaavard Skinnemoen irq = platform_get_irq(pdev, 0); 10467d2be074SHaavard Skinnemoen if (irq < 0) 10477d2be074SHaavard Skinnemoen return irq; 10487d2be074SHaavard Skinnemoen 10497d2be074SHaavard Skinnemoen mmc = mmc_alloc_host(sizeof(struct atmel_mci), &pdev->dev); 10507d2be074SHaavard Skinnemoen if (!mmc) 10517d2be074SHaavard Skinnemoen return -ENOMEM; 10527d2be074SHaavard Skinnemoen 10537d2be074SHaavard Skinnemoen host = mmc_priv(mmc); 10547d2be074SHaavard Skinnemoen host->pdev = pdev; 10557d2be074SHaavard Skinnemoen host->mmc = mmc; 10567d2be074SHaavard Skinnemoen host->detect_pin = pdata->detect_pin; 10577d2be074SHaavard Skinnemoen host->wp_pin = pdata->wp_pin; 10587d2be074SHaavard Skinnemoen 10597d2be074SHaavard Skinnemoen host->mck = clk_get(&pdev->dev, "mci_clk"); 10607d2be074SHaavard Skinnemoen if (IS_ERR(host->mck)) { 10617d2be074SHaavard Skinnemoen ret = PTR_ERR(host->mck); 10627d2be074SHaavard Skinnemoen goto err_clk_get; 10637d2be074SHaavard Skinnemoen } 10647d2be074SHaavard Skinnemoen 10657d2be074SHaavard Skinnemoen ret = -ENOMEM; 10667d2be074SHaavard Skinnemoen host->regs = ioremap(regs->start, regs->end - regs->start + 1); 10677d2be074SHaavard Skinnemoen if (!host->regs) 10687d2be074SHaavard Skinnemoen goto err_ioremap; 10697d2be074SHaavard Skinnemoen 10707d2be074SHaavard Skinnemoen clk_enable(host->mck); 10717d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_SWRST); 10727d2be074SHaavard Skinnemoen host->bus_hz = clk_get_rate(host->mck); 10737d2be074SHaavard Skinnemoen clk_disable(host->mck); 10747d2be074SHaavard Skinnemoen 10757d2be074SHaavard Skinnemoen host->mapbase = regs->start; 10767d2be074SHaavard Skinnemoen 10777d2be074SHaavard Skinnemoen mmc->ops = &atmci_ops; 10787d2be074SHaavard Skinnemoen mmc->f_min = (host->bus_hz + 511) / 512; 10797d2be074SHaavard Skinnemoen mmc->f_max = host->bus_hz / 2; 10807d2be074SHaavard Skinnemoen mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; 108123af6039SPierre Ossman mmc->caps |= MMC_CAP_4_BIT_DATA; 10827d2be074SHaavard Skinnemoen 10837d2be074SHaavard Skinnemoen mmc->max_hw_segs = 64; 10847d2be074SHaavard Skinnemoen mmc->max_phys_segs = 64; 10857d2be074SHaavard Skinnemoen mmc->max_req_size = 32768 * 512; 10867d2be074SHaavard Skinnemoen mmc->max_blk_size = 32768; 10877d2be074SHaavard Skinnemoen mmc->max_blk_count = 512; 10887d2be074SHaavard Skinnemoen 10897d2be074SHaavard Skinnemoen tasklet_init(&host->tasklet, atmci_tasklet_func, (unsigned long)mmc); 10907d2be074SHaavard Skinnemoen 10917d2be074SHaavard Skinnemoen ret = request_irq(irq, atmci_interrupt, 0, pdev->dev.bus_id, mmc); 10927d2be074SHaavard Skinnemoen if (ret) 10937d2be074SHaavard Skinnemoen goto err_request_irq; 10947d2be074SHaavard Skinnemoen 10957d2be074SHaavard Skinnemoen /* Assume card is present if we don't have a detect pin */ 10967d2be074SHaavard Skinnemoen host->present = 1; 10973c26e170SDavid Brownell if (gpio_is_valid(host->detect_pin)) { 10987d2be074SHaavard Skinnemoen if (gpio_request(host->detect_pin, "mmc_detect")) { 10997d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "no detect pin available\n"); 11007d2be074SHaavard Skinnemoen host->detect_pin = -1; 11017d2be074SHaavard Skinnemoen } else { 11027d2be074SHaavard Skinnemoen host->present = !gpio_get_value(host->detect_pin); 11037d2be074SHaavard Skinnemoen } 11047d2be074SHaavard Skinnemoen } 1105da45b66eSHaavard Skinnemoen 1106da45b66eSHaavard Skinnemoen if (!gpio_is_valid(host->detect_pin)) 1107da45b66eSHaavard Skinnemoen mmc->caps |= MMC_CAP_NEEDS_POLL; 1108da45b66eSHaavard Skinnemoen 11093c26e170SDavid Brownell if (gpio_is_valid(host->wp_pin)) { 11107d2be074SHaavard Skinnemoen if (gpio_request(host->wp_pin, "mmc_wp")) { 11117d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, "no WP pin available\n"); 11127d2be074SHaavard Skinnemoen host->wp_pin = -1; 11137d2be074SHaavard Skinnemoen } 11147d2be074SHaavard Skinnemoen } 11157d2be074SHaavard Skinnemoen 11167d2be074SHaavard Skinnemoen platform_set_drvdata(pdev, host); 11177d2be074SHaavard Skinnemoen 11187d2be074SHaavard Skinnemoen mmc_add_host(mmc); 11197d2be074SHaavard Skinnemoen 11203c26e170SDavid Brownell if (gpio_is_valid(host->detect_pin)) { 11217d2be074SHaavard Skinnemoen setup_timer(&host->detect_timer, atmci_detect_change, 11227d2be074SHaavard Skinnemoen (unsigned long)host); 11237d2be074SHaavard Skinnemoen 11247d2be074SHaavard Skinnemoen ret = request_irq(gpio_to_irq(host->detect_pin), 11257d2be074SHaavard Skinnemoen atmci_detect_interrupt, 11267d2be074SHaavard Skinnemoen IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING, 11277d2be074SHaavard Skinnemoen "mmc-detect", mmc); 11287d2be074SHaavard Skinnemoen if (ret) { 11297d2be074SHaavard Skinnemoen dev_dbg(&mmc->class_dev, 11307d2be074SHaavard Skinnemoen "could not request IRQ %d for detect pin\n", 11317d2be074SHaavard Skinnemoen gpio_to_irq(host->detect_pin)); 11327d2be074SHaavard Skinnemoen gpio_free(host->detect_pin); 11337d2be074SHaavard Skinnemoen host->detect_pin = -1; 11347d2be074SHaavard Skinnemoen } 11357d2be074SHaavard Skinnemoen } 11367d2be074SHaavard Skinnemoen 11377d2be074SHaavard Skinnemoen dev_info(&mmc->class_dev, 11387d2be074SHaavard Skinnemoen "Atmel MCI controller at 0x%08lx irq %d\n", 11397d2be074SHaavard Skinnemoen host->mapbase, irq); 11407d2be074SHaavard Skinnemoen 1141deec9ae3SHaavard Skinnemoen atmci_init_debugfs(host); 1142deec9ae3SHaavard Skinnemoen 11437d2be074SHaavard Skinnemoen return 0; 11447d2be074SHaavard Skinnemoen 11457d2be074SHaavard Skinnemoen err_request_irq: 11467d2be074SHaavard Skinnemoen iounmap(host->regs); 11477d2be074SHaavard Skinnemoen err_ioremap: 11487d2be074SHaavard Skinnemoen clk_put(host->mck); 11497d2be074SHaavard Skinnemoen err_clk_get: 11507d2be074SHaavard Skinnemoen mmc_free_host(mmc); 11517d2be074SHaavard Skinnemoen return ret; 11527d2be074SHaavard Skinnemoen } 11537d2be074SHaavard Skinnemoen 11547d2be074SHaavard Skinnemoen static int __exit atmci_remove(struct platform_device *pdev) 11557d2be074SHaavard Skinnemoen { 11567d2be074SHaavard Skinnemoen struct atmel_mci *host = platform_get_drvdata(pdev); 11577d2be074SHaavard Skinnemoen 11587d2be074SHaavard Skinnemoen platform_set_drvdata(pdev, NULL); 11597d2be074SHaavard Skinnemoen 11607d2be074SHaavard Skinnemoen if (host) { 1161deec9ae3SHaavard Skinnemoen /* Debugfs stuff is cleaned up by mmc core */ 1162deec9ae3SHaavard Skinnemoen 11633c26e170SDavid Brownell if (gpio_is_valid(host->detect_pin)) { 11647d2be074SHaavard Skinnemoen int pin = host->detect_pin; 11657d2be074SHaavard Skinnemoen 11667d2be074SHaavard Skinnemoen /* Make sure the timer doesn't enable the interrupt */ 11677d2be074SHaavard Skinnemoen host->detect_pin = -1; 11687d2be074SHaavard Skinnemoen smp_wmb(); 11697d2be074SHaavard Skinnemoen 11707d2be074SHaavard Skinnemoen free_irq(gpio_to_irq(pin), host->mmc); 11717d2be074SHaavard Skinnemoen del_timer_sync(&host->detect_timer); 11727d2be074SHaavard Skinnemoen gpio_free(pin); 11737d2be074SHaavard Skinnemoen } 11747d2be074SHaavard Skinnemoen 11757d2be074SHaavard Skinnemoen mmc_remove_host(host->mmc); 11767d2be074SHaavard Skinnemoen 11777d2be074SHaavard Skinnemoen clk_enable(host->mck); 11787d2be074SHaavard Skinnemoen mci_writel(host, IDR, ~0UL); 11797d2be074SHaavard Skinnemoen mci_writel(host, CR, MCI_CR_MCIDIS); 11807d2be074SHaavard Skinnemoen mci_readl(host, SR); 11817d2be074SHaavard Skinnemoen clk_disable(host->mck); 11827d2be074SHaavard Skinnemoen 11833c26e170SDavid Brownell if (gpio_is_valid(host->wp_pin)) 11847d2be074SHaavard Skinnemoen gpio_free(host->wp_pin); 11857d2be074SHaavard Skinnemoen 11867d2be074SHaavard Skinnemoen free_irq(platform_get_irq(pdev, 0), host->mmc); 11877d2be074SHaavard Skinnemoen iounmap(host->regs); 11887d2be074SHaavard Skinnemoen 11897d2be074SHaavard Skinnemoen clk_put(host->mck); 11907d2be074SHaavard Skinnemoen 11917d2be074SHaavard Skinnemoen mmc_free_host(host->mmc); 11927d2be074SHaavard Skinnemoen } 11937d2be074SHaavard Skinnemoen return 0; 11947d2be074SHaavard Skinnemoen } 11957d2be074SHaavard Skinnemoen 11967d2be074SHaavard Skinnemoen static struct platform_driver atmci_driver = { 11977d2be074SHaavard Skinnemoen .remove = __exit_p(atmci_remove), 11987d2be074SHaavard Skinnemoen .driver = { 11997d2be074SHaavard Skinnemoen .name = "atmel_mci", 12007d2be074SHaavard Skinnemoen }, 12017d2be074SHaavard Skinnemoen }; 12027d2be074SHaavard Skinnemoen 12037d2be074SHaavard Skinnemoen static int __init atmci_init(void) 12047d2be074SHaavard Skinnemoen { 12057d2be074SHaavard Skinnemoen return platform_driver_probe(&atmci_driver, atmci_probe); 12067d2be074SHaavard Skinnemoen } 12077d2be074SHaavard Skinnemoen 12087d2be074SHaavard Skinnemoen static void __exit atmci_exit(void) 12097d2be074SHaavard Skinnemoen { 12107d2be074SHaavard Skinnemoen platform_driver_unregister(&atmci_driver); 12117d2be074SHaavard Skinnemoen } 12127d2be074SHaavard Skinnemoen 12137d2be074SHaavard Skinnemoen module_init(atmci_init); 12147d2be074SHaavard Skinnemoen module_exit(atmci_exit); 12157d2be074SHaavard Skinnemoen 12167d2be074SHaavard Skinnemoen MODULE_DESCRIPTION("Atmel Multimedia Card Interface driver"); 12177d2be074SHaavard Skinnemoen MODULE_AUTHOR("Haavard Skinnemoen <haavard.skinnemoen@atmel.com>"); 12187d2be074SHaavard Skinnemoen MODULE_LICENSE("GPL v2"); 1219