11c6a0718SPierre Ossman /* 270f10482SPierre Ossman * linux/drivers/mmc/host/omap.c 31c6a0718SPierre Ossman * 41c6a0718SPierre Ossman * Copyright (C) 2004 Nokia Corporation 51c6a0718SPierre Ossman * Written by Tuukka Tikkanen and Juha Yrj�l�<juha.yrjola@nokia.com> 61c6a0718SPierre Ossman * Misc hacks here and there by Tony Lindgren <tony@atomide.com> 71c6a0718SPierre Ossman * Other hacks (DMA, SD, etc) by David Brownell 81c6a0718SPierre Ossman * 91c6a0718SPierre Ossman * This program is free software; you can redistribute it and/or modify 101c6a0718SPierre Ossman * it under the terms of the GNU General Public License version 2 as 111c6a0718SPierre Ossman * published by the Free Software Foundation. 121c6a0718SPierre Ossman */ 131c6a0718SPierre Ossman 141c6a0718SPierre Ossman #include <linux/module.h> 151c6a0718SPierre Ossman #include <linux/moduleparam.h> 161c6a0718SPierre Ossman #include <linux/init.h> 171c6a0718SPierre Ossman #include <linux/ioport.h> 181c6a0718SPierre Ossman #include <linux/platform_device.h> 191c6a0718SPierre Ossman #include <linux/interrupt.h> 201c6a0718SPierre Ossman #include <linux/dma-mapping.h> 211c6a0718SPierre Ossman #include <linux/delay.h> 221c6a0718SPierre Ossman #include <linux/spinlock.h> 231c6a0718SPierre Ossman #include <linux/timer.h> 241c6a0718SPierre Ossman #include <linux/mmc/host.h> 251c6a0718SPierre Ossman #include <linux/mmc/card.h> 261c6a0718SPierre Ossman #include <linux/clk.h> 2745711f1aSJens Axboe #include <linux/scatterlist.h> 286d16bfb5SDavid Brownell #include <linux/i2c/tps65010.h> 291c6a0718SPierre Ossman 301c6a0718SPierre Ossman #include <asm/io.h> 311c6a0718SPierre Ossman #include <asm/irq.h> 321c6a0718SPierre Ossman 33a09e64fbSRussell King #include <mach/board.h> 34a09e64fbSRussell King #include <mach/mmc.h> 35a09e64fbSRussell King #include <mach/gpio.h> 36a09e64fbSRussell King #include <mach/dma.h> 37a09e64fbSRussell King #include <mach/mux.h> 38a09e64fbSRussell King #include <mach/fpga.h> 391c6a0718SPierre Ossman 401c6a0718SPierre Ossman #define OMAP_MMC_REG_CMD 0x00 411c6a0718SPierre Ossman #define OMAP_MMC_REG_ARGL 0x04 421c6a0718SPierre Ossman #define OMAP_MMC_REG_ARGH 0x08 431c6a0718SPierre Ossman #define OMAP_MMC_REG_CON 0x0c 441c6a0718SPierre Ossman #define OMAP_MMC_REG_STAT 0x10 451c6a0718SPierre Ossman #define OMAP_MMC_REG_IE 0x14 461c6a0718SPierre Ossman #define OMAP_MMC_REG_CTO 0x18 471c6a0718SPierre Ossman #define OMAP_MMC_REG_DTO 0x1c 481c6a0718SPierre Ossman #define OMAP_MMC_REG_DATA 0x20 491c6a0718SPierre Ossman #define OMAP_MMC_REG_BLEN 0x24 501c6a0718SPierre Ossman #define OMAP_MMC_REG_NBLK 0x28 511c6a0718SPierre Ossman #define OMAP_MMC_REG_BUF 0x2c 521c6a0718SPierre Ossman #define OMAP_MMC_REG_SDIO 0x34 531c6a0718SPierre Ossman #define OMAP_MMC_REG_REV 0x3c 541c6a0718SPierre Ossman #define OMAP_MMC_REG_RSP0 0x40 551c6a0718SPierre Ossman #define OMAP_MMC_REG_RSP1 0x44 561c6a0718SPierre Ossman #define OMAP_MMC_REG_RSP2 0x48 571c6a0718SPierre Ossman #define OMAP_MMC_REG_RSP3 0x4c 581c6a0718SPierre Ossman #define OMAP_MMC_REG_RSP4 0x50 591c6a0718SPierre Ossman #define OMAP_MMC_REG_RSP5 0x54 601c6a0718SPierre Ossman #define OMAP_MMC_REG_RSP6 0x58 611c6a0718SPierre Ossman #define OMAP_MMC_REG_RSP7 0x5c 621c6a0718SPierre Ossman #define OMAP_MMC_REG_IOSR 0x60 631c6a0718SPierre Ossman #define OMAP_MMC_REG_SYSC 0x64 641c6a0718SPierre Ossman #define OMAP_MMC_REG_SYSS 0x68 651c6a0718SPierre Ossman 661c6a0718SPierre Ossman #define OMAP_MMC_STAT_CARD_ERR (1 << 14) 671c6a0718SPierre Ossman #define OMAP_MMC_STAT_CARD_IRQ (1 << 13) 681c6a0718SPierre Ossman #define OMAP_MMC_STAT_OCR_BUSY (1 << 12) 691c6a0718SPierre Ossman #define OMAP_MMC_STAT_A_EMPTY (1 << 11) 701c6a0718SPierre Ossman #define OMAP_MMC_STAT_A_FULL (1 << 10) 711c6a0718SPierre Ossman #define OMAP_MMC_STAT_CMD_CRC (1 << 8) 721c6a0718SPierre Ossman #define OMAP_MMC_STAT_CMD_TOUT (1 << 7) 731c6a0718SPierre Ossman #define OMAP_MMC_STAT_DATA_CRC (1 << 6) 741c6a0718SPierre Ossman #define OMAP_MMC_STAT_DATA_TOUT (1 << 5) 751c6a0718SPierre Ossman #define OMAP_MMC_STAT_END_BUSY (1 << 4) 761c6a0718SPierre Ossman #define OMAP_MMC_STAT_END_OF_DATA (1 << 3) 771c6a0718SPierre Ossman #define OMAP_MMC_STAT_CARD_BUSY (1 << 2) 781c6a0718SPierre Ossman #define OMAP_MMC_STAT_END_OF_CMD (1 << 0) 791c6a0718SPierre Ossman 801c6a0718SPierre Ossman #define OMAP_MMC_READ(host, reg) __raw_readw((host)->virt_base + OMAP_MMC_REG_##reg) 811c6a0718SPierre Ossman #define OMAP_MMC_WRITE(host, reg, val) __raw_writew((val), (host)->virt_base + OMAP_MMC_REG_##reg) 821c6a0718SPierre Ossman 831c6a0718SPierre Ossman /* 841c6a0718SPierre Ossman * Command types 851c6a0718SPierre Ossman */ 861c6a0718SPierre Ossman #define OMAP_MMC_CMDTYPE_BC 0 871c6a0718SPierre Ossman #define OMAP_MMC_CMDTYPE_BCR 1 881c6a0718SPierre Ossman #define OMAP_MMC_CMDTYPE_AC 2 891c6a0718SPierre Ossman #define OMAP_MMC_CMDTYPE_ADTC 3 901c6a0718SPierre Ossman 911c6a0718SPierre Ossman 921c6a0718SPierre Ossman #define DRIVER_NAME "mmci-omap" 931c6a0718SPierre Ossman 941c6a0718SPierre Ossman /* Specifies how often in millisecs to poll for card status changes 951c6a0718SPierre Ossman * when the cover switch is open */ 967584d276SJarkko Lavinen #define OMAP_MMC_COVER_POLL_DELAY 500 971c6a0718SPierre Ossman 98abfbe5f7SJuha Yrjola struct mmc_omap_host; 99abfbe5f7SJuha Yrjola 100abfbe5f7SJuha Yrjola struct mmc_omap_slot { 101abfbe5f7SJuha Yrjola int id; 102abfbe5f7SJuha Yrjola unsigned int vdd; 103abfbe5f7SJuha Yrjola u16 saved_con; 104abfbe5f7SJuha Yrjola u16 bus_mode; 105abfbe5f7SJuha Yrjola unsigned int fclk_freq; 106abfbe5f7SJuha Yrjola unsigned powered:1; 107abfbe5f7SJuha Yrjola 1087584d276SJarkko Lavinen struct tasklet_struct cover_tasklet; 1097584d276SJarkko Lavinen struct timer_list cover_timer; 1105a0f3f1fSJuha Yrjola unsigned cover_open; 1115a0f3f1fSJuha Yrjola 112abfbe5f7SJuha Yrjola struct mmc_request *mrq; 113abfbe5f7SJuha Yrjola struct mmc_omap_host *host; 114abfbe5f7SJuha Yrjola struct mmc_host *mmc; 115abfbe5f7SJuha Yrjola struct omap_mmc_slot_data *pdata; 116abfbe5f7SJuha Yrjola }; 117abfbe5f7SJuha Yrjola 1181c6a0718SPierre Ossman struct mmc_omap_host { 1191c6a0718SPierre Ossman int initialized; 1201c6a0718SPierre Ossman int suspended; 1211c6a0718SPierre Ossman struct mmc_request * mrq; 1221c6a0718SPierre Ossman struct mmc_command * cmd; 1231c6a0718SPierre Ossman struct mmc_data * data; 1241c6a0718SPierre Ossman struct mmc_host * mmc; 1251c6a0718SPierre Ossman struct device * dev; 1261c6a0718SPierre Ossman unsigned char id; /* 16xx chips have 2 MMC blocks */ 1271c6a0718SPierre Ossman struct clk * iclk; 1281c6a0718SPierre Ossman struct clk * fclk; 1291c6a0718SPierre Ossman struct resource *mem_res; 1301c6a0718SPierre Ossman void __iomem *virt_base; 1311c6a0718SPierre Ossman unsigned int phys_base; 1321c6a0718SPierre Ossman int irq; 1331c6a0718SPierre Ossman unsigned char bus_mode; 1341c6a0718SPierre Ossman unsigned char hw_bus_mode; 1351c6a0718SPierre Ossman 1360fb4723dSJarkko Lavinen struct work_struct cmd_abort_work; 1370fb4723dSJarkko Lavinen unsigned abort:1; 1380fb4723dSJarkko Lavinen struct timer_list cmd_abort_timer; 139eb1860bcSJarkko Lavinen 1400f602ec7SJarkko Lavinen struct work_struct slot_release_work; 1410f602ec7SJarkko Lavinen struct mmc_omap_slot *next_slot; 1420f602ec7SJarkko Lavinen struct work_struct send_stop_work; 1430f602ec7SJarkko Lavinen struct mmc_data *stop_data; 1440f602ec7SJarkko Lavinen 1451c6a0718SPierre Ossman unsigned int sg_len; 1461c6a0718SPierre Ossman int sg_idx; 1471c6a0718SPierre Ossman u16 * buffer; 1481c6a0718SPierre Ossman u32 buffer_bytes_left; 1491c6a0718SPierre Ossman u32 total_bytes_left; 1501c6a0718SPierre Ossman 1511c6a0718SPierre Ossman unsigned use_dma:1; 1521c6a0718SPierre Ossman unsigned brs_received:1, dma_done:1; 1531c6a0718SPierre Ossman unsigned dma_is_read:1; 1541c6a0718SPierre Ossman unsigned dma_in_use:1; 1551c6a0718SPierre Ossman int dma_ch; 1561c6a0718SPierre Ossman spinlock_t dma_lock; 1571c6a0718SPierre Ossman struct timer_list dma_timer; 1581c6a0718SPierre Ossman unsigned dma_len; 1591c6a0718SPierre Ossman 1601c6a0718SPierre Ossman short power_pin; 1611c6a0718SPierre Ossman 162abfbe5f7SJuha Yrjola struct mmc_omap_slot *slots[OMAP_MMC_MAX_SLOTS]; 163abfbe5f7SJuha Yrjola struct mmc_omap_slot *current_slot; 164abfbe5f7SJuha Yrjola spinlock_t slot_lock; 165abfbe5f7SJuha Yrjola wait_queue_head_t slot_wq; 166abfbe5f7SJuha Yrjola int nr_slots; 167abfbe5f7SJuha Yrjola 1680807a9b5SJarkko Lavinen struct timer_list clk_timer; 1690807a9b5SJarkko Lavinen spinlock_t clk_lock; /* for changing enabled state */ 1700807a9b5SJarkko Lavinen unsigned int fclk_enabled:1; 1710807a9b5SJarkko Lavinen 172abfbe5f7SJuha Yrjola struct omap_mmc_platform_data *pdata; 1731c6a0718SPierre Ossman }; 1741c6a0718SPierre Ossman 1757c8ad982SRussell King static void mmc_omap_fclk_offdelay(struct mmc_omap_slot *slot) 1760807a9b5SJarkko Lavinen { 1770807a9b5SJarkko Lavinen unsigned long tick_ns; 1780807a9b5SJarkko Lavinen 1790807a9b5SJarkko Lavinen if (slot != NULL && slot->host->fclk_enabled && slot->fclk_freq > 0) { 1800807a9b5SJarkko Lavinen tick_ns = (1000000000 + slot->fclk_freq - 1) / slot->fclk_freq; 1810807a9b5SJarkko Lavinen ndelay(8 * tick_ns); 1820807a9b5SJarkko Lavinen } 1830807a9b5SJarkko Lavinen } 1840807a9b5SJarkko Lavinen 1857c8ad982SRussell King static void mmc_omap_fclk_enable(struct mmc_omap_host *host, unsigned int enable) 1860807a9b5SJarkko Lavinen { 1870807a9b5SJarkko Lavinen unsigned long flags; 1880807a9b5SJarkko Lavinen 1890807a9b5SJarkko Lavinen spin_lock_irqsave(&host->clk_lock, flags); 1900807a9b5SJarkko Lavinen if (host->fclk_enabled != enable) { 1910807a9b5SJarkko Lavinen host->fclk_enabled = enable; 1920807a9b5SJarkko Lavinen if (enable) 1930807a9b5SJarkko Lavinen clk_enable(host->fclk); 1940807a9b5SJarkko Lavinen else 1950807a9b5SJarkko Lavinen clk_disable(host->fclk); 1960807a9b5SJarkko Lavinen } 1970807a9b5SJarkko Lavinen spin_unlock_irqrestore(&host->clk_lock, flags); 1980807a9b5SJarkko Lavinen } 1990807a9b5SJarkko Lavinen 200abfbe5f7SJuha Yrjola static void mmc_omap_select_slot(struct mmc_omap_slot *slot, int claimed) 201abfbe5f7SJuha Yrjola { 202abfbe5f7SJuha Yrjola struct mmc_omap_host *host = slot->host; 203abfbe5f7SJuha Yrjola unsigned long flags; 204abfbe5f7SJuha Yrjola 205abfbe5f7SJuha Yrjola if (claimed) 206abfbe5f7SJuha Yrjola goto no_claim; 207abfbe5f7SJuha Yrjola spin_lock_irqsave(&host->slot_lock, flags); 208abfbe5f7SJuha Yrjola while (host->mmc != NULL) { 209abfbe5f7SJuha Yrjola spin_unlock_irqrestore(&host->slot_lock, flags); 210abfbe5f7SJuha Yrjola wait_event(host->slot_wq, host->mmc == NULL); 211abfbe5f7SJuha Yrjola spin_lock_irqsave(&host->slot_lock, flags); 212abfbe5f7SJuha Yrjola } 213abfbe5f7SJuha Yrjola host->mmc = slot->mmc; 214abfbe5f7SJuha Yrjola spin_unlock_irqrestore(&host->slot_lock, flags); 215abfbe5f7SJuha Yrjola no_claim: 2160807a9b5SJarkko Lavinen del_timer(&host->clk_timer); 2170807a9b5SJarkko Lavinen if (host->current_slot != slot || !claimed) 2180807a9b5SJarkko Lavinen mmc_omap_fclk_offdelay(host->current_slot); 2190807a9b5SJarkko Lavinen 220abfbe5f7SJuha Yrjola if (host->current_slot != slot) { 2210807a9b5SJarkko Lavinen OMAP_MMC_WRITE(host, CON, slot->saved_con & 0xFC00); 222abfbe5f7SJuha Yrjola if (host->pdata->switch_slot != NULL) 223abfbe5f7SJuha Yrjola host->pdata->switch_slot(mmc_dev(slot->mmc), slot->id); 224abfbe5f7SJuha Yrjola host->current_slot = slot; 225abfbe5f7SJuha Yrjola } 226abfbe5f7SJuha Yrjola 2270807a9b5SJarkko Lavinen if (claimed) { 2280807a9b5SJarkko Lavinen mmc_omap_fclk_enable(host, 1); 2290807a9b5SJarkko Lavinen 230abfbe5f7SJuha Yrjola /* Doing the dummy read here seems to work around some bug 231abfbe5f7SJuha Yrjola * at least in OMAP24xx silicon where the command would not 232abfbe5f7SJuha Yrjola * start after writing the CMD register. Sigh. */ 233abfbe5f7SJuha Yrjola OMAP_MMC_READ(host, CON); 234abfbe5f7SJuha Yrjola 235abfbe5f7SJuha Yrjola OMAP_MMC_WRITE(host, CON, slot->saved_con); 2360807a9b5SJarkko Lavinen } else 2370807a9b5SJarkko Lavinen mmc_omap_fclk_enable(host, 0); 238abfbe5f7SJuha Yrjola } 239abfbe5f7SJuha Yrjola 240abfbe5f7SJuha Yrjola static void mmc_omap_start_request(struct mmc_omap_host *host, 241abfbe5f7SJuha Yrjola struct mmc_request *req); 242abfbe5f7SJuha Yrjola 2430f602ec7SJarkko Lavinen static void mmc_omap_slot_release_work(struct work_struct *work) 2440f602ec7SJarkko Lavinen { 2450f602ec7SJarkko Lavinen struct mmc_omap_host *host = container_of(work, struct mmc_omap_host, 2460f602ec7SJarkko Lavinen slot_release_work); 2470f602ec7SJarkko Lavinen struct mmc_omap_slot *next_slot = host->next_slot; 2480f602ec7SJarkko Lavinen struct mmc_request *rq; 2490f602ec7SJarkko Lavinen 2500f602ec7SJarkko Lavinen host->next_slot = NULL; 2510f602ec7SJarkko Lavinen mmc_omap_select_slot(next_slot, 1); 2520f602ec7SJarkko Lavinen 2530f602ec7SJarkko Lavinen rq = next_slot->mrq; 2540f602ec7SJarkko Lavinen next_slot->mrq = NULL; 2550f602ec7SJarkko Lavinen mmc_omap_start_request(host, rq); 2560f602ec7SJarkko Lavinen } 2570f602ec7SJarkko Lavinen 2580807a9b5SJarkko Lavinen static void mmc_omap_release_slot(struct mmc_omap_slot *slot, int clk_enabled) 259abfbe5f7SJuha Yrjola { 260abfbe5f7SJuha Yrjola struct mmc_omap_host *host = slot->host; 261abfbe5f7SJuha Yrjola unsigned long flags; 262abfbe5f7SJuha Yrjola int i; 263abfbe5f7SJuha Yrjola 264abfbe5f7SJuha Yrjola BUG_ON(slot == NULL || host->mmc == NULL); 2650807a9b5SJarkko Lavinen 2660807a9b5SJarkko Lavinen if (clk_enabled) 2670807a9b5SJarkko Lavinen /* Keeps clock running for at least 8 cycles on valid freq */ 2680807a9b5SJarkko Lavinen mod_timer(&host->clk_timer, jiffies + HZ/10); 2690807a9b5SJarkko Lavinen else { 2700807a9b5SJarkko Lavinen del_timer(&host->clk_timer); 2710807a9b5SJarkko Lavinen mmc_omap_fclk_offdelay(slot); 2720807a9b5SJarkko Lavinen mmc_omap_fclk_enable(host, 0); 2730807a9b5SJarkko Lavinen } 274abfbe5f7SJuha Yrjola 275abfbe5f7SJuha Yrjola spin_lock_irqsave(&host->slot_lock, flags); 276abfbe5f7SJuha Yrjola /* Check for any pending requests */ 277abfbe5f7SJuha Yrjola for (i = 0; i < host->nr_slots; i++) { 278abfbe5f7SJuha Yrjola struct mmc_omap_slot *new_slot; 279abfbe5f7SJuha Yrjola 280abfbe5f7SJuha Yrjola if (host->slots[i] == NULL || host->slots[i]->mrq == NULL) 281abfbe5f7SJuha Yrjola continue; 282abfbe5f7SJuha Yrjola 2830f602ec7SJarkko Lavinen BUG_ON(host->next_slot != NULL); 284abfbe5f7SJuha Yrjola new_slot = host->slots[i]; 285abfbe5f7SJuha Yrjola /* The current slot should not have a request in queue */ 286abfbe5f7SJuha Yrjola BUG_ON(new_slot == host->current_slot); 287abfbe5f7SJuha Yrjola 2880f602ec7SJarkko Lavinen host->next_slot = new_slot; 289abfbe5f7SJuha Yrjola host->mmc = new_slot->mmc; 290abfbe5f7SJuha Yrjola spin_unlock_irqrestore(&host->slot_lock, flags); 2910f602ec7SJarkko Lavinen schedule_work(&host->slot_release_work); 292abfbe5f7SJuha Yrjola return; 293abfbe5f7SJuha Yrjola } 294abfbe5f7SJuha Yrjola 295abfbe5f7SJuha Yrjola host->mmc = NULL; 296abfbe5f7SJuha Yrjola wake_up(&host->slot_wq); 297abfbe5f7SJuha Yrjola spin_unlock_irqrestore(&host->slot_lock, flags); 298abfbe5f7SJuha Yrjola } 299abfbe5f7SJuha Yrjola 3005a0f3f1fSJuha Yrjola static inline 3015a0f3f1fSJuha Yrjola int mmc_omap_cover_is_open(struct mmc_omap_slot *slot) 3025a0f3f1fSJuha Yrjola { 3038348f002SKyungmin Park if (slot->pdata->get_cover_state) 3048348f002SKyungmin Park return slot->pdata->get_cover_state(mmc_dev(slot->mmc), 3058348f002SKyungmin Park slot->id); 3068348f002SKyungmin Park return 0; 3075a0f3f1fSJuha Yrjola } 3085a0f3f1fSJuha Yrjola 3095a0f3f1fSJuha Yrjola static ssize_t 3105a0f3f1fSJuha Yrjola mmc_omap_show_cover_switch(struct device *dev, struct device_attribute *attr, 3115a0f3f1fSJuha Yrjola char *buf) 3125a0f3f1fSJuha Yrjola { 3135a0f3f1fSJuha Yrjola struct mmc_host *mmc = container_of(dev, struct mmc_host, class_dev); 3145a0f3f1fSJuha Yrjola struct mmc_omap_slot *slot = mmc_priv(mmc); 3155a0f3f1fSJuha Yrjola 3165a0f3f1fSJuha Yrjola return sprintf(buf, "%s\n", mmc_omap_cover_is_open(slot) ? "open" : 3175a0f3f1fSJuha Yrjola "closed"); 3185a0f3f1fSJuha Yrjola } 3195a0f3f1fSJuha Yrjola 3205a0f3f1fSJuha Yrjola static DEVICE_ATTR(cover_switch, S_IRUGO, mmc_omap_show_cover_switch, NULL); 3215a0f3f1fSJuha Yrjola 322abfbe5f7SJuha Yrjola static ssize_t 323abfbe5f7SJuha Yrjola mmc_omap_show_slot_name(struct device *dev, struct device_attribute *attr, 324abfbe5f7SJuha Yrjola char *buf) 325abfbe5f7SJuha Yrjola { 326abfbe5f7SJuha Yrjola struct mmc_host *mmc = container_of(dev, struct mmc_host, class_dev); 327abfbe5f7SJuha Yrjola struct mmc_omap_slot *slot = mmc_priv(mmc); 328abfbe5f7SJuha Yrjola 329abfbe5f7SJuha Yrjola return sprintf(buf, "%s\n", slot->pdata->name); 330abfbe5f7SJuha Yrjola } 331abfbe5f7SJuha Yrjola 332abfbe5f7SJuha Yrjola static DEVICE_ATTR(slot_name, S_IRUGO, mmc_omap_show_slot_name, NULL); 333abfbe5f7SJuha Yrjola 3341c6a0718SPierre Ossman static void 3351c6a0718SPierre Ossman mmc_omap_start_command(struct mmc_omap_host *host, struct mmc_command *cmd) 3361c6a0718SPierre Ossman { 3371c6a0718SPierre Ossman u32 cmdreg; 3381c6a0718SPierre Ossman u32 resptype; 3391c6a0718SPierre Ossman u32 cmdtype; 3401c6a0718SPierre Ossman 3411c6a0718SPierre Ossman host->cmd = cmd; 3421c6a0718SPierre Ossman 3431c6a0718SPierre Ossman resptype = 0; 3441c6a0718SPierre Ossman cmdtype = 0; 3451c6a0718SPierre Ossman 3461c6a0718SPierre Ossman /* Our hardware needs to know exact type */ 3471c6a0718SPierre Ossman switch (mmc_resp_type(cmd)) { 3481c6a0718SPierre Ossman case MMC_RSP_NONE: 3491c6a0718SPierre Ossman break; 3501c6a0718SPierre Ossman case MMC_RSP_R1: 3511c6a0718SPierre Ossman case MMC_RSP_R1B: 3521c6a0718SPierre Ossman /* resp 1, 1b, 6, 7 */ 3531c6a0718SPierre Ossman resptype = 1; 3541c6a0718SPierre Ossman break; 3551c6a0718SPierre Ossman case MMC_RSP_R2: 3561c6a0718SPierre Ossman resptype = 2; 3571c6a0718SPierre Ossman break; 3581c6a0718SPierre Ossman case MMC_RSP_R3: 3591c6a0718SPierre Ossman resptype = 3; 3601c6a0718SPierre Ossman break; 3611c6a0718SPierre Ossman default: 3621c6a0718SPierre Ossman dev_err(mmc_dev(host->mmc), "Invalid response type: %04x\n", mmc_resp_type(cmd)); 3631c6a0718SPierre Ossman break; 3641c6a0718SPierre Ossman } 3651c6a0718SPierre Ossman 3661c6a0718SPierre Ossman if (mmc_cmd_type(cmd) == MMC_CMD_ADTC) { 3671c6a0718SPierre Ossman cmdtype = OMAP_MMC_CMDTYPE_ADTC; 3681c6a0718SPierre Ossman } else if (mmc_cmd_type(cmd) == MMC_CMD_BC) { 3691c6a0718SPierre Ossman cmdtype = OMAP_MMC_CMDTYPE_BC; 3701c6a0718SPierre Ossman } else if (mmc_cmd_type(cmd) == MMC_CMD_BCR) { 3711c6a0718SPierre Ossman cmdtype = OMAP_MMC_CMDTYPE_BCR; 3721c6a0718SPierre Ossman } else { 3731c6a0718SPierre Ossman cmdtype = OMAP_MMC_CMDTYPE_AC; 3741c6a0718SPierre Ossman } 3751c6a0718SPierre Ossman 3761c6a0718SPierre Ossman cmdreg = cmd->opcode | (resptype << 8) | (cmdtype << 12); 3771c6a0718SPierre Ossman 378abfbe5f7SJuha Yrjola if (host->current_slot->bus_mode == MMC_BUSMODE_OPENDRAIN) 3791c6a0718SPierre Ossman cmdreg |= 1 << 6; 3801c6a0718SPierre Ossman 3811c6a0718SPierre Ossman if (cmd->flags & MMC_RSP_BUSY) 3821c6a0718SPierre Ossman cmdreg |= 1 << 11; 3831c6a0718SPierre Ossman 3841c6a0718SPierre Ossman if (host->data && !(host->data->flags & MMC_DATA_WRITE)) 3851c6a0718SPierre Ossman cmdreg |= 1 << 15; 3861c6a0718SPierre Ossman 3870fb4723dSJarkko Lavinen mod_timer(&host->cmd_abort_timer, jiffies + HZ/2); 388eb1860bcSJarkko Lavinen 3891c6a0718SPierre Ossman OMAP_MMC_WRITE(host, CTO, 200); 3901c6a0718SPierre Ossman OMAP_MMC_WRITE(host, ARGL, cmd->arg & 0xffff); 3911c6a0718SPierre Ossman OMAP_MMC_WRITE(host, ARGH, cmd->arg >> 16); 3921c6a0718SPierre Ossman OMAP_MMC_WRITE(host, IE, 3931c6a0718SPierre Ossman OMAP_MMC_STAT_A_EMPTY | OMAP_MMC_STAT_A_FULL | 3941c6a0718SPierre Ossman OMAP_MMC_STAT_CMD_CRC | OMAP_MMC_STAT_CMD_TOUT | 3951c6a0718SPierre Ossman OMAP_MMC_STAT_DATA_CRC | OMAP_MMC_STAT_DATA_TOUT | 3961c6a0718SPierre Ossman OMAP_MMC_STAT_END_OF_CMD | OMAP_MMC_STAT_CARD_ERR | 3971c6a0718SPierre Ossman OMAP_MMC_STAT_END_OF_DATA); 3981c6a0718SPierre Ossman OMAP_MMC_WRITE(host, CMD, cmdreg); 3991c6a0718SPierre Ossman } 4001c6a0718SPierre Ossman 4011c6a0718SPierre Ossman static void 402a914ded2SJuha Yrjola mmc_omap_release_dma(struct mmc_omap_host *host, struct mmc_data *data, 403a914ded2SJuha Yrjola int abort) 4041c6a0718SPierre Ossman { 4051c6a0718SPierre Ossman enum dma_data_direction dma_data_dir; 4061c6a0718SPierre Ossman 4071c6a0718SPierre Ossman BUG_ON(host->dma_ch < 0); 40817b0429dSPierre Ossman if (data->error) 4091c6a0718SPierre Ossman omap_stop_dma(host->dma_ch); 4101c6a0718SPierre Ossman /* Release DMA channel lazily */ 4111c6a0718SPierre Ossman mod_timer(&host->dma_timer, jiffies + HZ); 4121c6a0718SPierre Ossman if (data->flags & MMC_DATA_WRITE) 4131c6a0718SPierre Ossman dma_data_dir = DMA_TO_DEVICE; 4141c6a0718SPierre Ossman else 4151c6a0718SPierre Ossman dma_data_dir = DMA_FROM_DEVICE; 4161c6a0718SPierre Ossman dma_unmap_sg(mmc_dev(host->mmc), data->sg, host->sg_len, 4171c6a0718SPierre Ossman dma_data_dir); 4181c6a0718SPierre Ossman } 419a914ded2SJuha Yrjola 4200f602ec7SJarkko Lavinen static void mmc_omap_send_stop_work(struct work_struct *work) 4210f602ec7SJarkko Lavinen { 4220f602ec7SJarkko Lavinen struct mmc_omap_host *host = container_of(work, struct mmc_omap_host, 4230f602ec7SJarkko Lavinen send_stop_work); 4240f602ec7SJarkko Lavinen struct mmc_omap_slot *slot = host->current_slot; 4250f602ec7SJarkko Lavinen struct mmc_data *data = host->stop_data; 4260f602ec7SJarkko Lavinen unsigned long tick_ns; 4270f602ec7SJarkko Lavinen 4280f602ec7SJarkko Lavinen tick_ns = (1000000000 + slot->fclk_freq - 1)/slot->fclk_freq; 4290f602ec7SJarkko Lavinen ndelay(8*tick_ns); 4300f602ec7SJarkko Lavinen 4310f602ec7SJarkko Lavinen mmc_omap_start_command(host, data->stop); 4320f602ec7SJarkko Lavinen } 4330f602ec7SJarkko Lavinen 434a914ded2SJuha Yrjola static void 435a914ded2SJuha Yrjola mmc_omap_xfer_done(struct mmc_omap_host *host, struct mmc_data *data) 436a914ded2SJuha Yrjola { 437a914ded2SJuha Yrjola if (host->dma_in_use) 438a914ded2SJuha Yrjola mmc_omap_release_dma(host, data, data->error); 439a914ded2SJuha Yrjola 4401c6a0718SPierre Ossman host->data = NULL; 4411c6a0718SPierre Ossman host->sg_len = 0; 4421c6a0718SPierre Ossman 4431c6a0718SPierre Ossman /* NOTE: MMC layer will sometimes poll-wait CMD13 next, issuing 4441c6a0718SPierre Ossman * dozens of requests until the card finishes writing data. 4451c6a0718SPierre Ossman * It'd be cheaper to just wait till an EOFB interrupt arrives... 4461c6a0718SPierre Ossman */ 4471c6a0718SPierre Ossman 4481c6a0718SPierre Ossman if (!data->stop) { 449a914ded2SJuha Yrjola struct mmc_host *mmc; 450a914ded2SJuha Yrjola 4511c6a0718SPierre Ossman host->mrq = NULL; 452a914ded2SJuha Yrjola mmc = host->mmc; 4530807a9b5SJarkko Lavinen mmc_omap_release_slot(host->current_slot, 1); 454a914ded2SJuha Yrjola mmc_request_done(mmc, data->mrq); 4551c6a0718SPierre Ossman return; 4561c6a0718SPierre Ossman } 4571c6a0718SPierre Ossman 4580f602ec7SJarkko Lavinen host->stop_data = data; 4590f602ec7SJarkko Lavinen schedule_work(&host->send_stop_work); 4601c6a0718SPierre Ossman } 4611c6a0718SPierre Ossman 4621c6a0718SPierre Ossman static void 4630fb4723dSJarkko Lavinen mmc_omap_send_abort(struct mmc_omap_host *host, int maxloops) 464eb1860bcSJarkko Lavinen { 465eb1860bcSJarkko Lavinen struct mmc_omap_slot *slot = host->current_slot; 466eb1860bcSJarkko Lavinen unsigned int restarts, passes, timeout; 467eb1860bcSJarkko Lavinen u16 stat = 0; 468eb1860bcSJarkko Lavinen 469eb1860bcSJarkko Lavinen /* Sending abort takes 80 clocks. Have some extra and round up */ 470eb1860bcSJarkko Lavinen timeout = (120*1000000 + slot->fclk_freq - 1)/slot->fclk_freq; 471eb1860bcSJarkko Lavinen restarts = 0; 4720fb4723dSJarkko Lavinen while (restarts < maxloops) { 473eb1860bcSJarkko Lavinen OMAP_MMC_WRITE(host, STAT, 0xFFFF); 474eb1860bcSJarkko Lavinen OMAP_MMC_WRITE(host, CMD, (3 << 12) | (1 << 7)); 475eb1860bcSJarkko Lavinen 476eb1860bcSJarkko Lavinen passes = 0; 477eb1860bcSJarkko Lavinen while (passes < timeout) { 478eb1860bcSJarkko Lavinen stat = OMAP_MMC_READ(host, STAT); 479eb1860bcSJarkko Lavinen if (stat & OMAP_MMC_STAT_END_OF_CMD) 480eb1860bcSJarkko Lavinen goto out; 481eb1860bcSJarkko Lavinen udelay(1); 482eb1860bcSJarkko Lavinen passes++; 483eb1860bcSJarkko Lavinen } 484eb1860bcSJarkko Lavinen 485eb1860bcSJarkko Lavinen restarts++; 486eb1860bcSJarkko Lavinen } 487eb1860bcSJarkko Lavinen out: 488eb1860bcSJarkko Lavinen OMAP_MMC_WRITE(host, STAT, stat); 489eb1860bcSJarkko Lavinen } 490eb1860bcSJarkko Lavinen 491eb1860bcSJarkko Lavinen static void 492a914ded2SJuha Yrjola mmc_omap_abort_xfer(struct mmc_omap_host *host, struct mmc_data *data) 493a914ded2SJuha Yrjola { 494a914ded2SJuha Yrjola if (host->dma_in_use) 495a914ded2SJuha Yrjola mmc_omap_release_dma(host, data, 1); 496a914ded2SJuha Yrjola 497a914ded2SJuha Yrjola host->data = NULL; 498a914ded2SJuha Yrjola host->sg_len = 0; 499a914ded2SJuha Yrjola 5000fb4723dSJarkko Lavinen mmc_omap_send_abort(host, 10000); 501a914ded2SJuha Yrjola } 502a914ded2SJuha Yrjola 503a914ded2SJuha Yrjola static void 5041c6a0718SPierre Ossman mmc_omap_end_of_data(struct mmc_omap_host *host, struct mmc_data *data) 5051c6a0718SPierre Ossman { 5061c6a0718SPierre Ossman unsigned long flags; 5071c6a0718SPierre Ossman int done; 5081c6a0718SPierre Ossman 5091c6a0718SPierre Ossman if (!host->dma_in_use) { 5101c6a0718SPierre Ossman mmc_omap_xfer_done(host, data); 5111c6a0718SPierre Ossman return; 5121c6a0718SPierre Ossman } 5131c6a0718SPierre Ossman done = 0; 5141c6a0718SPierre Ossman spin_lock_irqsave(&host->dma_lock, flags); 5151c6a0718SPierre Ossman if (host->dma_done) 5161c6a0718SPierre Ossman done = 1; 5171c6a0718SPierre Ossman else 5181c6a0718SPierre Ossman host->brs_received = 1; 5191c6a0718SPierre Ossman spin_unlock_irqrestore(&host->dma_lock, flags); 5201c6a0718SPierre Ossman if (done) 5211c6a0718SPierre Ossman mmc_omap_xfer_done(host, data); 5221c6a0718SPierre Ossman } 5231c6a0718SPierre Ossman 5241c6a0718SPierre Ossman static void 5251c6a0718SPierre Ossman mmc_omap_dma_timer(unsigned long data) 5261c6a0718SPierre Ossman { 5271c6a0718SPierre Ossman struct mmc_omap_host *host = (struct mmc_omap_host *) data; 5281c6a0718SPierre Ossman 5291c6a0718SPierre Ossman BUG_ON(host->dma_ch < 0); 5301c6a0718SPierre Ossman omap_free_dma(host->dma_ch); 5311c6a0718SPierre Ossman host->dma_ch = -1; 5321c6a0718SPierre Ossman } 5331c6a0718SPierre Ossman 5341c6a0718SPierre Ossman static void 5351c6a0718SPierre Ossman mmc_omap_dma_done(struct mmc_omap_host *host, struct mmc_data *data) 5361c6a0718SPierre Ossman { 5371c6a0718SPierre Ossman unsigned long flags; 5381c6a0718SPierre Ossman int done; 5391c6a0718SPierre Ossman 5401c6a0718SPierre Ossman done = 0; 5411c6a0718SPierre Ossman spin_lock_irqsave(&host->dma_lock, flags); 5421c6a0718SPierre Ossman if (host->brs_received) 5431c6a0718SPierre Ossman done = 1; 5441c6a0718SPierre Ossman else 5451c6a0718SPierre Ossman host->dma_done = 1; 5461c6a0718SPierre Ossman spin_unlock_irqrestore(&host->dma_lock, flags); 5471c6a0718SPierre Ossman if (done) 5481c6a0718SPierre Ossman mmc_omap_xfer_done(host, data); 5491c6a0718SPierre Ossman } 5501c6a0718SPierre Ossman 5511c6a0718SPierre Ossman static void 5521c6a0718SPierre Ossman mmc_omap_cmd_done(struct mmc_omap_host *host, struct mmc_command *cmd) 5531c6a0718SPierre Ossman { 5541c6a0718SPierre Ossman host->cmd = NULL; 5551c6a0718SPierre Ossman 5560fb4723dSJarkko Lavinen del_timer(&host->cmd_abort_timer); 557eb1860bcSJarkko Lavinen 5581c6a0718SPierre Ossman if (cmd->flags & MMC_RSP_PRESENT) { 5591c6a0718SPierre Ossman if (cmd->flags & MMC_RSP_136) { 5601c6a0718SPierre Ossman /* response type 2 */ 5611c6a0718SPierre Ossman cmd->resp[3] = 5621c6a0718SPierre Ossman OMAP_MMC_READ(host, RSP0) | 5631c6a0718SPierre Ossman (OMAP_MMC_READ(host, RSP1) << 16); 5641c6a0718SPierre Ossman cmd->resp[2] = 5651c6a0718SPierre Ossman OMAP_MMC_READ(host, RSP2) | 5661c6a0718SPierre Ossman (OMAP_MMC_READ(host, RSP3) << 16); 5671c6a0718SPierre Ossman cmd->resp[1] = 5681c6a0718SPierre Ossman OMAP_MMC_READ(host, RSP4) | 5691c6a0718SPierre Ossman (OMAP_MMC_READ(host, RSP5) << 16); 5701c6a0718SPierre Ossman cmd->resp[0] = 5711c6a0718SPierre Ossman OMAP_MMC_READ(host, RSP6) | 5721c6a0718SPierre Ossman (OMAP_MMC_READ(host, RSP7) << 16); 5731c6a0718SPierre Ossman } else { 5741c6a0718SPierre Ossman /* response types 1, 1b, 3, 4, 5, 6 */ 5751c6a0718SPierre Ossman cmd->resp[0] = 5761c6a0718SPierre Ossman OMAP_MMC_READ(host, RSP6) | 5771c6a0718SPierre Ossman (OMAP_MMC_READ(host, RSP7) << 16); 5781c6a0718SPierre Ossman } 5791c6a0718SPierre Ossman } 5801c6a0718SPierre Ossman 58117b0429dSPierre Ossman if (host->data == NULL || cmd->error) { 582a914ded2SJuha Yrjola struct mmc_host *mmc; 583a914ded2SJuha Yrjola 584a914ded2SJuha Yrjola if (host->data != NULL) 585a914ded2SJuha Yrjola mmc_omap_abort_xfer(host, host->data); 5861c6a0718SPierre Ossman host->mrq = NULL; 587a914ded2SJuha Yrjola mmc = host->mmc; 5880807a9b5SJarkko Lavinen mmc_omap_release_slot(host->current_slot, 1); 589a914ded2SJuha Yrjola mmc_request_done(mmc, cmd->mrq); 5901c6a0718SPierre Ossman } 5911c6a0718SPierre Ossman } 5921c6a0718SPierre Ossman 593eb1860bcSJarkko Lavinen /* 594eb1860bcSJarkko Lavinen * Abort stuck command. Can occur when card is removed while it is being 595eb1860bcSJarkko Lavinen * read. 596eb1860bcSJarkko Lavinen */ 597eb1860bcSJarkko Lavinen static void mmc_omap_abort_command(struct work_struct *work) 598eb1860bcSJarkko Lavinen { 599eb1860bcSJarkko Lavinen struct mmc_omap_host *host = container_of(work, struct mmc_omap_host, 6000fb4723dSJarkko Lavinen cmd_abort_work); 6010fb4723dSJarkko Lavinen BUG_ON(!host->cmd); 602eb1860bcSJarkko Lavinen 603eb1860bcSJarkko Lavinen dev_dbg(mmc_dev(host->mmc), "Aborting stuck command CMD%d\n", 604eb1860bcSJarkko Lavinen host->cmd->opcode); 605eb1860bcSJarkko Lavinen 6060fb4723dSJarkko Lavinen if (host->cmd->error == 0) 607eb1860bcSJarkko Lavinen host->cmd->error = -ETIMEDOUT; 6080fb4723dSJarkko Lavinen 6090fb4723dSJarkko Lavinen if (host->data == NULL) { 6100fb4723dSJarkko Lavinen struct mmc_command *cmd; 6110fb4723dSJarkko Lavinen struct mmc_host *mmc; 6120fb4723dSJarkko Lavinen 6130fb4723dSJarkko Lavinen cmd = host->cmd; 6140fb4723dSJarkko Lavinen host->cmd = NULL; 6150fb4723dSJarkko Lavinen mmc_omap_send_abort(host, 10000); 6160fb4723dSJarkko Lavinen 6170fb4723dSJarkko Lavinen host->mrq = NULL; 6180fb4723dSJarkko Lavinen mmc = host->mmc; 6190807a9b5SJarkko Lavinen mmc_omap_release_slot(host->current_slot, 1); 6200fb4723dSJarkko Lavinen mmc_request_done(mmc, cmd->mrq); 6210fb4723dSJarkko Lavinen } else 622eb1860bcSJarkko Lavinen mmc_omap_cmd_done(host, host->cmd); 6230fb4723dSJarkko Lavinen 6240fb4723dSJarkko Lavinen host->abort = 0; 6250fb4723dSJarkko Lavinen enable_irq(host->irq); 626eb1860bcSJarkko Lavinen } 627eb1860bcSJarkko Lavinen 628eb1860bcSJarkko Lavinen static void 629eb1860bcSJarkko Lavinen mmc_omap_cmd_timer(unsigned long data) 630eb1860bcSJarkko Lavinen { 631eb1860bcSJarkko Lavinen struct mmc_omap_host *host = (struct mmc_omap_host *) data; 6320fb4723dSJarkko Lavinen unsigned long flags; 633eb1860bcSJarkko Lavinen 6340fb4723dSJarkko Lavinen spin_lock_irqsave(&host->slot_lock, flags); 6350fb4723dSJarkko Lavinen if (host->cmd != NULL && !host->abort) { 6360fb4723dSJarkko Lavinen OMAP_MMC_WRITE(host, IE, 0); 6370fb4723dSJarkko Lavinen disable_irq(host->irq); 6380fb4723dSJarkko Lavinen host->abort = 1; 6390fb4723dSJarkko Lavinen schedule_work(&host->cmd_abort_work); 6400fb4723dSJarkko Lavinen } 6410fb4723dSJarkko Lavinen spin_unlock_irqrestore(&host->slot_lock, flags); 642eb1860bcSJarkko Lavinen } 643eb1860bcSJarkko Lavinen 6441c6a0718SPierre Ossman /* PIO only */ 6451c6a0718SPierre Ossman static void 6461c6a0718SPierre Ossman mmc_omap_sg_to_buf(struct mmc_omap_host *host) 6471c6a0718SPierre Ossman { 6481c6a0718SPierre Ossman struct scatterlist *sg; 6491c6a0718SPierre Ossman 6501c6a0718SPierre Ossman sg = host->data->sg + host->sg_idx; 6511c6a0718SPierre Ossman host->buffer_bytes_left = sg->length; 65245711f1aSJens Axboe host->buffer = sg_virt(sg); 6531c6a0718SPierre Ossman if (host->buffer_bytes_left > host->total_bytes_left) 6541c6a0718SPierre Ossman host->buffer_bytes_left = host->total_bytes_left; 6551c6a0718SPierre Ossman } 6561c6a0718SPierre Ossman 6570807a9b5SJarkko Lavinen static void 6580807a9b5SJarkko Lavinen mmc_omap_clk_timer(unsigned long data) 6590807a9b5SJarkko Lavinen { 6600807a9b5SJarkko Lavinen struct mmc_omap_host *host = (struct mmc_omap_host *) data; 6610807a9b5SJarkko Lavinen 6620807a9b5SJarkko Lavinen mmc_omap_fclk_enable(host, 0); 6630807a9b5SJarkko Lavinen } 6640807a9b5SJarkko Lavinen 6651c6a0718SPierre Ossman /* PIO only */ 6661c6a0718SPierre Ossman static void 6671c6a0718SPierre Ossman mmc_omap_xfer_data(struct mmc_omap_host *host, int write) 6681c6a0718SPierre Ossman { 6691c6a0718SPierre Ossman int n; 6701c6a0718SPierre Ossman 6711c6a0718SPierre Ossman if (host->buffer_bytes_left == 0) { 6721c6a0718SPierre Ossman host->sg_idx++; 6731c6a0718SPierre Ossman BUG_ON(host->sg_idx == host->sg_len); 6741c6a0718SPierre Ossman mmc_omap_sg_to_buf(host); 6751c6a0718SPierre Ossman } 6761c6a0718SPierre Ossman n = 64; 6771c6a0718SPierre Ossman if (n > host->buffer_bytes_left) 6781c6a0718SPierre Ossman n = host->buffer_bytes_left; 6791c6a0718SPierre Ossman host->buffer_bytes_left -= n; 6801c6a0718SPierre Ossman host->total_bytes_left -= n; 6811c6a0718SPierre Ossman host->data->bytes_xfered += n; 6821c6a0718SPierre Ossman 6831c6a0718SPierre Ossman if (write) { 6841c6a0718SPierre Ossman __raw_writesw(host->virt_base + OMAP_MMC_REG_DATA, host->buffer, n); 6851c6a0718SPierre Ossman } else { 6861c6a0718SPierre Ossman __raw_readsw(host->virt_base + OMAP_MMC_REG_DATA, host->buffer, n); 6871c6a0718SPierre Ossman } 6881c6a0718SPierre Ossman } 6891c6a0718SPierre Ossman 6901c6a0718SPierre Ossman static inline void mmc_omap_report_irq(u16 status) 6911c6a0718SPierre Ossman { 6921c6a0718SPierre Ossman static const char *mmc_omap_status_bits[] = { 6931c6a0718SPierre Ossman "EOC", "CD", "CB", "BRS", "EOFB", "DTO", "DCRC", "CTO", 6941c6a0718SPierre Ossman "CCRC", "CRW", "AF", "AE", "OCRB", "CIRQ", "CERR" 6951c6a0718SPierre Ossman }; 6961c6a0718SPierre Ossman int i, c = 0; 6971c6a0718SPierre Ossman 6981c6a0718SPierre Ossman for (i = 0; i < ARRAY_SIZE(mmc_omap_status_bits); i++) 6991c6a0718SPierre Ossman if (status & (1 << i)) { 7001c6a0718SPierre Ossman if (c) 7011c6a0718SPierre Ossman printk(" "); 7021c6a0718SPierre Ossman printk("%s", mmc_omap_status_bits[i]); 7031c6a0718SPierre Ossman c++; 7041c6a0718SPierre Ossman } 7051c6a0718SPierre Ossman } 7061c6a0718SPierre Ossman 7071c6a0718SPierre Ossman static irqreturn_t mmc_omap_irq(int irq, void *dev_id) 7081c6a0718SPierre Ossman { 7091c6a0718SPierre Ossman struct mmc_omap_host * host = (struct mmc_omap_host *)dev_id; 7101c6a0718SPierre Ossman u16 status; 7111c6a0718SPierre Ossman int end_command; 7121c6a0718SPierre Ossman int end_transfer; 7132a50b888SJuha Yrjola int transfer_error, cmd_error; 7141c6a0718SPierre Ossman 7151c6a0718SPierre Ossman if (host->cmd == NULL && host->data == NULL) { 7161c6a0718SPierre Ossman status = OMAP_MMC_READ(host, STAT); 7172a50b888SJuha Yrjola dev_info(mmc_dev(host->slots[0]->mmc), 7182a50b888SJuha Yrjola "Spurious IRQ 0x%04x\n", status); 7191c6a0718SPierre Ossman if (status != 0) { 7201c6a0718SPierre Ossman OMAP_MMC_WRITE(host, STAT, status); 7211c6a0718SPierre Ossman OMAP_MMC_WRITE(host, IE, 0); 7221c6a0718SPierre Ossman } 7231c6a0718SPierre Ossman return IRQ_HANDLED; 7241c6a0718SPierre Ossman } 7251c6a0718SPierre Ossman 7261c6a0718SPierre Ossman end_command = 0; 7271c6a0718SPierre Ossman end_transfer = 0; 7281c6a0718SPierre Ossman transfer_error = 0; 7292a50b888SJuha Yrjola cmd_error = 0; 7301c6a0718SPierre Ossman 7311c6a0718SPierre Ossman while ((status = OMAP_MMC_READ(host, STAT)) != 0) { 7322a50b888SJuha Yrjola int cmd; 7332a50b888SJuha Yrjola 7341c6a0718SPierre Ossman OMAP_MMC_WRITE(host, STAT, status); 7352a50b888SJuha Yrjola if (host->cmd != NULL) 7362a50b888SJuha Yrjola cmd = host->cmd->opcode; 7372a50b888SJuha Yrjola else 7382a50b888SJuha Yrjola cmd = -1; 7391c6a0718SPierre Ossman #ifdef CONFIG_MMC_DEBUG 7401c6a0718SPierre Ossman dev_dbg(mmc_dev(host->mmc), "MMC IRQ %04x (CMD %d): ", 7412a50b888SJuha Yrjola status, cmd); 7421c6a0718SPierre Ossman mmc_omap_report_irq(status); 7431c6a0718SPierre Ossman printk("\n"); 7441c6a0718SPierre Ossman #endif 7451c6a0718SPierre Ossman if (host->total_bytes_left) { 7461c6a0718SPierre Ossman if ((status & OMAP_MMC_STAT_A_FULL) || 7471c6a0718SPierre Ossman (status & OMAP_MMC_STAT_END_OF_DATA)) 7481c6a0718SPierre Ossman mmc_omap_xfer_data(host, 0); 7491c6a0718SPierre Ossman if (status & OMAP_MMC_STAT_A_EMPTY) 7501c6a0718SPierre Ossman mmc_omap_xfer_data(host, 1); 7511c6a0718SPierre Ossman } 7521c6a0718SPierre Ossman 7532a50b888SJuha Yrjola if (status & OMAP_MMC_STAT_END_OF_DATA) 7541c6a0718SPierre Ossman end_transfer = 1; 7551c6a0718SPierre Ossman 7561c6a0718SPierre Ossman if (status & OMAP_MMC_STAT_DATA_TOUT) { 7572a50b888SJuha Yrjola dev_dbg(mmc_dev(host->mmc), "data timeout (CMD%d)\n", 7582a50b888SJuha Yrjola cmd); 7591c6a0718SPierre Ossman if (host->data) { 76017b0429dSPierre Ossman host->data->error = -ETIMEDOUT; 7611c6a0718SPierre Ossman transfer_error = 1; 7621c6a0718SPierre Ossman } 7631c6a0718SPierre Ossman } 7641c6a0718SPierre Ossman 7651c6a0718SPierre Ossman if (status & OMAP_MMC_STAT_DATA_CRC) { 7661c6a0718SPierre Ossman if (host->data) { 76717b0429dSPierre Ossman host->data->error = -EILSEQ; 7681c6a0718SPierre Ossman dev_dbg(mmc_dev(host->mmc), 7691c6a0718SPierre Ossman "data CRC error, bytes left %d\n", 7701c6a0718SPierre Ossman host->total_bytes_left); 7711c6a0718SPierre Ossman transfer_error = 1; 7721c6a0718SPierre Ossman } else { 7731c6a0718SPierre Ossman dev_dbg(mmc_dev(host->mmc), "data CRC error\n"); 7741c6a0718SPierre Ossman } 7751c6a0718SPierre Ossman } 7761c6a0718SPierre Ossman 7771c6a0718SPierre Ossman if (status & OMAP_MMC_STAT_CMD_TOUT) { 7781c6a0718SPierre Ossman /* Timeouts are routine with some commands */ 7791c6a0718SPierre Ossman if (host->cmd) { 780abfbe5f7SJuha Yrjola struct mmc_omap_slot *slot = 781abfbe5f7SJuha Yrjola host->current_slot; 7822a50b888SJuha Yrjola if (slot == NULL || 7832a50b888SJuha Yrjola !mmc_omap_cover_is_open(slot)) 7841c6a0718SPierre Ossman dev_err(mmc_dev(host->mmc), 7852a50b888SJuha Yrjola "command timeout (CMD%d)\n", 7862a50b888SJuha Yrjola cmd); 78717b0429dSPierre Ossman host->cmd->error = -ETIMEDOUT; 7881c6a0718SPierre Ossman end_command = 1; 7892a50b888SJuha Yrjola cmd_error = 1; 7901c6a0718SPierre Ossman } 7911c6a0718SPierre Ossman } 7921c6a0718SPierre Ossman 7931c6a0718SPierre Ossman if (status & OMAP_MMC_STAT_CMD_CRC) { 7941c6a0718SPierre Ossman if (host->cmd) { 7951c6a0718SPierre Ossman dev_err(mmc_dev(host->mmc), 7961c6a0718SPierre Ossman "command CRC error (CMD%d, arg 0x%08x)\n", 7972a50b888SJuha Yrjola cmd, host->cmd->arg); 79817b0429dSPierre Ossman host->cmd->error = -EILSEQ; 7991c6a0718SPierre Ossman end_command = 1; 8002a50b888SJuha Yrjola cmd_error = 1; 8011c6a0718SPierre Ossman } else 8021c6a0718SPierre Ossman dev_err(mmc_dev(host->mmc), 8031c6a0718SPierre Ossman "command CRC error without cmd?\n"); 8041c6a0718SPierre Ossman } 8051c6a0718SPierre Ossman 8061c6a0718SPierre Ossman if (status & OMAP_MMC_STAT_CARD_ERR) { 8070107a4b3SRagner Magalhaes dev_dbg(mmc_dev(host->mmc), 8080107a4b3SRagner Magalhaes "ignoring card status error (CMD%d)\n", 8092a50b888SJuha Yrjola cmd); 8101c6a0718SPierre Ossman end_command = 1; 8111c6a0718SPierre Ossman } 8121c6a0718SPierre Ossman 8131c6a0718SPierre Ossman /* 8141c6a0718SPierre Ossman * NOTE: On 1610 the END_OF_CMD may come too early when 8151c6a0718SPierre Ossman * starting a write 8161c6a0718SPierre Ossman */ 8171c6a0718SPierre Ossman if ((status & OMAP_MMC_STAT_END_OF_CMD) && 8181c6a0718SPierre Ossman (!(status & OMAP_MMC_STAT_A_EMPTY))) { 8191c6a0718SPierre Ossman end_command = 1; 8201c6a0718SPierre Ossman } 8211c6a0718SPierre Ossman } 8221c6a0718SPierre Ossman 8230fb4723dSJarkko Lavinen if (cmd_error && host->data) { 8240fb4723dSJarkko Lavinen del_timer(&host->cmd_abort_timer); 8250fb4723dSJarkko Lavinen host->abort = 1; 8260fb4723dSJarkko Lavinen OMAP_MMC_WRITE(host, IE, 0); 8270fb4723dSJarkko Lavinen disable_irq(host->irq); 8280fb4723dSJarkko Lavinen schedule_work(&host->cmd_abort_work); 8290fb4723dSJarkko Lavinen return IRQ_HANDLED; 8300fb4723dSJarkko Lavinen } 8310fb4723dSJarkko Lavinen 8322a50b888SJuha Yrjola if (end_command) 8331c6a0718SPierre Ossman mmc_omap_cmd_done(host, host->cmd); 8342a50b888SJuha Yrjola if (host->data != NULL) { 8351c6a0718SPierre Ossman if (transfer_error) 8361c6a0718SPierre Ossman mmc_omap_xfer_done(host, host->data); 8371c6a0718SPierre Ossman else if (end_transfer) 8381c6a0718SPierre Ossman mmc_omap_end_of_data(host, host->data); 8392a50b888SJuha Yrjola } 8401c6a0718SPierre Ossman 8411c6a0718SPierre Ossman return IRQ_HANDLED; 8421c6a0718SPierre Ossman } 8431c6a0718SPierre Ossman 8447584d276SJarkko Lavinen void omap_mmc_notify_cover_event(struct device *dev, int num, int is_closed) 8455a0f3f1fSJuha Yrjola { 8467584d276SJarkko Lavinen int cover_open; 8475a0f3f1fSJuha Yrjola struct mmc_omap_host *host = dev_get_drvdata(dev); 8487584d276SJarkko Lavinen struct mmc_omap_slot *slot = host->slots[num]; 8495a0f3f1fSJuha Yrjola 8507584d276SJarkko Lavinen BUG_ON(num >= host->nr_slots); 8515a0f3f1fSJuha Yrjola 8525a0f3f1fSJuha Yrjola /* Other subsystems can call in here before we're initialised. */ 8537584d276SJarkko Lavinen if (host->nr_slots == 0 || !host->slots[num]) 8545a0f3f1fSJuha Yrjola return; 8555a0f3f1fSJuha Yrjola 8565a0f3f1fSJuha Yrjola cover_open = mmc_omap_cover_is_open(slot); 8575a0f3f1fSJuha Yrjola if (cover_open != slot->cover_open) { 8585a0f3f1fSJuha Yrjola slot->cover_open = cover_open; 8597584d276SJarkko Lavinen sysfs_notify(&slot->mmc->class_dev.kobj, NULL, "cover_switch"); 8605a0f3f1fSJuha Yrjola } 8617584d276SJarkko Lavinen 8627584d276SJarkko Lavinen tasklet_hi_schedule(&slot->cover_tasklet); 8637584d276SJarkko Lavinen } 8647584d276SJarkko Lavinen 8657584d276SJarkko Lavinen static void mmc_omap_cover_timer(unsigned long arg) 8667584d276SJarkko Lavinen { 8677584d276SJarkko Lavinen struct mmc_omap_slot *slot = (struct mmc_omap_slot *) arg; 8687584d276SJarkko Lavinen tasklet_schedule(&slot->cover_tasklet); 8697584d276SJarkko Lavinen } 8707584d276SJarkko Lavinen 8717584d276SJarkko Lavinen static void mmc_omap_cover_handler(unsigned long param) 8727584d276SJarkko Lavinen { 8737584d276SJarkko Lavinen struct mmc_omap_slot *slot = (struct mmc_omap_slot *)param; 8747584d276SJarkko Lavinen int cover_open = mmc_omap_cover_is_open(slot); 8757584d276SJarkko Lavinen 8767584d276SJarkko Lavinen mmc_detect_change(slot->mmc, 0); 8777584d276SJarkko Lavinen if (!cover_open) 8787584d276SJarkko Lavinen return; 8797584d276SJarkko Lavinen 8807584d276SJarkko Lavinen /* 8817584d276SJarkko Lavinen * If no card is inserted, we postpone polling until 8827584d276SJarkko Lavinen * the cover has been closed. 8837584d276SJarkko Lavinen */ 8847584d276SJarkko Lavinen if (slot->mmc->card == NULL || !mmc_card_present(slot->mmc->card)) 8857584d276SJarkko Lavinen return; 8867584d276SJarkko Lavinen 8877584d276SJarkko Lavinen mod_timer(&slot->cover_timer, 8887584d276SJarkko Lavinen jiffies + msecs_to_jiffies(OMAP_MMC_COVER_POLL_DELAY)); 8895a0f3f1fSJuha Yrjola } 8905a0f3f1fSJuha Yrjola 8911c6a0718SPierre Ossman /* Prepare to transfer the next segment of a scatterlist */ 8921c6a0718SPierre Ossman static void 8931c6a0718SPierre Ossman mmc_omap_prepare_dma(struct mmc_omap_host *host, struct mmc_data *data) 8941c6a0718SPierre Ossman { 8951c6a0718SPierre Ossman int dma_ch = host->dma_ch; 8961c6a0718SPierre Ossman unsigned long data_addr; 8971c6a0718SPierre Ossman u16 buf, frame; 8981c6a0718SPierre Ossman u32 count; 8991c6a0718SPierre Ossman struct scatterlist *sg = &data->sg[host->sg_idx]; 9001c6a0718SPierre Ossman int src_port = 0; 9011c6a0718SPierre Ossman int dst_port = 0; 9021c6a0718SPierre Ossman int sync_dev = 0; 9031c6a0718SPierre Ossman 9041c6a0718SPierre Ossman data_addr = host->phys_base + OMAP_MMC_REG_DATA; 9051c6a0718SPierre Ossman frame = data->blksz; 9061c6a0718SPierre Ossman count = sg_dma_len(sg); 9071c6a0718SPierre Ossman 9081c6a0718SPierre Ossman if ((data->blocks == 1) && (count > data->blksz)) 9091c6a0718SPierre Ossman count = frame; 9101c6a0718SPierre Ossman 9111c6a0718SPierre Ossman host->dma_len = count; 9121c6a0718SPierre Ossman 9131c6a0718SPierre Ossman /* FIFO is 16x2 bytes on 15xx, and 32x2 bytes on 16xx and 24xx. 9141c6a0718SPierre Ossman * Use 16 or 32 word frames when the blocksize is at least that large. 9151c6a0718SPierre Ossman * Blocksize is usually 512 bytes; but not for some SD reads. 9161c6a0718SPierre Ossman */ 9171c6a0718SPierre Ossman if (cpu_is_omap15xx() && frame > 32) 9181c6a0718SPierre Ossman frame = 32; 9191c6a0718SPierre Ossman else if (frame > 64) 9201c6a0718SPierre Ossman frame = 64; 9211c6a0718SPierre Ossman count /= frame; 9221c6a0718SPierre Ossman frame >>= 1; 9231c6a0718SPierre Ossman 9241c6a0718SPierre Ossman if (!(data->flags & MMC_DATA_WRITE)) { 9251c6a0718SPierre Ossman buf = 0x800f | ((frame - 1) << 8); 9261c6a0718SPierre Ossman 9271c6a0718SPierre Ossman if (cpu_class_is_omap1()) { 9281c6a0718SPierre Ossman src_port = OMAP_DMA_PORT_TIPB; 9291c6a0718SPierre Ossman dst_port = OMAP_DMA_PORT_EMIFF; 9301c6a0718SPierre Ossman } 9311c6a0718SPierre Ossman if (cpu_is_omap24xx()) 9321c6a0718SPierre Ossman sync_dev = OMAP24XX_DMA_MMC1_RX; 9331c6a0718SPierre Ossman 9341c6a0718SPierre Ossman omap_set_dma_src_params(dma_ch, src_port, 9351c6a0718SPierre Ossman OMAP_DMA_AMODE_CONSTANT, 9361c6a0718SPierre Ossman data_addr, 0, 0); 9371c6a0718SPierre Ossman omap_set_dma_dest_params(dma_ch, dst_port, 9381c6a0718SPierre Ossman OMAP_DMA_AMODE_POST_INC, 9391c6a0718SPierre Ossman sg_dma_address(sg), 0, 0); 9401c6a0718SPierre Ossman omap_set_dma_dest_data_pack(dma_ch, 1); 9411c6a0718SPierre Ossman omap_set_dma_dest_burst_mode(dma_ch, OMAP_DMA_DATA_BURST_4); 9421c6a0718SPierre Ossman } else { 9431c6a0718SPierre Ossman buf = 0x0f80 | ((frame - 1) << 0); 9441c6a0718SPierre Ossman 9451c6a0718SPierre Ossman if (cpu_class_is_omap1()) { 9461c6a0718SPierre Ossman src_port = OMAP_DMA_PORT_EMIFF; 9471c6a0718SPierre Ossman dst_port = OMAP_DMA_PORT_TIPB; 9481c6a0718SPierre Ossman } 9491c6a0718SPierre Ossman if (cpu_is_omap24xx()) 9501c6a0718SPierre Ossman sync_dev = OMAP24XX_DMA_MMC1_TX; 9511c6a0718SPierre Ossman 9521c6a0718SPierre Ossman omap_set_dma_dest_params(dma_ch, dst_port, 9531c6a0718SPierre Ossman OMAP_DMA_AMODE_CONSTANT, 9541c6a0718SPierre Ossman data_addr, 0, 0); 9551c6a0718SPierre Ossman omap_set_dma_src_params(dma_ch, src_port, 9561c6a0718SPierre Ossman OMAP_DMA_AMODE_POST_INC, 9571c6a0718SPierre Ossman sg_dma_address(sg), 0, 0); 9581c6a0718SPierre Ossman omap_set_dma_src_data_pack(dma_ch, 1); 9591c6a0718SPierre Ossman omap_set_dma_src_burst_mode(dma_ch, OMAP_DMA_DATA_BURST_4); 9601c6a0718SPierre Ossman } 9611c6a0718SPierre Ossman 9621c6a0718SPierre Ossman /* Max limit for DMA frame count is 0xffff */ 9631c6a0718SPierre Ossman BUG_ON(count > 0xffff); 9641c6a0718SPierre Ossman 9651c6a0718SPierre Ossman OMAP_MMC_WRITE(host, BUF, buf); 9661c6a0718SPierre Ossman omap_set_dma_transfer_params(dma_ch, OMAP_DMA_DATA_TYPE_S16, 9671c6a0718SPierre Ossman frame, count, OMAP_DMA_SYNC_FRAME, 9681c6a0718SPierre Ossman sync_dev, 0); 9691c6a0718SPierre Ossman } 9701c6a0718SPierre Ossman 9711c6a0718SPierre Ossman /* A scatterlist segment completed */ 9721c6a0718SPierre Ossman static void mmc_omap_dma_cb(int lch, u16 ch_status, void *data) 9731c6a0718SPierre Ossman { 9741c6a0718SPierre Ossman struct mmc_omap_host *host = (struct mmc_omap_host *) data; 9751c6a0718SPierre Ossman struct mmc_data *mmcdat = host->data; 9761c6a0718SPierre Ossman 9771c6a0718SPierre Ossman if (unlikely(host->dma_ch < 0)) { 9781c6a0718SPierre Ossman dev_err(mmc_dev(host->mmc), 9791c6a0718SPierre Ossman "DMA callback while DMA not enabled\n"); 9801c6a0718SPierre Ossman return; 9811c6a0718SPierre Ossman } 9821c6a0718SPierre Ossman /* FIXME: We really should do something to _handle_ the errors */ 9831c6a0718SPierre Ossman if (ch_status & OMAP1_DMA_TOUT_IRQ) { 9841c6a0718SPierre Ossman dev_err(mmc_dev(host->mmc),"DMA timeout\n"); 9851c6a0718SPierre Ossman return; 9861c6a0718SPierre Ossman } 9871c6a0718SPierre Ossman if (ch_status & OMAP_DMA_DROP_IRQ) { 9881c6a0718SPierre Ossman dev_err(mmc_dev(host->mmc), "DMA sync error\n"); 9891c6a0718SPierre Ossman return; 9901c6a0718SPierre Ossman } 9911c6a0718SPierre Ossman if (!(ch_status & OMAP_DMA_BLOCK_IRQ)) { 9921c6a0718SPierre Ossman return; 9931c6a0718SPierre Ossman } 9941c6a0718SPierre Ossman mmcdat->bytes_xfered += host->dma_len; 9951c6a0718SPierre Ossman host->sg_idx++; 9961c6a0718SPierre Ossman if (host->sg_idx < host->sg_len) { 9971c6a0718SPierre Ossman mmc_omap_prepare_dma(host, host->data); 9981c6a0718SPierre Ossman omap_start_dma(host->dma_ch); 9991c6a0718SPierre Ossman } else 10001c6a0718SPierre Ossman mmc_omap_dma_done(host, host->data); 10011c6a0718SPierre Ossman } 10021c6a0718SPierre Ossman 10031c6a0718SPierre Ossman static int mmc_omap_get_dma_channel(struct mmc_omap_host *host, struct mmc_data *data) 10041c6a0718SPierre Ossman { 1005df48dd02STony Lindgren const char *dma_dev_name; 10061c6a0718SPierre Ossman int sync_dev, dma_ch, is_read, r; 10071c6a0718SPierre Ossman 10081c6a0718SPierre Ossman is_read = !(data->flags & MMC_DATA_WRITE); 10091c6a0718SPierre Ossman del_timer_sync(&host->dma_timer); 10101c6a0718SPierre Ossman if (host->dma_ch >= 0) { 10111c6a0718SPierre Ossman if (is_read == host->dma_is_read) 10121c6a0718SPierre Ossman return 0; 10131c6a0718SPierre Ossman omap_free_dma(host->dma_ch); 10141c6a0718SPierre Ossman host->dma_ch = -1; 10151c6a0718SPierre Ossman } 10161c6a0718SPierre Ossman 10171c6a0718SPierre Ossman if (is_read) { 1018*d8874665STony Lindgren if (host->id == 0) { 10191c6a0718SPierre Ossman sync_dev = OMAP_DMA_MMC_RX; 1020df48dd02STony Lindgren dma_dev_name = "MMC1 read"; 10211c6a0718SPierre Ossman } else { 10221c6a0718SPierre Ossman sync_dev = OMAP_DMA_MMC2_RX; 1023df48dd02STony Lindgren dma_dev_name = "MMC2 read"; 10241c6a0718SPierre Ossman } 10251c6a0718SPierre Ossman } else { 1026*d8874665STony Lindgren if (host->id == 0) { 10271c6a0718SPierre Ossman sync_dev = OMAP_DMA_MMC_TX; 1028df48dd02STony Lindgren dma_dev_name = "MMC1 write"; 10291c6a0718SPierre Ossman } else { 10301c6a0718SPierre Ossman sync_dev = OMAP_DMA_MMC2_TX; 1031df48dd02STony Lindgren dma_dev_name = "MMC2 write"; 10321c6a0718SPierre Ossman } 10331c6a0718SPierre Ossman } 1034df48dd02STony Lindgren r = omap_request_dma(sync_dev, dma_dev_name, mmc_omap_dma_cb, 10351c6a0718SPierre Ossman host, &dma_ch); 10361c6a0718SPierre Ossman if (r != 0) { 10371c6a0718SPierre Ossman dev_dbg(mmc_dev(host->mmc), "omap_request_dma() failed with %d\n", r); 10381c6a0718SPierre Ossman return r; 10391c6a0718SPierre Ossman } 10401c6a0718SPierre Ossman host->dma_ch = dma_ch; 10411c6a0718SPierre Ossman host->dma_is_read = is_read; 10421c6a0718SPierre Ossman 10431c6a0718SPierre Ossman return 0; 10441c6a0718SPierre Ossman } 10451c6a0718SPierre Ossman 10461c6a0718SPierre Ossman static inline void set_cmd_timeout(struct mmc_omap_host *host, struct mmc_request *req) 10471c6a0718SPierre Ossman { 10481c6a0718SPierre Ossman u16 reg; 10491c6a0718SPierre Ossman 10501c6a0718SPierre Ossman reg = OMAP_MMC_READ(host, SDIO); 10511c6a0718SPierre Ossman reg &= ~(1 << 5); 10521c6a0718SPierre Ossman OMAP_MMC_WRITE(host, SDIO, reg); 10531c6a0718SPierre Ossman /* Set maximum timeout */ 10541c6a0718SPierre Ossman OMAP_MMC_WRITE(host, CTO, 0xff); 10551c6a0718SPierre Ossman } 10561c6a0718SPierre Ossman 10571c6a0718SPierre Ossman static inline void set_data_timeout(struct mmc_omap_host *host, struct mmc_request *req) 10581c6a0718SPierre Ossman { 1059b8f9f0e9SJuha Yrjola unsigned int timeout, cycle_ns; 10601c6a0718SPierre Ossman u16 reg; 10611c6a0718SPierre Ossman 1062b8f9f0e9SJuha Yrjola cycle_ns = 1000000000 / host->current_slot->fclk_freq; 1063b8f9f0e9SJuha Yrjola timeout = req->data->timeout_ns / cycle_ns; 1064b8f9f0e9SJuha Yrjola timeout += req->data->timeout_clks; 10651c6a0718SPierre Ossman 10661c6a0718SPierre Ossman /* Check if we need to use timeout multiplier register */ 10671c6a0718SPierre Ossman reg = OMAP_MMC_READ(host, SDIO); 10681c6a0718SPierre Ossman if (timeout > 0xffff) { 10691c6a0718SPierre Ossman reg |= (1 << 5); 10701c6a0718SPierre Ossman timeout /= 1024; 10711c6a0718SPierre Ossman } else 10721c6a0718SPierre Ossman reg &= ~(1 << 5); 10731c6a0718SPierre Ossman OMAP_MMC_WRITE(host, SDIO, reg); 10741c6a0718SPierre Ossman OMAP_MMC_WRITE(host, DTO, timeout); 10751c6a0718SPierre Ossman } 10761c6a0718SPierre Ossman 10771c6a0718SPierre Ossman static void 10781c6a0718SPierre Ossman mmc_omap_prepare_data(struct mmc_omap_host *host, struct mmc_request *req) 10791c6a0718SPierre Ossman { 10801c6a0718SPierre Ossman struct mmc_data *data = req->data; 10811c6a0718SPierre Ossman int i, use_dma, block_size; 10821c6a0718SPierre Ossman unsigned sg_len; 10831c6a0718SPierre Ossman 10841c6a0718SPierre Ossman host->data = data; 10851c6a0718SPierre Ossman if (data == NULL) { 10861c6a0718SPierre Ossman OMAP_MMC_WRITE(host, BLEN, 0); 10871c6a0718SPierre Ossman OMAP_MMC_WRITE(host, NBLK, 0); 10881c6a0718SPierre Ossman OMAP_MMC_WRITE(host, BUF, 0); 10891c6a0718SPierre Ossman host->dma_in_use = 0; 10901c6a0718SPierre Ossman set_cmd_timeout(host, req); 10911c6a0718SPierre Ossman return; 10921c6a0718SPierre Ossman } 10931c6a0718SPierre Ossman 10941c6a0718SPierre Ossman block_size = data->blksz; 10951c6a0718SPierre Ossman 10961c6a0718SPierre Ossman OMAP_MMC_WRITE(host, NBLK, data->blocks - 1); 10971c6a0718SPierre Ossman OMAP_MMC_WRITE(host, BLEN, block_size - 1); 10981c6a0718SPierre Ossman set_data_timeout(host, req); 10991c6a0718SPierre Ossman 11001c6a0718SPierre Ossman /* cope with calling layer confusion; it issues "single 11011c6a0718SPierre Ossman * block" writes using multi-block scatterlists. 11021c6a0718SPierre Ossman */ 11031c6a0718SPierre Ossman sg_len = (data->blocks == 1) ? 1 : data->sg_len; 11041c6a0718SPierre Ossman 11051c6a0718SPierre Ossman /* Only do DMA for entire blocks */ 11061c6a0718SPierre Ossman use_dma = host->use_dma; 11071c6a0718SPierre Ossman if (use_dma) { 11081c6a0718SPierre Ossman for (i = 0; i < sg_len; i++) { 11091c6a0718SPierre Ossman if ((data->sg[i].length % block_size) != 0) { 11101c6a0718SPierre Ossman use_dma = 0; 11111c6a0718SPierre Ossman break; 11121c6a0718SPierre Ossman } 11131c6a0718SPierre Ossman } 11141c6a0718SPierre Ossman } 11151c6a0718SPierre Ossman 11161c6a0718SPierre Ossman host->sg_idx = 0; 11171c6a0718SPierre Ossman if (use_dma) { 11181c6a0718SPierre Ossman if (mmc_omap_get_dma_channel(host, data) == 0) { 11191c6a0718SPierre Ossman enum dma_data_direction dma_data_dir; 11201c6a0718SPierre Ossman 11211c6a0718SPierre Ossman if (data->flags & MMC_DATA_WRITE) 11221c6a0718SPierre Ossman dma_data_dir = DMA_TO_DEVICE; 11231c6a0718SPierre Ossman else 11241c6a0718SPierre Ossman dma_data_dir = DMA_FROM_DEVICE; 11251c6a0718SPierre Ossman 11261c6a0718SPierre Ossman host->sg_len = dma_map_sg(mmc_dev(host->mmc), data->sg, 11271c6a0718SPierre Ossman sg_len, dma_data_dir); 11281c6a0718SPierre Ossman host->total_bytes_left = 0; 11291c6a0718SPierre Ossman mmc_omap_prepare_dma(host, req->data); 11301c6a0718SPierre Ossman host->brs_received = 0; 11311c6a0718SPierre Ossman host->dma_done = 0; 11321c6a0718SPierre Ossman host->dma_in_use = 1; 11331c6a0718SPierre Ossman } else 11341c6a0718SPierre Ossman use_dma = 0; 11351c6a0718SPierre Ossman } 11361c6a0718SPierre Ossman 11371c6a0718SPierre Ossman /* Revert to PIO? */ 11381c6a0718SPierre Ossman if (!use_dma) { 11391c6a0718SPierre Ossman OMAP_MMC_WRITE(host, BUF, 0x1f1f); 11401c6a0718SPierre Ossman host->total_bytes_left = data->blocks * block_size; 11411c6a0718SPierre Ossman host->sg_len = sg_len; 11421c6a0718SPierre Ossman mmc_omap_sg_to_buf(host); 11431c6a0718SPierre Ossman host->dma_in_use = 0; 11441c6a0718SPierre Ossman } 11451c6a0718SPierre Ossman } 11461c6a0718SPierre Ossman 1147abfbe5f7SJuha Yrjola static void mmc_omap_start_request(struct mmc_omap_host *host, 1148abfbe5f7SJuha Yrjola struct mmc_request *req) 11491c6a0718SPierre Ossman { 1150abfbe5f7SJuha Yrjola BUG_ON(host->mrq != NULL); 11511c6a0718SPierre Ossman 11521c6a0718SPierre Ossman host->mrq = req; 11531c6a0718SPierre Ossman 11541c6a0718SPierre Ossman /* only touch fifo AFTER the controller readies it */ 11551c6a0718SPierre Ossman mmc_omap_prepare_data(host, req); 11561c6a0718SPierre Ossman mmc_omap_start_command(host, req->cmd); 11571c6a0718SPierre Ossman if (host->dma_in_use) 11581c6a0718SPierre Ossman omap_start_dma(host->dma_ch); 1159abfbe5f7SJuha Yrjola BUG_ON(irqs_disabled()); 1160abfbe5f7SJuha Yrjola } 1161abfbe5f7SJuha Yrjola 1162abfbe5f7SJuha Yrjola static void mmc_omap_request(struct mmc_host *mmc, struct mmc_request *req) 1163abfbe5f7SJuha Yrjola { 1164abfbe5f7SJuha Yrjola struct mmc_omap_slot *slot = mmc_priv(mmc); 1165abfbe5f7SJuha Yrjola struct mmc_omap_host *host = slot->host; 1166abfbe5f7SJuha Yrjola unsigned long flags; 1167abfbe5f7SJuha Yrjola 1168abfbe5f7SJuha Yrjola spin_lock_irqsave(&host->slot_lock, flags); 1169abfbe5f7SJuha Yrjola if (host->mmc != NULL) { 1170abfbe5f7SJuha Yrjola BUG_ON(slot->mrq != NULL); 1171abfbe5f7SJuha Yrjola slot->mrq = req; 1172abfbe5f7SJuha Yrjola spin_unlock_irqrestore(&host->slot_lock, flags); 1173abfbe5f7SJuha Yrjola return; 1174abfbe5f7SJuha Yrjola } else 1175abfbe5f7SJuha Yrjola host->mmc = mmc; 1176abfbe5f7SJuha Yrjola spin_unlock_irqrestore(&host->slot_lock, flags); 1177abfbe5f7SJuha Yrjola mmc_omap_select_slot(slot, 1); 1178abfbe5f7SJuha Yrjola mmc_omap_start_request(host, req); 11791c6a0718SPierre Ossman } 11801c6a0718SPierre Ossman 118165b5b6e5SJuha Yrjola static void mmc_omap_set_power(struct mmc_omap_slot *slot, int power_on, 118265b5b6e5SJuha Yrjola int vdd) 11831c6a0718SPierre Ossman { 118465b5b6e5SJuha Yrjola struct mmc_omap_host *host; 11851c6a0718SPierre Ossman 118665b5b6e5SJuha Yrjola host = slot->host; 118765b5b6e5SJuha Yrjola 118865b5b6e5SJuha Yrjola if (slot->pdata->set_power != NULL) 118965b5b6e5SJuha Yrjola slot->pdata->set_power(mmc_dev(slot->mmc), slot->id, power_on, 119065b5b6e5SJuha Yrjola vdd); 119165b5b6e5SJuha Yrjola 119265b5b6e5SJuha Yrjola if (cpu_is_omap24xx()) { 119365b5b6e5SJuha Yrjola u16 w; 119465b5b6e5SJuha Yrjola 119565b5b6e5SJuha Yrjola if (power_on) { 119665b5b6e5SJuha Yrjola w = OMAP_MMC_READ(host, CON); 119765b5b6e5SJuha Yrjola OMAP_MMC_WRITE(host, CON, w | (1 << 11)); 11981c6a0718SPierre Ossman } else { 119965b5b6e5SJuha Yrjola w = OMAP_MMC_READ(host, CON); 120065b5b6e5SJuha Yrjola OMAP_MMC_WRITE(host, CON, w & ~(1 << 11)); 120165b5b6e5SJuha Yrjola } 12021c6a0718SPierre Ossman } 12031c6a0718SPierre Ossman } 12041c6a0718SPierre Ossman 1205d3af5abeSTony Lindgren static int mmc_omap_calc_divisor(struct mmc_host *mmc, struct mmc_ios *ios) 12061c6a0718SPierre Ossman { 1207abfbe5f7SJuha Yrjola struct mmc_omap_slot *slot = mmc_priv(mmc); 1208abfbe5f7SJuha Yrjola struct mmc_omap_host *host = slot->host; 1209d3af5abeSTony Lindgren int func_clk_rate = clk_get_rate(host->fclk); 12101c6a0718SPierre Ossman int dsor; 12111c6a0718SPierre Ossman 12121c6a0718SPierre Ossman if (ios->clock == 0) 1213d3af5abeSTony Lindgren return 0; 12141c6a0718SPierre Ossman 1215d3af5abeSTony Lindgren dsor = func_clk_rate / ios->clock; 12161c6a0718SPierre Ossman if (dsor < 1) 12171c6a0718SPierre Ossman dsor = 1; 12181c6a0718SPierre Ossman 1219d3af5abeSTony Lindgren if (func_clk_rate / dsor > ios->clock) 12201c6a0718SPierre Ossman dsor++; 12211c6a0718SPierre Ossman 12221c6a0718SPierre Ossman if (dsor > 250) 12231c6a0718SPierre Ossman dsor = 250; 12241c6a0718SPierre Ossman 1225abfbe5f7SJuha Yrjola slot->fclk_freq = func_clk_rate / dsor; 1226abfbe5f7SJuha Yrjola 12271c6a0718SPierre Ossman if (ios->bus_width == MMC_BUS_WIDTH_4) 12281c6a0718SPierre Ossman dsor |= 1 << 15; 1229d3af5abeSTony Lindgren 1230d3af5abeSTony Lindgren return dsor; 12311c6a0718SPierre Ossman } 12321c6a0718SPierre Ossman 1233d3af5abeSTony Lindgren static void mmc_omap_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) 1234d3af5abeSTony Lindgren { 1235abfbe5f7SJuha Yrjola struct mmc_omap_slot *slot = mmc_priv(mmc); 1236abfbe5f7SJuha Yrjola struct mmc_omap_host *host = slot->host; 1237abfbe5f7SJuha Yrjola int i, dsor; 12380807a9b5SJarkko Lavinen int clk_enabled; 123965b5b6e5SJuha Yrjola 124065b5b6e5SJuha Yrjola mmc_omap_select_slot(slot, 0); 124165b5b6e5SJuha Yrjola 12420807a9b5SJarkko Lavinen dsor = mmc_omap_calc_divisor(mmc, ios); 12430807a9b5SJarkko Lavinen 124465b5b6e5SJuha Yrjola if (ios->vdd != slot->vdd) 124565b5b6e5SJuha Yrjola slot->vdd = ios->vdd; 1246d3af5abeSTony Lindgren 12470807a9b5SJarkko Lavinen clk_enabled = 0; 12481c6a0718SPierre Ossman switch (ios->power_mode) { 12491c6a0718SPierre Ossman case MMC_POWER_OFF: 125065b5b6e5SJuha Yrjola mmc_omap_set_power(slot, 0, ios->vdd); 12511c6a0718SPierre Ossman break; 12521c6a0718SPierre Ossman case MMC_POWER_UP: 125346a6730eSTony Lindgren /* Cannot touch dsor yet, just power up MMC */ 125465b5b6e5SJuha Yrjola mmc_omap_set_power(slot, 1, ios->vdd); 125565b5b6e5SJuha Yrjola goto exit; 125646a6730eSTony Lindgren case MMC_POWER_ON: 12570807a9b5SJarkko Lavinen mmc_omap_fclk_enable(host, 1); 12580807a9b5SJarkko Lavinen clk_enabled = 1; 12591c6a0718SPierre Ossman dsor |= 1 << 11; 12601c6a0718SPierre Ossman break; 12611c6a0718SPierre Ossman } 12621c6a0718SPierre Ossman 126365b5b6e5SJuha Yrjola if (slot->bus_mode != ios->bus_mode) { 126465b5b6e5SJuha Yrjola if (slot->pdata->set_bus_mode != NULL) 126565b5b6e5SJuha Yrjola slot->pdata->set_bus_mode(mmc_dev(mmc), slot->id, 126665b5b6e5SJuha Yrjola ios->bus_mode); 126765b5b6e5SJuha Yrjola slot->bus_mode = ios->bus_mode; 126865b5b6e5SJuha Yrjola } 12691c6a0718SPierre Ossman 12701c6a0718SPierre Ossman /* On insanely high arm_per frequencies something sometimes 12711c6a0718SPierre Ossman * goes somehow out of sync, and the POW bit is not being set, 12721c6a0718SPierre Ossman * which results in the while loop below getting stuck. 12731c6a0718SPierre Ossman * Writing to the CON register twice seems to do the trick. */ 12741c6a0718SPierre Ossman for (i = 0; i < 2; i++) 12751c6a0718SPierre Ossman OMAP_MMC_WRITE(host, CON, dsor); 127665b5b6e5SJuha Yrjola slot->saved_con = dsor; 127746a6730eSTony Lindgren if (ios->power_mode == MMC_POWER_ON) { 12789d7c6eeeSJarkko Lavinen /* worst case at 400kHz, 80 cycles makes 200 microsecs */ 12799d7c6eeeSJarkko Lavinen int usecs = 250; 12809d7c6eeeSJarkko Lavinen 12811c6a0718SPierre Ossman /* Send clock cycles, poll completion */ 12821c6a0718SPierre Ossman OMAP_MMC_WRITE(host, IE, 0); 12831c6a0718SPierre Ossman OMAP_MMC_WRITE(host, STAT, 0xffff); 12841c6a0718SPierre Ossman OMAP_MMC_WRITE(host, CMD, 1 << 7); 12859d7c6eeeSJarkko Lavinen while (usecs > 0 && (OMAP_MMC_READ(host, STAT) & 1) == 0) { 12869d7c6eeeSJarkko Lavinen udelay(1); 12879d7c6eeeSJarkko Lavinen usecs--; 12889d7c6eeeSJarkko Lavinen } 12891c6a0718SPierre Ossman OMAP_MMC_WRITE(host, STAT, 1); 12901c6a0718SPierre Ossman } 129165b5b6e5SJuha Yrjola 129265b5b6e5SJuha Yrjola exit: 12930807a9b5SJarkko Lavinen mmc_omap_release_slot(slot, clk_enabled); 12941c6a0718SPierre Ossman } 12951c6a0718SPierre Ossman 12961c6a0718SPierre Ossman static const struct mmc_host_ops mmc_omap_ops = { 12971c6a0718SPierre Ossman .request = mmc_omap_request, 12981c6a0718SPierre Ossman .set_ios = mmc_omap_set_ios, 12991c6a0718SPierre Ossman }; 13001c6a0718SPierre Ossman 1301abfbe5f7SJuha Yrjola static int __init mmc_omap_new_slot(struct mmc_omap_host *host, int id) 1302abfbe5f7SJuha Yrjola { 1303abfbe5f7SJuha Yrjola struct mmc_omap_slot *slot = NULL; 1304abfbe5f7SJuha Yrjola struct mmc_host *mmc; 1305abfbe5f7SJuha Yrjola int r; 1306abfbe5f7SJuha Yrjola 1307abfbe5f7SJuha Yrjola mmc = mmc_alloc_host(sizeof(struct mmc_omap_slot), host->dev); 1308abfbe5f7SJuha Yrjola if (mmc == NULL) 1309abfbe5f7SJuha Yrjola return -ENOMEM; 1310abfbe5f7SJuha Yrjola 1311abfbe5f7SJuha Yrjola slot = mmc_priv(mmc); 1312abfbe5f7SJuha Yrjola slot->host = host; 1313abfbe5f7SJuha Yrjola slot->mmc = mmc; 1314abfbe5f7SJuha Yrjola slot->id = id; 1315abfbe5f7SJuha Yrjola slot->pdata = &host->pdata->slots[id]; 1316abfbe5f7SJuha Yrjola 1317abfbe5f7SJuha Yrjola host->slots[id] = slot; 1318abfbe5f7SJuha Yrjola 131923af6039SPierre Ossman mmc->caps = 0; 1320*d8874665STony Lindgren if (host->pdata->slots[id].wire4) 1321abfbe5f7SJuha Yrjola mmc->caps |= MMC_CAP_4_BIT_DATA; 1322abfbe5f7SJuha Yrjola 1323abfbe5f7SJuha Yrjola mmc->ops = &mmc_omap_ops; 1324abfbe5f7SJuha Yrjola mmc->f_min = 400000; 1325abfbe5f7SJuha Yrjola 1326abfbe5f7SJuha Yrjola if (cpu_class_is_omap2()) 1327abfbe5f7SJuha Yrjola mmc->f_max = 48000000; 1328abfbe5f7SJuha Yrjola else 1329abfbe5f7SJuha Yrjola mmc->f_max = 24000000; 1330abfbe5f7SJuha Yrjola if (host->pdata->max_freq) 1331abfbe5f7SJuha Yrjola mmc->f_max = min(host->pdata->max_freq, mmc->f_max); 1332abfbe5f7SJuha Yrjola mmc->ocr_avail = slot->pdata->ocr_mask; 1333abfbe5f7SJuha Yrjola 1334abfbe5f7SJuha Yrjola /* Use scatterlist DMA to reduce per-transfer costs. 1335abfbe5f7SJuha Yrjola * NOTE max_seg_size assumption that small blocks aren't 1336abfbe5f7SJuha Yrjola * normally used (except e.g. for reading SD registers). 1337abfbe5f7SJuha Yrjola */ 1338abfbe5f7SJuha Yrjola mmc->max_phys_segs = 32; 1339abfbe5f7SJuha Yrjola mmc->max_hw_segs = 32; 1340abfbe5f7SJuha Yrjola mmc->max_blk_size = 2048; /* BLEN is 11 bits (+1) */ 1341abfbe5f7SJuha Yrjola mmc->max_blk_count = 2048; /* NBLK is 11 bits (+1) */ 1342abfbe5f7SJuha Yrjola mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count; 1343abfbe5f7SJuha Yrjola mmc->max_seg_size = mmc->max_req_size; 1344abfbe5f7SJuha Yrjola 1345abfbe5f7SJuha Yrjola r = mmc_add_host(mmc); 1346abfbe5f7SJuha Yrjola if (r < 0) 1347abfbe5f7SJuha Yrjola goto err_remove_host; 1348abfbe5f7SJuha Yrjola 1349abfbe5f7SJuha Yrjola if (slot->pdata->name != NULL) { 1350abfbe5f7SJuha Yrjola r = device_create_file(&mmc->class_dev, 1351abfbe5f7SJuha Yrjola &dev_attr_slot_name); 1352abfbe5f7SJuha Yrjola if (r < 0) 1353abfbe5f7SJuha Yrjola goto err_remove_host; 1354abfbe5f7SJuha Yrjola } 1355abfbe5f7SJuha Yrjola 13565a0f3f1fSJuha Yrjola if (slot->pdata->get_cover_state != NULL) { 13575a0f3f1fSJuha Yrjola r = device_create_file(&mmc->class_dev, 13585a0f3f1fSJuha Yrjola &dev_attr_cover_switch); 13595a0f3f1fSJuha Yrjola if (r < 0) 13605a0f3f1fSJuha Yrjola goto err_remove_slot_name; 13615a0f3f1fSJuha Yrjola 13627584d276SJarkko Lavinen setup_timer(&slot->cover_timer, mmc_omap_cover_timer, 136301e77e13SCarlos Eduardo Aguiar (unsigned long)slot); 13647584d276SJarkko Lavinen tasklet_init(&slot->cover_tasklet, mmc_omap_cover_handler, 13657584d276SJarkko Lavinen (unsigned long)slot); 13667584d276SJarkko Lavinen tasklet_schedule(&slot->cover_tasklet); 13675a0f3f1fSJuha Yrjola } 13685a0f3f1fSJuha Yrjola 1369abfbe5f7SJuha Yrjola return 0; 1370abfbe5f7SJuha Yrjola 13715a0f3f1fSJuha Yrjola err_remove_slot_name: 13725a0f3f1fSJuha Yrjola if (slot->pdata->name != NULL) 13735a0f3f1fSJuha Yrjola device_remove_file(&mmc->class_dev, &dev_attr_slot_name); 1374abfbe5f7SJuha Yrjola err_remove_host: 1375abfbe5f7SJuha Yrjola mmc_remove_host(mmc); 1376abfbe5f7SJuha Yrjola mmc_free_host(mmc); 1377abfbe5f7SJuha Yrjola return r; 1378abfbe5f7SJuha Yrjola } 1379abfbe5f7SJuha Yrjola 1380abfbe5f7SJuha Yrjola static void mmc_omap_remove_slot(struct mmc_omap_slot *slot) 1381abfbe5f7SJuha Yrjola { 1382abfbe5f7SJuha Yrjola struct mmc_host *mmc = slot->mmc; 1383abfbe5f7SJuha Yrjola 1384abfbe5f7SJuha Yrjola if (slot->pdata->name != NULL) 1385abfbe5f7SJuha Yrjola device_remove_file(&mmc->class_dev, &dev_attr_slot_name); 13865a0f3f1fSJuha Yrjola if (slot->pdata->get_cover_state != NULL) 13875a0f3f1fSJuha Yrjola device_remove_file(&mmc->class_dev, &dev_attr_cover_switch); 13885a0f3f1fSJuha Yrjola 13897584d276SJarkko Lavinen tasklet_kill(&slot->cover_tasklet); 13907584d276SJarkko Lavinen del_timer_sync(&slot->cover_timer); 13915a0f3f1fSJuha Yrjola flush_scheduled_work(); 1392abfbe5f7SJuha Yrjola 1393abfbe5f7SJuha Yrjola mmc_remove_host(mmc); 1394abfbe5f7SJuha Yrjola mmc_free_host(mmc); 1395abfbe5f7SJuha Yrjola } 1396abfbe5f7SJuha Yrjola 13971c6a0718SPierre Ossman static int __init mmc_omap_probe(struct platform_device *pdev) 13981c6a0718SPierre Ossman { 1399abfbe5f7SJuha Yrjola struct omap_mmc_platform_data *pdata = pdev->dev.platform_data; 14001c6a0718SPierre Ossman struct mmc_omap_host *host = NULL; 14011c6a0718SPierre Ossman struct resource *res; 1402abfbe5f7SJuha Yrjola int i, ret = 0; 14031c6a0718SPierre Ossman int irq; 14041c6a0718SPierre Ossman 1405abfbe5f7SJuha Yrjola if (pdata == NULL) { 14061c6a0718SPierre Ossman dev_err(&pdev->dev, "platform data missing\n"); 14071c6a0718SPierre Ossman return -ENXIO; 14081c6a0718SPierre Ossman } 1409abfbe5f7SJuha Yrjola if (pdata->nr_slots == 0) { 1410abfbe5f7SJuha Yrjola dev_err(&pdev->dev, "no slots\n"); 1411abfbe5f7SJuha Yrjola return -ENXIO; 1412abfbe5f7SJuha Yrjola } 14131c6a0718SPierre Ossman 14141c6a0718SPierre Ossman res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 14151c6a0718SPierre Ossman irq = platform_get_irq(pdev, 0); 14161c6a0718SPierre Ossman if (res == NULL || irq < 0) 14171c6a0718SPierre Ossman return -ENXIO; 14181c6a0718SPierre Ossman 14191c6a0718SPierre Ossman res = request_mem_region(res->start, res->end - res->start + 1, 14201c6a0718SPierre Ossman pdev->name); 14211c6a0718SPierre Ossman if (res == NULL) 14221c6a0718SPierre Ossman return -EBUSY; 14231c6a0718SPierre Ossman 1424abfbe5f7SJuha Yrjola host = kzalloc(sizeof(struct mmc_omap_host), GFP_KERNEL); 1425abfbe5f7SJuha Yrjola if (host == NULL) { 14261c6a0718SPierre Ossman ret = -ENOMEM; 14271c6a0718SPierre Ossman goto err_free_mem_region; 14281c6a0718SPierre Ossman } 14291c6a0718SPierre Ossman 14300f602ec7SJarkko Lavinen INIT_WORK(&host->slot_release_work, mmc_omap_slot_release_work); 14310f602ec7SJarkko Lavinen INIT_WORK(&host->send_stop_work, mmc_omap_send_stop_work); 14320f602ec7SJarkko Lavinen 14330fb4723dSJarkko Lavinen INIT_WORK(&host->cmd_abort_work, mmc_omap_abort_command); 14340fb4723dSJarkko Lavinen setup_timer(&host->cmd_abort_timer, mmc_omap_cmd_timer, 14350fb4723dSJarkko Lavinen (unsigned long) host); 1436eb1860bcSJarkko Lavinen 14370807a9b5SJarkko Lavinen spin_lock_init(&host->clk_lock); 14380807a9b5SJarkko Lavinen setup_timer(&host->clk_timer, mmc_omap_clk_timer, (unsigned long) host); 14390807a9b5SJarkko Lavinen 14401c6a0718SPierre Ossman spin_lock_init(&host->dma_lock); 144101e77e13SCarlos Eduardo Aguiar setup_timer(&host->dma_timer, mmc_omap_dma_timer, (unsigned long) host); 1442abfbe5f7SJuha Yrjola spin_lock_init(&host->slot_lock); 1443abfbe5f7SJuha Yrjola init_waitqueue_head(&host->slot_wq); 1444abfbe5f7SJuha Yrjola 1445abfbe5f7SJuha Yrjola host->pdata = pdata; 1446abfbe5f7SJuha Yrjola host->dev = &pdev->dev; 1447abfbe5f7SJuha Yrjola platform_set_drvdata(pdev, host); 1448abfbe5f7SJuha Yrjola 14491c6a0718SPierre Ossman host->id = pdev->id; 14501c6a0718SPierre Ossman host->mem_res = res; 14511c6a0718SPierre Ossman host->irq = irq; 14521c6a0718SPierre Ossman 1453abfbe5f7SJuha Yrjola host->use_dma = 1; 1454*d8874665STony Lindgren host->dev->dma_mask = &pdata->dma_mask; 1455abfbe5f7SJuha Yrjola host->dma_ch = -1; 1456abfbe5f7SJuha Yrjola 1457abfbe5f7SJuha Yrjola host->irq = irq; 1458abfbe5f7SJuha Yrjola host->phys_base = host->mem_res->start; 145955c381e4SRussell King host->virt_base = ioremap(res->start, res->end - res->start + 1); 146055c381e4SRussell King if (!host->virt_base) 146155c381e4SRussell King goto err_ioremap; 1462abfbe5f7SJuha Yrjola 14631c6a0718SPierre Ossman if (cpu_is_omap24xx()) { 14641c6a0718SPierre Ossman host->iclk = clk_get(&pdev->dev, "mmc_ick"); 14651c6a0718SPierre Ossman if (IS_ERR(host->iclk)) 14661c6a0718SPierre Ossman goto err_free_mmc_host; 14671c6a0718SPierre Ossman clk_enable(host->iclk); 14681c6a0718SPierre Ossman } 14691c6a0718SPierre Ossman 14701c6a0718SPierre Ossman if (!cpu_is_omap24xx()) 14711c6a0718SPierre Ossman host->fclk = clk_get(&pdev->dev, "mmc_ck"); 14721c6a0718SPierre Ossman else 14731c6a0718SPierre Ossman host->fclk = clk_get(&pdev->dev, "mmc_fck"); 14741c6a0718SPierre Ossman 14751c6a0718SPierre Ossman if (IS_ERR(host->fclk)) { 14761c6a0718SPierre Ossman ret = PTR_ERR(host->fclk); 14771c6a0718SPierre Ossman goto err_free_iclk; 14781c6a0718SPierre Ossman } 14791c6a0718SPierre Ossman 14801c6a0718SPierre Ossman ret = request_irq(host->irq, mmc_omap_irq, 0, DRIVER_NAME, host); 14811c6a0718SPierre Ossman if (ret) 1482abfbe5f7SJuha Yrjola goto err_free_fclk; 14831c6a0718SPierre Ossman 1484abfbe5f7SJuha Yrjola if (pdata->init != NULL) { 1485abfbe5f7SJuha Yrjola ret = pdata->init(&pdev->dev); 1486abfbe5f7SJuha Yrjola if (ret < 0) 1487abfbe5f7SJuha Yrjola goto err_free_irq; 1488abfbe5f7SJuha Yrjola } 14891c6a0718SPierre Ossman 1490abfbe5f7SJuha Yrjola host->nr_slots = pdata->nr_slots; 1491abfbe5f7SJuha Yrjola for (i = 0; i < pdata->nr_slots; i++) { 1492abfbe5f7SJuha Yrjola ret = mmc_omap_new_slot(host, i); 1493abfbe5f7SJuha Yrjola if (ret < 0) { 1494abfbe5f7SJuha Yrjola while (--i >= 0) 1495abfbe5f7SJuha Yrjola mmc_omap_remove_slot(host->slots[i]); 1496abfbe5f7SJuha Yrjola 1497abfbe5f7SJuha Yrjola goto err_plat_cleanup; 1498abfbe5f7SJuha Yrjola } 1499abfbe5f7SJuha Yrjola } 15001c6a0718SPierre Ossman 15011c6a0718SPierre Ossman return 0; 15021c6a0718SPierre Ossman 1503abfbe5f7SJuha Yrjola err_plat_cleanup: 1504abfbe5f7SJuha Yrjola if (pdata->cleanup) 1505abfbe5f7SJuha Yrjola pdata->cleanup(&pdev->dev); 1506abfbe5f7SJuha Yrjola err_free_irq: 1507abfbe5f7SJuha Yrjola free_irq(host->irq, host); 15081c6a0718SPierre Ossman err_free_fclk: 15091c6a0718SPierre Ossman clk_put(host->fclk); 15101c6a0718SPierre Ossman err_free_iclk: 15111c6a0718SPierre Ossman if (host->iclk != NULL) { 15121c6a0718SPierre Ossman clk_disable(host->iclk); 15131c6a0718SPierre Ossman clk_put(host->iclk); 15141c6a0718SPierre Ossman } 15151c6a0718SPierre Ossman err_free_mmc_host: 151655c381e4SRussell King iounmap(host->virt_base); 151755c381e4SRussell King err_ioremap: 1518abfbe5f7SJuha Yrjola kfree(host); 15191c6a0718SPierre Ossman err_free_mem_region: 15201c6a0718SPierre Ossman release_mem_region(res->start, res->end - res->start + 1); 15211c6a0718SPierre Ossman return ret; 15221c6a0718SPierre Ossman } 15231c6a0718SPierre Ossman 15241c6a0718SPierre Ossman static int mmc_omap_remove(struct platform_device *pdev) 15251c6a0718SPierre Ossman { 15261c6a0718SPierre Ossman struct mmc_omap_host *host = platform_get_drvdata(pdev); 1527abfbe5f7SJuha Yrjola int i; 15281c6a0718SPierre Ossman 15291c6a0718SPierre Ossman platform_set_drvdata(pdev, NULL); 15301c6a0718SPierre Ossman 15311c6a0718SPierre Ossman BUG_ON(host == NULL); 15321c6a0718SPierre Ossman 1533abfbe5f7SJuha Yrjola for (i = 0; i < host->nr_slots; i++) 1534abfbe5f7SJuha Yrjola mmc_omap_remove_slot(host->slots[i]); 15351c6a0718SPierre Ossman 1536abfbe5f7SJuha Yrjola if (host->pdata->cleanup) 1537abfbe5f7SJuha Yrjola host->pdata->cleanup(&pdev->dev); 1538abfbe5f7SJuha Yrjola 15391c6a0718SPierre Ossman if (host->iclk && !IS_ERR(host->iclk)) 15401c6a0718SPierre Ossman clk_put(host->iclk); 15411c6a0718SPierre Ossman if (host->fclk && !IS_ERR(host->fclk)) 15421c6a0718SPierre Ossman clk_put(host->fclk); 15431c6a0718SPierre Ossman 154455c381e4SRussell King iounmap(host->virt_base); 15451c6a0718SPierre Ossman release_mem_region(pdev->resource[0].start, 15461c6a0718SPierre Ossman pdev->resource[0].end - pdev->resource[0].start + 1); 15471c6a0718SPierre Ossman 1548abfbe5f7SJuha Yrjola kfree(host); 15491c6a0718SPierre Ossman 15501c6a0718SPierre Ossman return 0; 15511c6a0718SPierre Ossman } 15521c6a0718SPierre Ossman 15531c6a0718SPierre Ossman #ifdef CONFIG_PM 15541c6a0718SPierre Ossman static int mmc_omap_suspend(struct platform_device *pdev, pm_message_t mesg) 15551c6a0718SPierre Ossman { 1556abfbe5f7SJuha Yrjola int i, ret = 0; 15571c6a0718SPierre Ossman struct mmc_omap_host *host = platform_get_drvdata(pdev); 15581c6a0718SPierre Ossman 1559abfbe5f7SJuha Yrjola if (host == NULL || host->suspended) 15601c6a0718SPierre Ossman return 0; 15611c6a0718SPierre Ossman 1562abfbe5f7SJuha Yrjola for (i = 0; i < host->nr_slots; i++) { 1563abfbe5f7SJuha Yrjola struct mmc_omap_slot *slot; 1564abfbe5f7SJuha Yrjola 1565abfbe5f7SJuha Yrjola slot = host->slots[i]; 1566abfbe5f7SJuha Yrjola ret = mmc_suspend_host(slot->mmc, mesg); 1567abfbe5f7SJuha Yrjola if (ret < 0) { 1568abfbe5f7SJuha Yrjola while (--i >= 0) { 1569abfbe5f7SJuha Yrjola slot = host->slots[i]; 1570abfbe5f7SJuha Yrjola mmc_resume_host(slot->mmc); 15711c6a0718SPierre Ossman } 15721c6a0718SPierre Ossman return ret; 15731c6a0718SPierre Ossman } 1574abfbe5f7SJuha Yrjola } 1575abfbe5f7SJuha Yrjola host->suspended = 1; 1576abfbe5f7SJuha Yrjola return 0; 1577abfbe5f7SJuha Yrjola } 15781c6a0718SPierre Ossman 15791c6a0718SPierre Ossman static int mmc_omap_resume(struct platform_device *pdev) 15801c6a0718SPierre Ossman { 1581abfbe5f7SJuha Yrjola int i, ret = 0; 15821c6a0718SPierre Ossman struct mmc_omap_host *host = platform_get_drvdata(pdev); 15831c6a0718SPierre Ossman 1584abfbe5f7SJuha Yrjola if (host == NULL || !host->suspended) 15851c6a0718SPierre Ossman return 0; 15861c6a0718SPierre Ossman 1587abfbe5f7SJuha Yrjola for (i = 0; i < host->nr_slots; i++) { 1588abfbe5f7SJuha Yrjola struct mmc_omap_slot *slot; 1589abfbe5f7SJuha Yrjola slot = host->slots[i]; 1590abfbe5f7SJuha Yrjola ret = mmc_resume_host(slot->mmc); 1591abfbe5f7SJuha Yrjola if (ret < 0) 1592abfbe5f7SJuha Yrjola return ret; 1593abfbe5f7SJuha Yrjola 15941c6a0718SPierre Ossman host->suspended = 0; 15951c6a0718SPierre Ossman } 1596abfbe5f7SJuha Yrjola return 0; 15971c6a0718SPierre Ossman } 15981c6a0718SPierre Ossman #else 15991c6a0718SPierre Ossman #define mmc_omap_suspend NULL 16001c6a0718SPierre Ossman #define mmc_omap_resume NULL 16011c6a0718SPierre Ossman #endif 16021c6a0718SPierre Ossman 16031c6a0718SPierre Ossman static struct platform_driver mmc_omap_driver = { 16041c6a0718SPierre Ossman .probe = mmc_omap_probe, 16051c6a0718SPierre Ossman .remove = mmc_omap_remove, 16061c6a0718SPierre Ossman .suspend = mmc_omap_suspend, 16071c6a0718SPierre Ossman .resume = mmc_omap_resume, 16081c6a0718SPierre Ossman .driver = { 16091c6a0718SPierre Ossman .name = DRIVER_NAME, 1610bc65c724SKay Sievers .owner = THIS_MODULE, 16111c6a0718SPierre Ossman }, 16121c6a0718SPierre Ossman }; 16131c6a0718SPierre Ossman 16141c6a0718SPierre Ossman static int __init mmc_omap_init(void) 16151c6a0718SPierre Ossman { 16161c6a0718SPierre Ossman return platform_driver_register(&mmc_omap_driver); 16171c6a0718SPierre Ossman } 16181c6a0718SPierre Ossman 16191c6a0718SPierre Ossman static void __exit mmc_omap_exit(void) 16201c6a0718SPierre Ossman { 16211c6a0718SPierre Ossman platform_driver_unregister(&mmc_omap_driver); 16221c6a0718SPierre Ossman } 16231c6a0718SPierre Ossman 16241c6a0718SPierre Ossman module_init(mmc_omap_init); 16251c6a0718SPierre Ossman module_exit(mmc_omap_exit); 16261c6a0718SPierre Ossman 16271c6a0718SPierre Ossman MODULE_DESCRIPTION("OMAP Multimedia Card driver"); 16281c6a0718SPierre Ossman MODULE_LICENSE("GPL"); 1629bc65c724SKay Sievers MODULE_ALIAS("platform:" DRIVER_NAME); 16301c6a0718SPierre Ossman MODULE_AUTHOR("Juha Yrj�l�"); 1631