Merge branch 'upstream-fixes'
[linux-2.6] / drivers / mmc / mmci.c
1 /*
2  *  linux/drivers/mmc/mmci.c - ARM PrimeCell MMCI PL180/1 driver
3  *
4  *  Copyright (C) 2003 Deep Blue Solutions, Ltd, All Rights Reserved.
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  */
10 #include <linux/config.h>
11 #include <linux/module.h>
12 #include <linux/moduleparam.h>
13 #include <linux/init.h>
14 #include <linux/ioport.h>
15 #include <linux/device.h>
16 #include <linux/interrupt.h>
17 #include <linux/delay.h>
18 #include <linux/err.h>
19 #include <linux/highmem.h>
20 #include <linux/mmc/host.h>
21 #include <linux/mmc/protocol.h>
22
23 #include <asm/div64.h>
24 #include <asm/io.h>
25 #include <asm/scatterlist.h>
26 #include <asm/sizes.h>
27 #include <asm/hardware/amba.h>
28 #include <asm/hardware/clock.h>
29 #include <asm/mach/mmc.h>
30
31 #include "mmci.h"
32
33 #define DRIVER_NAME "mmci-pl18x"
34
35 #ifdef CONFIG_MMC_DEBUG
36 #define DBG(host,fmt,args...)   \
37         pr_debug("%s: %s: " fmt, mmc_hostname(host->mmc), __func__ , args)
38 #else
39 #define DBG(host,fmt,args...)   do { } while (0)
40 #endif
41
42 static unsigned int fmax = 515633;
43
44 static void
45 mmci_request_end(struct mmci_host *host, struct mmc_request *mrq)
46 {
47         writel(0, host->base + MMCICOMMAND);
48
49         host->mrq = NULL;
50         host->cmd = NULL;
51
52         if (mrq->data)
53                 mrq->data->bytes_xfered = host->data_xfered;
54
55         /*
56          * Need to drop the host lock here; mmc_request_done may call
57          * back into the driver...
58          */
59         spin_unlock(&host->lock);
60         mmc_request_done(host->mmc, mrq);
61         spin_lock(&host->lock);
62 }
63
64 static void mmci_stop_data(struct mmci_host *host)
65 {
66         writel(0, host->base + MMCIDATACTRL);
67         writel(0, host->base + MMCIMASK1);
68         host->data = NULL;
69 }
70
71 static void mmci_start_data(struct mmci_host *host, struct mmc_data *data)
72 {
73         unsigned int datactrl, timeout, irqmask;
74         unsigned long long clks;
75         void __iomem *base;
76
77         DBG(host, "blksz %04x blks %04x flags %08x\n",
78             1 << data->blksz_bits, data->blocks, data->flags);
79
80         host->data = data;
81         host->size = data->blocks << data->blksz_bits;
82         host->data_xfered = 0;
83
84         mmci_init_sg(host, data);
85
86         clks = (unsigned long long)data->timeout_ns * host->cclk;
87         do_div(clks, 1000000000UL);
88
89         timeout = data->timeout_clks + (unsigned int)clks;
90
91         base = host->base;
92         writel(timeout, base + MMCIDATATIMER);
93         writel(host->size, base + MMCIDATALENGTH);
94
95         datactrl = MCI_DPSM_ENABLE | data->blksz_bits << 4;
96         if (data->flags & MMC_DATA_READ) {
97                 datactrl |= MCI_DPSM_DIRECTION;
98                 irqmask = MCI_RXFIFOHALFFULLMASK;
99         } else {
100                 /*
101                  * We don't actually need to include "FIFO empty" here
102                  * since its implicit in "FIFO half empty".
103                  */
104                 irqmask = MCI_TXFIFOHALFEMPTYMASK;
105         }
106
107         writel(datactrl, base + MMCIDATACTRL);
108         writel(readl(base + MMCIMASK0) & ~MCI_DATAENDMASK, base + MMCIMASK0);
109         writel(irqmask, base + MMCIMASK1);
110 }
111
112 static void
113 mmci_start_command(struct mmci_host *host, struct mmc_command *cmd, u32 c)
114 {
115         void __iomem *base = host->base;
116
117         DBG(host, "op %02x arg %08x flags %08x\n",
118             cmd->opcode, cmd->arg, cmd->flags);
119
120         if (readl(base + MMCICOMMAND) & MCI_CPSM_ENABLE) {
121                 writel(0, base + MMCICOMMAND);
122                 udelay(1);
123         }
124
125         c |= cmd->opcode | MCI_CPSM_ENABLE;
126         switch (cmd->flags & MMC_RSP_MASK) {
127         case MMC_RSP_NONE:
128         default:
129                 break;
130         case MMC_RSP_LONG:
131                 c |= MCI_CPSM_LONGRSP;
132         case MMC_RSP_SHORT:
133                 c |= MCI_CPSM_RESPONSE;
134                 break;
135         }
136         if (/*interrupt*/0)
137                 c |= MCI_CPSM_INTERRUPT;
138
139         host->cmd = cmd;
140
141         writel(cmd->arg, base + MMCIARGUMENT);
142         writel(c, base + MMCICOMMAND);
143 }
144
145 static void
146 mmci_data_irq(struct mmci_host *host, struct mmc_data *data,
147               unsigned int status)
148 {
149         if (status & MCI_DATABLOCKEND) {
150                 host->data_xfered += 1 << data->blksz_bits;
151         }
152         if (status & (MCI_DATACRCFAIL|MCI_DATATIMEOUT|MCI_TXUNDERRUN|MCI_RXOVERRUN)) {
153                 if (status & MCI_DATACRCFAIL)
154                         data->error = MMC_ERR_BADCRC;
155                 else if (status & MCI_DATATIMEOUT)
156                         data->error = MMC_ERR_TIMEOUT;
157                 else if (status & (MCI_TXUNDERRUN|MCI_RXOVERRUN))
158                         data->error = MMC_ERR_FIFO;
159                 status |= MCI_DATAEND;
160         }
161         if (status & MCI_DATAEND) {
162                 mmci_stop_data(host);
163
164                 if (!data->stop) {
165                         mmci_request_end(host, data->mrq);
166                 } else {
167                         mmci_start_command(host, data->stop, 0);
168                 }
169         }
170 }
171
172 static void
173 mmci_cmd_irq(struct mmci_host *host, struct mmc_command *cmd,
174              unsigned int status)
175 {
176         void __iomem *base = host->base;
177
178         host->cmd = NULL;
179
180         cmd->resp[0] = readl(base + MMCIRESPONSE0);
181         cmd->resp[1] = readl(base + MMCIRESPONSE1);
182         cmd->resp[2] = readl(base + MMCIRESPONSE2);
183         cmd->resp[3] = readl(base + MMCIRESPONSE3);
184
185         if (status & MCI_CMDTIMEOUT) {
186                 cmd->error = MMC_ERR_TIMEOUT;
187         } else if (status & MCI_CMDCRCFAIL && cmd->flags & MMC_RSP_CRC) {
188                 cmd->error = MMC_ERR_BADCRC;
189         }
190
191         if (!cmd->data || cmd->error != MMC_ERR_NONE) {
192                 mmci_request_end(host, cmd->mrq);
193         } else if (!(cmd->data->flags & MMC_DATA_READ)) {
194                 mmci_start_data(host, cmd->data);
195         }
196 }
197
198 static int mmci_pio_read(struct mmci_host *host, char *buffer, unsigned int remain)
199 {
200         void __iomem *base = host->base;
201         char *ptr = buffer;
202         u32 status;
203
204         do {
205                 int count = host->size - (readl(base + MMCIFIFOCNT) << 2);
206
207                 if (count > remain)
208                         count = remain;
209
210                 if (count <= 0)
211                         break;
212
213                 readsl(base + MMCIFIFO, ptr, count >> 2);
214
215                 ptr += count;
216                 remain -= count;
217
218                 if (remain == 0)
219                         break;
220
221                 status = readl(base + MMCISTATUS);
222         } while (status & MCI_RXDATAAVLBL);
223
224         return ptr - buffer;
225 }
226
227 static int mmci_pio_write(struct mmci_host *host, char *buffer, unsigned int remain, u32 status)
228 {
229         void __iomem *base = host->base;
230         char *ptr = buffer;
231
232         do {
233                 unsigned int count, maxcnt;
234
235                 maxcnt = status & MCI_TXFIFOEMPTY ? MCI_FIFOSIZE : MCI_FIFOHALFSIZE;
236                 count = min(remain, maxcnt);
237
238                 writesl(base + MMCIFIFO, ptr, count >> 2);
239
240                 ptr += count;
241                 remain -= count;
242
243                 if (remain == 0)
244                         break;
245
246                 status = readl(base + MMCISTATUS);
247         } while (status & MCI_TXFIFOHALFEMPTY);
248
249         return ptr - buffer;
250 }
251
252 /*
253  * PIO data transfer IRQ handler.
254  */
255 static irqreturn_t mmci_pio_irq(int irq, void *dev_id, struct pt_regs *regs)
256 {
257         struct mmci_host *host = dev_id;
258         void __iomem *base = host->base;
259         u32 status;
260
261         status = readl(base + MMCISTATUS);
262
263         DBG(host, "irq1 %08x\n", status);
264
265         do {
266                 unsigned long flags;
267                 unsigned int remain, len;
268                 char *buffer;
269
270                 /*
271                  * For write, we only need to test the half-empty flag
272                  * here - if the FIFO is completely empty, then by
273                  * definition it is more than half empty.
274                  *
275                  * For read, check for data available.
276                  */
277                 if (!(status & (MCI_TXFIFOHALFEMPTY|MCI_RXDATAAVLBL)))
278                         break;
279
280                 /*
281                  * Map the current scatter buffer.
282                  */
283                 buffer = mmci_kmap_atomic(host, &flags) + host->sg_off;
284                 remain = host->sg_ptr->length - host->sg_off;
285
286                 len = 0;
287                 if (status & MCI_RXACTIVE)
288                         len = mmci_pio_read(host, buffer, remain);
289                 if (status & MCI_TXACTIVE)
290                         len = mmci_pio_write(host, buffer, remain, status);
291
292                 /*
293                  * Unmap the buffer.
294                  */
295                 mmci_kunmap_atomic(host, &flags);
296
297                 host->sg_off += len;
298                 host->size -= len;
299                 remain -= len;
300
301                 if (remain)
302                         break;
303
304                 if (!mmci_next_sg(host))
305                         break;
306
307                 status = readl(base + MMCISTATUS);
308         } while (1);
309
310         /*
311          * If we're nearing the end of the read, switch to
312          * "any data available" mode.
313          */
314         if (status & MCI_RXACTIVE && host->size < MCI_FIFOSIZE)
315                 writel(MCI_RXDATAAVLBLMASK, base + MMCIMASK1);
316
317         /*
318          * If we run out of data, disable the data IRQs; this
319          * prevents a race where the FIFO becomes empty before
320          * the chip itself has disabled the data path, and
321          * stops us racing with our data end IRQ.
322          */
323         if (host->size == 0) {
324                 writel(0, base + MMCIMASK1);
325                 writel(readl(base + MMCIMASK0) | MCI_DATAENDMASK, base + MMCIMASK0);
326         }
327
328         return IRQ_HANDLED;
329 }
330
331 /*
332  * Handle completion of command and data transfers.
333  */
334 static irqreturn_t mmci_irq(int irq, void *dev_id, struct pt_regs *regs)
335 {
336         struct mmci_host *host = dev_id;
337         u32 status;
338         int ret = 0;
339
340         spin_lock(&host->lock);
341
342         do {
343                 struct mmc_command *cmd;
344                 struct mmc_data *data;
345
346                 status = readl(host->base + MMCISTATUS);
347                 status &= readl(host->base + MMCIMASK0);
348                 writel(status, host->base + MMCICLEAR);
349
350                 DBG(host, "irq0 %08x\n", status);
351
352                 data = host->data;
353                 if (status & (MCI_DATACRCFAIL|MCI_DATATIMEOUT|MCI_TXUNDERRUN|
354                               MCI_RXOVERRUN|MCI_DATAEND|MCI_DATABLOCKEND) && data)
355                         mmci_data_irq(host, data, status);
356
357                 cmd = host->cmd;
358                 if (status & (MCI_CMDCRCFAIL|MCI_CMDTIMEOUT|MCI_CMDSENT|MCI_CMDRESPEND) && cmd)
359                         mmci_cmd_irq(host, cmd, status);
360
361                 ret = 1;
362         } while (status);
363
364         spin_unlock(&host->lock);
365
366         return IRQ_RETVAL(ret);
367 }
368
369 static void mmci_request(struct mmc_host *mmc, struct mmc_request *mrq)
370 {
371         struct mmci_host *host = mmc_priv(mmc);
372
373         WARN_ON(host->mrq != NULL);
374
375         spin_lock_irq(&host->lock);
376
377         host->mrq = mrq;
378
379         if (mrq->data && mrq->data->flags & MMC_DATA_READ)
380                 mmci_start_data(host, mrq->data);
381
382         mmci_start_command(host, mrq->cmd, 0);
383
384         spin_unlock_irq(&host->lock);
385 }
386
387 static void mmci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
388 {
389         struct mmci_host *host = mmc_priv(mmc);
390         u32 clk = 0, pwr = 0;
391
392         DBG(host, "clock %uHz busmode %u powermode %u Vdd %u\n",
393             ios->clock, ios->bus_mode, ios->power_mode, ios->vdd);
394
395         if (ios->clock) {
396                 if (ios->clock >= host->mclk) {
397                         clk = MCI_CLK_BYPASS;
398                         host->cclk = host->mclk;
399                 } else {
400                         clk = host->mclk / (2 * ios->clock) - 1;
401                         if (clk > 256)
402                                 clk = 255;
403                         host->cclk = host->mclk / (2 * (clk + 1));
404                 }
405                 clk |= MCI_CLK_ENABLE;
406         }
407
408         if (host->plat->translate_vdd)
409                 pwr |= host->plat->translate_vdd(mmc_dev(mmc), ios->vdd);
410
411         switch (ios->power_mode) {
412         case MMC_POWER_OFF:
413                 break;
414         case MMC_POWER_UP:
415                 pwr |= MCI_PWR_UP;
416                 break;
417         case MMC_POWER_ON:
418                 pwr |= MCI_PWR_ON;
419                 break;
420         }
421
422         if (ios->bus_mode == MMC_BUSMODE_OPENDRAIN)
423                 pwr |= MCI_ROD;
424
425         writel(clk, host->base + MMCICLOCK);
426
427         if (host->pwr != pwr) {
428                 host->pwr = pwr;
429                 writel(pwr, host->base + MMCIPOWER);
430         }
431 }
432
433 static struct mmc_host_ops mmci_ops = {
434         .request        = mmci_request,
435         .set_ios        = mmci_set_ios,
436 };
437
438 static void mmci_check_status(unsigned long data)
439 {
440         struct mmci_host *host = (struct mmci_host *)data;
441         unsigned int status;
442
443         status = host->plat->status(mmc_dev(host->mmc));
444         if (status ^ host->oldstat)
445                 mmc_detect_change(host->mmc, 0);
446
447         host->oldstat = status;
448         mod_timer(&host->timer, jiffies + HZ);
449 }
450
451 static int mmci_probe(struct amba_device *dev, void *id)
452 {
453         struct mmc_platform_data *plat = dev->dev.platform_data;
454         struct mmci_host *host;
455         struct mmc_host *mmc;
456         int ret;
457
458         /* must have platform data */
459         if (!plat) {
460                 ret = -EINVAL;
461                 goto out;
462         }
463
464         ret = amba_request_regions(dev, DRIVER_NAME);
465         if (ret)
466                 goto out;
467
468         mmc = mmc_alloc_host(sizeof(struct mmci_host), &dev->dev);
469         if (!mmc) {
470                 ret = -ENOMEM;
471                 goto rel_regions;
472         }
473
474         host = mmc_priv(mmc);
475         host->clk = clk_get(&dev->dev, "MCLK");
476         if (IS_ERR(host->clk)) {
477                 ret = PTR_ERR(host->clk);
478                 host->clk = NULL;
479                 goto host_free;
480         }
481
482         ret = clk_use(host->clk);
483         if (ret)
484                 goto clk_free;
485
486         ret = clk_enable(host->clk);
487         if (ret)
488                 goto clk_unuse;
489
490         host->plat = plat;
491         host->mclk = clk_get_rate(host->clk);
492         host->mmc = mmc;
493         host->base = ioremap(dev->res.start, SZ_4K);
494         if (!host->base) {
495                 ret = -ENOMEM;
496                 goto clk_disable;
497         }
498
499         mmc->ops = &mmci_ops;
500         mmc->f_min = (host->mclk + 511) / 512;
501         mmc->f_max = min(host->mclk, fmax);
502         mmc->ocr_avail = plat->ocr_mask;
503
504         /*
505          * We can do SGIO
506          */
507         mmc->max_hw_segs = 16;
508         mmc->max_phys_segs = NR_SG;
509
510         /*
511          * Since we only have a 16-bit data length register, we must
512          * ensure that we don't exceed 2^16-1 bytes in a single request.
513          * Choose 64 (512-byte) sectors as the limit.
514          */
515         mmc->max_sectors = 64;
516
517         /*
518          * Set the maximum segment size.  Since we aren't doing DMA
519          * (yet) we are only limited by the data length register.
520          */
521         mmc->max_seg_size = mmc->max_sectors << 9;
522
523         spin_lock_init(&host->lock);
524
525         writel(0, host->base + MMCIMASK0);
526         writel(0, host->base + MMCIMASK1);
527         writel(0xfff, host->base + MMCICLEAR);
528
529         ret = request_irq(dev->irq[0], mmci_irq, SA_SHIRQ, DRIVER_NAME " (cmd)", host);
530         if (ret)
531                 goto unmap;
532
533         ret = request_irq(dev->irq[1], mmci_pio_irq, SA_SHIRQ, DRIVER_NAME " (pio)", host);
534         if (ret)
535                 goto irq0_free;
536
537         writel(MCI_IRQENABLE, host->base + MMCIMASK0);
538
539         amba_set_drvdata(dev, mmc);
540
541         mmc_add_host(mmc);
542
543         printk(KERN_INFO "%s: MMCI rev %x cfg %02x at 0x%08lx irq %d,%d\n",
544                 mmc_hostname(mmc), amba_rev(dev), amba_config(dev),
545                 dev->res.start, dev->irq[0], dev->irq[1]);
546
547         init_timer(&host->timer);
548         host->timer.data = (unsigned long)host;
549         host->timer.function = mmci_check_status;
550         host->timer.expires = jiffies + HZ;
551         add_timer(&host->timer);
552
553         return 0;
554
555  irq0_free:
556         free_irq(dev->irq[0], host);
557  unmap:
558         iounmap(host->base);
559  clk_disable:
560         clk_disable(host->clk);
561  clk_unuse:
562         clk_unuse(host->clk);
563  clk_free:
564         clk_put(host->clk);
565  host_free:
566         mmc_free_host(mmc);
567  rel_regions:
568         amba_release_regions(dev);
569  out:
570         return ret;
571 }
572
573 static int mmci_remove(struct amba_device *dev)
574 {
575         struct mmc_host *mmc = amba_get_drvdata(dev);
576
577         amba_set_drvdata(dev, NULL);
578
579         if (mmc) {
580                 struct mmci_host *host = mmc_priv(mmc);
581
582                 del_timer_sync(&host->timer);
583
584                 mmc_remove_host(mmc);
585
586                 writel(0, host->base + MMCIMASK0);
587                 writel(0, host->base + MMCIMASK1);
588
589                 writel(0, host->base + MMCICOMMAND);
590                 writel(0, host->base + MMCIDATACTRL);
591
592                 free_irq(dev->irq[0], host);
593                 free_irq(dev->irq[1], host);
594
595                 iounmap(host->base);
596                 clk_disable(host->clk);
597                 clk_unuse(host->clk);
598                 clk_put(host->clk);
599
600                 mmc_free_host(mmc);
601
602                 amba_release_regions(dev);
603         }
604
605         return 0;
606 }
607
608 #ifdef CONFIG_PM
609 static int mmci_suspend(struct amba_device *dev, pm_message_t state)
610 {
611         struct mmc_host *mmc = amba_get_drvdata(dev);
612         int ret = 0;
613
614         if (mmc) {
615                 struct mmci_host *host = mmc_priv(mmc);
616
617                 ret = mmc_suspend_host(mmc, state);
618                 if (ret == 0)
619                         writel(0, host->base + MMCIMASK0);
620         }
621
622         return ret;
623 }
624
625 static int mmci_resume(struct amba_device *dev)
626 {
627         struct mmc_host *mmc = amba_get_drvdata(dev);
628         int ret = 0;
629
630         if (mmc) {
631                 struct mmci_host *host = mmc_priv(mmc);
632
633                 writel(MCI_IRQENABLE, host->base + MMCIMASK0);
634
635                 ret = mmc_resume_host(mmc);
636         }
637
638         return ret;
639 }
640 #else
641 #define mmci_suspend    NULL
642 #define mmci_resume     NULL
643 #endif
644
645 static struct amba_id mmci_ids[] = {
646         {
647                 .id     = 0x00041180,
648                 .mask   = 0x000fffff,
649         },
650         {
651                 .id     = 0x00041181,
652                 .mask   = 0x000fffff,
653         },
654         { 0, 0 },
655 };
656
657 static struct amba_driver mmci_driver = {
658         .drv            = {
659                 .name   = DRIVER_NAME,
660         },
661         .probe          = mmci_probe,
662         .remove         = mmci_remove,
663         .suspend        = mmci_suspend,
664         .resume         = mmci_resume,
665         .id_table       = mmci_ids,
666 };
667
668 static int __init mmci_init(void)
669 {
670         return amba_driver_register(&mmci_driver);
671 }
672
673 static void __exit mmci_exit(void)
674 {
675         amba_driver_unregister(&mmci_driver);
676 }
677
678 module_init(mmci_init);
679 module_exit(mmci_exit);
680 module_param(fmax, uint, 0444);
681
682 MODULE_DESCRIPTION("ARM PrimeCell PL180/181 Multimedia Card Interface driver");
683 MODULE_LICENSE("GPL");