Merge branch 'master' of master.kernel.org:/pub/scm/linux/kernel/git/davem/net-2.6
[linux-2.6] / drivers / mmc / host / at91_mci.c
1 /*
2  *  linux/drivers/mmc/host/at91_mci.c - ATMEL AT91 MCI Driver
3  *
4  *  Copyright (C) 2005 Cougar Creek Computing Devices Ltd, All Rights Reserved
5  *
6  *  Copyright (C) 2006 Malcolm Noyes
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  */
12
13 /*
14    This is the AT91 MCI driver that has been tested with both MMC cards
15    and SD-cards.  Boards that support write protect are now supported.
16    The CCAT91SBC001 board does not support SD cards.
17
18    The three entry points are at91_mci_request, at91_mci_set_ios
19    and at91_mci_get_ro.
20
21    SET IOS
22      This configures the device to put it into the correct mode and clock speed
23      required.
24
25    MCI REQUEST
26      MCI request processes the commands sent in the mmc_request structure. This
27      can consist of a processing command and a stop command in the case of
28      multiple block transfers.
29
30      There are three main types of request, commands, reads and writes.
31
32      Commands are straight forward. The command is submitted to the controller and
33      the request function returns. When the controller generates an interrupt to indicate
34      the command is finished, the response to the command are read and the mmc_request_done
35      function called to end the request.
36
37      Reads and writes work in a similar manner to normal commands but involve the PDC (DMA)
38      controller to manage the transfers.
39
40      A read is done from the controller directly to the scatterlist passed in from the request.
41      Due to a bug in the AT91RM9200 controller, when a read is completed, all the words are byte
42      swapped in the scatterlist buffers.  AT91SAM926x are not affected by this bug.
43
44      The sequence of read interrupts is: ENDRX, RXBUFF, CMDRDY
45
46      A write is slightly different in that the bytes to write are read from the scatterlist
47      into a dma memory buffer (this is in case the source buffer should be read only). The
48      entire write buffer is then done from this single dma memory buffer.
49
50      The sequence of write interrupts is: ENDTX, TXBUFE, NOTBUSY, CMDRDY
51
52    GET RO
53      Gets the status of the write protect pin, if available.
54 */
55
56 #include <linux/module.h>
57 #include <linux/moduleparam.h>
58 #include <linux/init.h>
59 #include <linux/ioport.h>
60 #include <linux/platform_device.h>
61 #include <linux/interrupt.h>
62 #include <linux/blkdev.h>
63 #include <linux/delay.h>
64 #include <linux/err.h>
65 #include <linux/dma-mapping.h>
66 #include <linux/clk.h>
67 #include <linux/atmel_pdc.h>
68
69 #include <linux/mmc/host.h>
70
71 #include <asm/io.h>
72 #include <asm/irq.h>
73 #include <asm/gpio.h>
74
75 #include <asm/mach/mmc.h>
76 #include <asm/arch/board.h>
77 #include <asm/arch/cpu.h>
78 #include <asm/arch/at91_mci.h>
79
80 #define DRIVER_NAME "at91_mci"
81
82 #define FL_SENT_COMMAND (1 << 0)
83 #define FL_SENT_STOP    (1 << 1)
84
85 #define AT91_MCI_ERRORS (AT91_MCI_RINDE | AT91_MCI_RDIRE | AT91_MCI_RCRCE       \
86                 | AT91_MCI_RENDE | AT91_MCI_RTOE | AT91_MCI_DCRCE               \
87                 | AT91_MCI_DTOE | AT91_MCI_OVRE | AT91_MCI_UNRE)
88
89 #define at91_mci_read(host, reg)        __raw_readl((host)->baseaddr + (reg))
90 #define at91_mci_write(host, reg, val)  __raw_writel((val), (host)->baseaddr + (reg))
91
92
93 /*
94  * Low level type for this driver
95  */
96 struct at91mci_host
97 {
98         struct mmc_host *mmc;
99         struct mmc_command *cmd;
100         struct mmc_request *request;
101
102         void __iomem *baseaddr;
103         int irq;
104
105         struct at91_mmc_data *board;
106         int present;
107
108         struct clk *mci_clk;
109
110         /*
111          * Flag indicating when the command has been sent. This is used to
112          * work out whether or not to send the stop
113          */
114         unsigned int flags;
115         /* flag for current bus settings */
116         u32 bus_mode;
117
118         /* DMA buffer used for transmitting */
119         unsigned int* buffer;
120         dma_addr_t physical_address;
121         unsigned int total_length;
122
123         /* Latest in the scatterlist that has been enabled for transfer, but not freed */
124         int in_use_index;
125
126         /* Latest in the scatterlist that has been enabled for transfer */
127         int transfer_index;
128 };
129
130 /*
131  * Copy from sg to a dma block - used for transfers
132  */
133 static inline void at91_mci_sg_to_dma(struct at91mci_host *host, struct mmc_data *data)
134 {
135         unsigned int len, i, size;
136         unsigned *dmabuf = host->buffer;
137
138         size = host->total_length;
139         len = data->sg_len;
140
141         /*
142          * Just loop through all entries. Size might not
143          * be the entire list though so make sure that
144          * we do not transfer too much.
145          */
146         for (i = 0; i < len; i++) {
147                 struct scatterlist *sg;
148                 int amount;
149                 unsigned int *sgbuffer;
150
151                 sg = &data->sg[i];
152
153                 sgbuffer = kmap_atomic(sg_page(sg), KM_BIO_SRC_IRQ) + sg->offset;
154                 amount = min(size, sg->length);
155                 size -= amount;
156
157                 if (cpu_is_at91rm9200()) {      /* AT91RM9200 errata */
158                         int index;
159
160                         for (index = 0; index < (amount / 4); index++)
161                                 *dmabuf++ = swab32(sgbuffer[index]);
162                 }
163                 else
164                         memcpy(dmabuf, sgbuffer, amount);
165
166                 kunmap_atomic(sgbuffer, KM_BIO_SRC_IRQ);
167
168                 if (size == 0)
169                         break;
170         }
171
172         /*
173          * Check that we didn't get a request to transfer
174          * more data than can fit into the SG list.
175          */
176         BUG_ON(size != 0);
177 }
178
179 /*
180  * Prepare a dma read
181  */
182 static void at91_mci_pre_dma_read(struct at91mci_host *host)
183 {
184         int i;
185         struct scatterlist *sg;
186         struct mmc_command *cmd;
187         struct mmc_data *data;
188
189         pr_debug("pre dma read\n");
190
191         cmd = host->cmd;
192         if (!cmd) {
193                 pr_debug("no command\n");
194                 return;
195         }
196
197         data = cmd->data;
198         if (!data) {
199                 pr_debug("no data\n");
200                 return;
201         }
202
203         for (i = 0; i < 2; i++) {
204                 /* nothing left to transfer */
205                 if (host->transfer_index >= data->sg_len) {
206                         pr_debug("Nothing left to transfer (index = %d)\n", host->transfer_index);
207                         break;
208                 }
209
210                 /* Check to see if this needs filling */
211                 if (i == 0) {
212                         if (at91_mci_read(host, ATMEL_PDC_RCR) != 0) {
213                                 pr_debug("Transfer active in current\n");
214                                 continue;
215                         }
216                 }
217                 else {
218                         if (at91_mci_read(host, ATMEL_PDC_RNCR) != 0) {
219                                 pr_debug("Transfer active in next\n");
220                                 continue;
221                         }
222                 }
223
224                 /* Setup the next transfer */
225                 pr_debug("Using transfer index %d\n", host->transfer_index);
226
227                 sg = &data->sg[host->transfer_index++];
228                 pr_debug("sg = %p\n", sg);
229
230                 sg->dma_address = dma_map_page(NULL, sg_page(sg), sg->offset, sg->length, DMA_FROM_DEVICE);
231
232                 pr_debug("dma address = %08X, length = %d\n", sg->dma_address, sg->length);
233
234                 if (i == 0) {
235                         at91_mci_write(host, ATMEL_PDC_RPR, sg->dma_address);
236                         at91_mci_write(host, ATMEL_PDC_RCR, sg->length / 4);
237                 }
238                 else {
239                         at91_mci_write(host, ATMEL_PDC_RNPR, sg->dma_address);
240                         at91_mci_write(host, ATMEL_PDC_RNCR, sg->length / 4);
241                 }
242         }
243
244         pr_debug("pre dma read done\n");
245 }
246
247 /*
248  * Handle after a dma read
249  */
250 static void at91_mci_post_dma_read(struct at91mci_host *host)
251 {
252         struct mmc_command *cmd;
253         struct mmc_data *data;
254
255         pr_debug("post dma read\n");
256
257         cmd = host->cmd;
258         if (!cmd) {
259                 pr_debug("no command\n");
260                 return;
261         }
262
263         data = cmd->data;
264         if (!data) {
265                 pr_debug("no data\n");
266                 return;
267         }
268
269         while (host->in_use_index < host->transfer_index) {
270                 struct scatterlist *sg;
271
272                 pr_debug("finishing index %d\n", host->in_use_index);
273
274                 sg = &data->sg[host->in_use_index++];
275
276                 pr_debug("Unmapping page %08X\n", sg->dma_address);
277
278                 dma_unmap_page(NULL, sg->dma_address, sg->length, DMA_FROM_DEVICE);
279
280                 data->bytes_xfered += sg->length;
281
282                 if (cpu_is_at91rm9200()) {      /* AT91RM9200 errata */
283                         unsigned int *buffer;
284                         int index;
285
286                         /* Swap the contents of the buffer */
287                         buffer = kmap_atomic(sg_page(sg), KM_BIO_SRC_IRQ) + sg->offset;
288                         pr_debug("buffer = %p, length = %d\n", buffer, sg->length);
289
290                         for (index = 0; index < (sg->length / 4); index++)
291                                 buffer[index] = swab32(buffer[index]);
292
293                         kunmap_atomic(buffer, KM_BIO_SRC_IRQ);
294                 }
295
296                 flush_dcache_page(sg_page(sg));
297         }
298
299         /* Is there another transfer to trigger? */
300         if (host->transfer_index < data->sg_len)
301                 at91_mci_pre_dma_read(host);
302         else {
303                 at91_mci_write(host, AT91_MCI_IDR, AT91_MCI_ENDRX);
304                 at91_mci_write(host, AT91_MCI_IER, AT91_MCI_RXBUFF);
305         }
306
307         pr_debug("post dma read done\n");
308 }
309
310 /*
311  * Handle transmitted data
312  */
313 static void at91_mci_handle_transmitted(struct at91mci_host *host)
314 {
315         struct mmc_command *cmd;
316         struct mmc_data *data;
317
318         pr_debug("Handling the transmit\n");
319
320         /* Disable the transfer */
321         at91_mci_write(host, ATMEL_PDC_PTCR, ATMEL_PDC_RXTDIS | ATMEL_PDC_TXTDIS);
322
323         /* Now wait for cmd ready */
324         at91_mci_write(host, AT91_MCI_IDR, AT91_MCI_TXBUFE);
325
326         cmd = host->cmd;
327         if (!cmd) return;
328
329         data = cmd->data;
330         if (!data) return;
331
332         if (cmd->data->blocks > 1) {
333                 pr_debug("multiple write : wait for BLKE...\n");
334                 at91_mci_write(host, AT91_MCI_IER, AT91_MCI_BLKE);
335         } else
336                 at91_mci_write(host, AT91_MCI_IER, AT91_MCI_NOTBUSY);
337
338         data->bytes_xfered = host->total_length;
339 }
340
341 /*Handle after command sent ready*/
342 static int at91_mci_handle_cmdrdy(struct at91mci_host *host)
343 {
344         if (!host->cmd)
345                 return 1;
346         else if (!host->cmd->data) {
347                 if (host->flags & FL_SENT_STOP) {
348                         /*After multi block write, we must wait for NOTBUSY*/
349                         at91_mci_write(host, AT91_MCI_IER, AT91_MCI_NOTBUSY);
350                 } else return 1;
351         } else if (host->cmd->data->flags & MMC_DATA_WRITE) {
352                 /*After sendding multi-block-write command, start DMA transfer*/
353                 at91_mci_write(host, AT91_MCI_IER, AT91_MCI_TXBUFE);
354                 at91_mci_write(host, AT91_MCI_IER, AT91_MCI_BLKE);
355                 at91_mci_write(host, ATMEL_PDC_PTCR, ATMEL_PDC_TXTEN);
356         }
357
358         /* command not completed, have to wait */
359         return 0;
360 }
361
362
363 /*
364  * Enable the controller
365  */
366 static void at91_mci_enable(struct at91mci_host *host)
367 {
368         unsigned int mr;
369
370         at91_mci_write(host, AT91_MCI_CR, AT91_MCI_MCIEN);
371         at91_mci_write(host, AT91_MCI_IDR, 0xffffffff);
372         at91_mci_write(host, AT91_MCI_DTOR, AT91_MCI_DTOMUL_1M | AT91_MCI_DTOCYC);
373         mr = AT91_MCI_PDCMODE | 0x34a;
374
375         if (cpu_is_at91sam9260() || cpu_is_at91sam9263())
376                 mr |= AT91_MCI_RDPROOF | AT91_MCI_WRPROOF;
377
378         at91_mci_write(host, AT91_MCI_MR, mr);
379
380         /* use Slot A or B (only one at same time) */
381         at91_mci_write(host, AT91_MCI_SDCR, host->board->slot_b);
382 }
383
384 /*
385  * Disable the controller
386  */
387 static void at91_mci_disable(struct at91mci_host *host)
388 {
389         at91_mci_write(host, AT91_MCI_CR, AT91_MCI_MCIDIS | AT91_MCI_SWRST);
390 }
391
392 /*
393  * Send a command
394  */
395 static void at91_mci_send_command(struct at91mci_host *host, struct mmc_command *cmd)
396 {
397         unsigned int cmdr, mr;
398         unsigned int block_length;
399         struct mmc_data *data = cmd->data;
400
401         unsigned int blocks;
402         unsigned int ier = 0;
403
404         host->cmd = cmd;
405
406         /* Needed for leaving busy state before CMD1 */
407         if ((at91_mci_read(host, AT91_MCI_SR) & AT91_MCI_RTOE) && (cmd->opcode == 1)) {
408                 pr_debug("Clearing timeout\n");
409                 at91_mci_write(host, AT91_MCI_ARGR, 0);
410                 at91_mci_write(host, AT91_MCI_CMDR, AT91_MCI_OPDCMD);
411                 while (!(at91_mci_read(host, AT91_MCI_SR) & AT91_MCI_CMDRDY)) {
412                         /* spin */
413                         pr_debug("Clearing: SR = %08X\n", at91_mci_read(host, AT91_MCI_SR));
414                 }
415         }
416
417         cmdr = cmd->opcode;
418
419         if (mmc_resp_type(cmd) == MMC_RSP_NONE)
420                 cmdr |= AT91_MCI_RSPTYP_NONE;
421         else {
422                 /* if a response is expected then allow maximum response latancy */
423                 cmdr |= AT91_MCI_MAXLAT;
424                 /* set 136 bit response for R2, 48 bit response otherwise */
425                 if (mmc_resp_type(cmd) == MMC_RSP_R2)
426                         cmdr |= AT91_MCI_RSPTYP_136;
427                 else
428                         cmdr |= AT91_MCI_RSPTYP_48;
429         }
430
431         if (data) {
432
433                 if ( data->blksz & 0x3 ) {
434                         pr_debug("Unsupported block size\n");
435                         cmd->error = -EINVAL;
436                         mmc_request_done(host->mmc, host->request);
437                         return;
438                 }
439
440                 block_length = data->blksz;
441                 blocks = data->blocks;
442
443                 /* always set data start - also set direction flag for read */
444                 if (data->flags & MMC_DATA_READ)
445                         cmdr |= (AT91_MCI_TRDIR | AT91_MCI_TRCMD_START);
446                 else if (data->flags & MMC_DATA_WRITE)
447                         cmdr |= AT91_MCI_TRCMD_START;
448
449                 if (data->flags & MMC_DATA_STREAM)
450                         cmdr |= AT91_MCI_TRTYP_STREAM;
451                 if (data->blocks > 1)
452                         cmdr |= AT91_MCI_TRTYP_MULTIPLE;
453         }
454         else {
455                 block_length = 0;
456                 blocks = 0;
457         }
458
459         if (host->flags & FL_SENT_STOP)
460                 cmdr |= AT91_MCI_TRCMD_STOP;
461
462         if (host->bus_mode == MMC_BUSMODE_OPENDRAIN)
463                 cmdr |= AT91_MCI_OPDCMD;
464
465         /*
466          * Set the arguments and send the command
467          */
468         pr_debug("Sending command %d as %08X, arg = %08X, blocks = %d, length = %d (MR = %08X)\n",
469                 cmd->opcode, cmdr, cmd->arg, blocks, block_length, at91_mci_read(host, AT91_MCI_MR));
470
471         if (!data) {
472                 at91_mci_write(host, ATMEL_PDC_PTCR, ATMEL_PDC_TXTDIS | ATMEL_PDC_RXTDIS);
473                 at91_mci_write(host, ATMEL_PDC_RPR, 0);
474                 at91_mci_write(host, ATMEL_PDC_RCR, 0);
475                 at91_mci_write(host, ATMEL_PDC_RNPR, 0);
476                 at91_mci_write(host, ATMEL_PDC_RNCR, 0);
477                 at91_mci_write(host, ATMEL_PDC_TPR, 0);
478                 at91_mci_write(host, ATMEL_PDC_TCR, 0);
479                 at91_mci_write(host, ATMEL_PDC_TNPR, 0);
480                 at91_mci_write(host, ATMEL_PDC_TNCR, 0);
481                 ier = AT91_MCI_CMDRDY;
482         } else {
483                 /* zero block length and PDC mode */
484                 mr = at91_mci_read(host, AT91_MCI_MR) & 0x7fff;
485                 at91_mci_write(host, AT91_MCI_MR, mr | (block_length << 16) | AT91_MCI_PDCMODE);
486
487                 /*
488                  * Disable the PDC controller
489                  */
490                 at91_mci_write(host, ATMEL_PDC_PTCR, ATMEL_PDC_RXTDIS | ATMEL_PDC_TXTDIS);
491
492                 if (cmdr & AT91_MCI_TRCMD_START) {
493                         data->bytes_xfered = 0;
494                         host->transfer_index = 0;
495                         host->in_use_index = 0;
496                         if (cmdr & AT91_MCI_TRDIR) {
497                                 /*
498                                  * Handle a read
499                                  */
500                                 host->buffer = NULL;
501                                 host->total_length = 0;
502
503                                 at91_mci_pre_dma_read(host);
504                                 ier = AT91_MCI_ENDRX /* | AT91_MCI_RXBUFF */;
505                         }
506                         else {
507                                 /*
508                                  * Handle a write
509                                  */
510                                 host->total_length = block_length * blocks;
511                                 host->buffer = dma_alloc_coherent(NULL,
512                                                 host->total_length,
513                                                 &host->physical_address, GFP_KERNEL);
514
515                                 at91_mci_sg_to_dma(host, data);
516
517                                 pr_debug("Transmitting %d bytes\n", host->total_length);
518
519                                 at91_mci_write(host, ATMEL_PDC_TPR, host->physical_address);
520                                 at91_mci_write(host, ATMEL_PDC_TCR, host->total_length / 4);
521                                 ier = AT91_MCI_CMDRDY;
522                         }
523                 }
524         }
525
526         /*
527          * Send the command and then enable the PDC - not the other way round as
528          * the data sheet says
529          */
530
531         at91_mci_write(host, AT91_MCI_ARGR, cmd->arg);
532         at91_mci_write(host, AT91_MCI_CMDR, cmdr);
533
534         if (cmdr & AT91_MCI_TRCMD_START) {
535                 if (cmdr & AT91_MCI_TRDIR)
536                         at91_mci_write(host, ATMEL_PDC_PTCR, ATMEL_PDC_RXTEN);
537         }
538
539         /* Enable selected interrupts */
540         at91_mci_write(host, AT91_MCI_IER, AT91_MCI_ERRORS | ier);
541 }
542
543 /*
544  * Process the next step in the request
545  */
546 static void at91_mci_process_next(struct at91mci_host *host)
547 {
548         if (!(host->flags & FL_SENT_COMMAND)) {
549                 host->flags |= FL_SENT_COMMAND;
550                 at91_mci_send_command(host, host->request->cmd);
551         }
552         else if ((!(host->flags & FL_SENT_STOP)) && host->request->stop) {
553                 host->flags |= FL_SENT_STOP;
554                 at91_mci_send_command(host, host->request->stop);
555         }
556         else
557                 mmc_request_done(host->mmc, host->request);
558 }
559
560 /*
561  * Handle a command that has been completed
562  */
563 static void at91_mci_completed_command(struct at91mci_host *host)
564 {
565         struct mmc_command *cmd = host->cmd;
566         unsigned int status;
567
568         at91_mci_write(host, AT91_MCI_IDR, 0xffffffff);
569
570         cmd->resp[0] = at91_mci_read(host, AT91_MCI_RSPR(0));
571         cmd->resp[1] = at91_mci_read(host, AT91_MCI_RSPR(1));
572         cmd->resp[2] = at91_mci_read(host, AT91_MCI_RSPR(2));
573         cmd->resp[3] = at91_mci_read(host, AT91_MCI_RSPR(3));
574
575         if (host->buffer) {
576                 dma_free_coherent(NULL, host->total_length, host->buffer, host->physical_address);
577                 host->buffer = NULL;
578         }
579
580         status = at91_mci_read(host, AT91_MCI_SR);
581
582         pr_debug("Status = %08X [%08X %08X %08X %08X]\n",
583                  status, cmd->resp[0], cmd->resp[1], cmd->resp[2], cmd->resp[3]);
584
585         if (status & AT91_MCI_ERRORS) {
586                 if ((status & AT91_MCI_RCRCE) && !(mmc_resp_type(cmd) & MMC_RSP_CRC)) {
587                         cmd->error = 0;
588                 }
589                 else {
590                         if (status & (AT91_MCI_RTOE | AT91_MCI_DTOE))
591                                 cmd->error = -ETIMEDOUT;
592                         else if (status & (AT91_MCI_RCRCE | AT91_MCI_DCRCE))
593                                 cmd->error = -EILSEQ;
594                         else
595                                 cmd->error = -EIO;
596
597                         pr_debug("Error detected and set to %d (cmd = %d, retries = %d)\n",
598                                  cmd->error, cmd->opcode, cmd->retries);
599                 }
600         }
601         else
602                 cmd->error = 0;
603
604         at91_mci_process_next(host);
605 }
606
607 /*
608  * Handle an MMC request
609  */
610 static void at91_mci_request(struct mmc_host *mmc, struct mmc_request *mrq)
611 {
612         struct at91mci_host *host = mmc_priv(mmc);
613         host->request = mrq;
614         host->flags = 0;
615
616         at91_mci_process_next(host);
617 }
618
619 /*
620  * Set the IOS
621  */
622 static void at91_mci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
623 {
624         int clkdiv;
625         struct at91mci_host *host = mmc_priv(mmc);
626         unsigned long at91_master_clock = clk_get_rate(host->mci_clk);
627
628         host->bus_mode = ios->bus_mode;
629
630         if (ios->clock == 0) {
631                 /* Disable the MCI controller */
632                 at91_mci_write(host, AT91_MCI_CR, AT91_MCI_MCIDIS);
633                 clkdiv = 0;
634         }
635         else {
636                 /* Enable the MCI controller */
637                 at91_mci_write(host, AT91_MCI_CR, AT91_MCI_MCIEN);
638
639                 if ((at91_master_clock % (ios->clock * 2)) == 0)
640                         clkdiv = ((at91_master_clock / ios->clock) / 2) - 1;
641                 else
642                         clkdiv = (at91_master_clock / ios->clock) / 2;
643
644                 pr_debug("clkdiv = %d. mcck = %ld\n", clkdiv,
645                         at91_master_clock / (2 * (clkdiv + 1)));
646         }
647         if (ios->bus_width == MMC_BUS_WIDTH_4 && host->board->wire4) {
648                 pr_debug("MMC: Setting controller bus width to 4\n");
649                 at91_mci_write(host, AT91_MCI_SDCR, at91_mci_read(host, AT91_MCI_SDCR) | AT91_MCI_SDCBUS);
650         }
651         else {
652                 pr_debug("MMC: Setting controller bus width to 1\n");
653                 at91_mci_write(host, AT91_MCI_SDCR, at91_mci_read(host, AT91_MCI_SDCR) & ~AT91_MCI_SDCBUS);
654         }
655
656         /* Set the clock divider */
657         at91_mci_write(host, AT91_MCI_MR, (at91_mci_read(host, AT91_MCI_MR) & ~AT91_MCI_CLKDIV) | clkdiv);
658
659         /* maybe switch power to the card */
660         if (host->board->vcc_pin) {
661                 switch (ios->power_mode) {
662                         case MMC_POWER_OFF:
663                                 gpio_set_value(host->board->vcc_pin, 0);
664                                 break;
665                         case MMC_POWER_UP:
666                                 gpio_set_value(host->board->vcc_pin, 1);
667                                 break;
668                         case MMC_POWER_ON:
669                                 break;
670                         default:
671                                 WARN_ON(1);
672                 }
673         }
674 }
675
676 /*
677  * Handle an interrupt
678  */
679 static irqreturn_t at91_mci_irq(int irq, void *devid)
680 {
681         struct at91mci_host *host = devid;
682         int completed = 0;
683         unsigned int int_status, int_mask;
684
685         int_status = at91_mci_read(host, AT91_MCI_SR);
686         int_mask = at91_mci_read(host, AT91_MCI_IMR);
687
688         pr_debug("MCI irq: status = %08X, %08X, %08X\n", int_status, int_mask,
689                 int_status & int_mask);
690
691         int_status = int_status & int_mask;
692
693         if (int_status & AT91_MCI_ERRORS) {
694                 completed = 1;
695
696                 if (int_status & AT91_MCI_UNRE)
697                         pr_debug("MMC: Underrun error\n");
698                 if (int_status & AT91_MCI_OVRE)
699                         pr_debug("MMC: Overrun error\n");
700                 if (int_status & AT91_MCI_DTOE)
701                         pr_debug("MMC: Data timeout\n");
702                 if (int_status & AT91_MCI_DCRCE)
703                         pr_debug("MMC: CRC error in data\n");
704                 if (int_status & AT91_MCI_RTOE)
705                         pr_debug("MMC: Response timeout\n");
706                 if (int_status & AT91_MCI_RENDE)
707                         pr_debug("MMC: Response end bit error\n");
708                 if (int_status & AT91_MCI_RCRCE)
709                         pr_debug("MMC: Response CRC error\n");
710                 if (int_status & AT91_MCI_RDIRE)
711                         pr_debug("MMC: Response direction error\n");
712                 if (int_status & AT91_MCI_RINDE)
713                         pr_debug("MMC: Response index error\n");
714         } else {
715                 /* Only continue processing if no errors */
716
717                 if (int_status & AT91_MCI_TXBUFE) {
718                         pr_debug("TX buffer empty\n");
719                         at91_mci_handle_transmitted(host);
720                 }
721
722                 if (int_status & AT91_MCI_ENDRX) {
723                         pr_debug("ENDRX\n");
724                         at91_mci_post_dma_read(host);
725                 }
726
727                 if (int_status & AT91_MCI_RXBUFF) {
728                         pr_debug("RX buffer full\n");
729                         at91_mci_write(host, ATMEL_PDC_PTCR, ATMEL_PDC_RXTDIS | ATMEL_PDC_TXTDIS);
730                         at91_mci_write(host, AT91_MCI_IDR, AT91_MCI_RXBUFF | AT91_MCI_ENDRX);
731                         completed = 1;
732                 }
733
734                 if (int_status & AT91_MCI_ENDTX)
735                         pr_debug("Transmit has ended\n");
736
737                 if (int_status & AT91_MCI_NOTBUSY) {
738                         pr_debug("Card is ready\n");
739                         completed = 1;
740                 }
741
742                 if (int_status & AT91_MCI_DTIP)
743                         pr_debug("Data transfer in progress\n");
744
745                 if (int_status & AT91_MCI_BLKE) {
746                         pr_debug("Block transfer has ended\n");
747                         completed = 1;
748                 }
749
750                 if (int_status & AT91_MCI_TXRDY)
751                         pr_debug("Ready to transmit\n");
752
753                 if (int_status & AT91_MCI_RXRDY)
754                         pr_debug("Ready to receive\n");
755
756                 if (int_status & AT91_MCI_CMDRDY) {
757                         pr_debug("Command ready\n");
758                         completed = at91_mci_handle_cmdrdy(host);
759                 }
760         }
761
762         if (completed) {
763                 pr_debug("Completed command\n");
764                 at91_mci_write(host, AT91_MCI_IDR, 0xffffffff);
765                 at91_mci_completed_command(host);
766         } else
767                 at91_mci_write(host, AT91_MCI_IDR, int_status);
768
769         return IRQ_HANDLED;
770 }
771
772 static irqreturn_t at91_mmc_det_irq(int irq, void *_host)
773 {
774         struct at91mci_host *host = _host;
775         int present = !gpio_get_value(irq_to_gpio(irq));
776
777         /*
778          * we expect this irq on both insert and remove,
779          * and use a short delay to debounce.
780          */
781         if (present != host->present) {
782                 host->present = present;
783                 pr_debug("%s: card %s\n", mmc_hostname(host->mmc),
784                         present ? "insert" : "remove");
785                 if (!present) {
786                         pr_debug("****** Resetting SD-card bus width ******\n");
787                         at91_mci_write(host, AT91_MCI_SDCR, at91_mci_read(host, AT91_MCI_SDCR) & ~AT91_MCI_SDCBUS);
788                 }
789                 mmc_detect_change(host->mmc, msecs_to_jiffies(100));
790         }
791         return IRQ_HANDLED;
792 }
793
794 static int at91_mci_get_ro(struct mmc_host *mmc)
795 {
796         int read_only = 0;
797         struct at91mci_host *host = mmc_priv(mmc);
798
799         if (host->board->wp_pin) {
800                 read_only = gpio_get_value(host->board->wp_pin);
801                 printk(KERN_WARNING "%s: card is %s\n", mmc_hostname(mmc),
802                                 (read_only ? "read-only" : "read-write") );
803         }
804         else {
805                 printk(KERN_WARNING "%s: host does not support reading read-only "
806                                 "switch.  Assuming write-enable.\n", mmc_hostname(mmc));
807         }
808         return read_only;
809 }
810
811 static const struct mmc_host_ops at91_mci_ops = {
812         .request        = at91_mci_request,
813         .set_ios        = at91_mci_set_ios,
814         .get_ro         = at91_mci_get_ro,
815 };
816
817 /*
818  * Probe for the device
819  */
820 static int __init at91_mci_probe(struct platform_device *pdev)
821 {
822         struct mmc_host *mmc;
823         struct at91mci_host *host;
824         struct resource *res;
825         int ret;
826
827         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
828         if (!res)
829                 return -ENXIO;
830
831         if (!request_mem_region(res->start, res->end - res->start + 1, DRIVER_NAME))
832                 return -EBUSY;
833
834         mmc = mmc_alloc_host(sizeof(struct at91mci_host), &pdev->dev);
835         if (!mmc) {
836                 ret = -ENOMEM;
837                 dev_dbg(&pdev->dev, "couldn't allocate mmc host\n");
838                 goto fail6;
839         }
840
841         mmc->ops = &at91_mci_ops;
842         mmc->f_min = 375000;
843         mmc->f_max = 25000000;
844         mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
845
846         mmc->max_blk_size = 4095;
847         mmc->max_blk_count = mmc->max_req_size;
848
849         host = mmc_priv(mmc);
850         host->mmc = mmc;
851         host->buffer = NULL;
852         host->bus_mode = 0;
853         host->board = pdev->dev.platform_data;
854         if (host->board->wire4) {
855                 if (cpu_is_at91sam9260() || cpu_is_at91sam9263())
856                         mmc->caps |= MMC_CAP_4_BIT_DATA;
857                 else
858                         dev_warn(&pdev->dev, "4 wire bus mode not supported"
859                                 " - using 1 wire\n");
860         }
861
862         /*
863          * Reserve GPIOs ... board init code makes sure these pins are set
864          * up as GPIOs with the right direction (input, except for vcc)
865          */
866         if (host->board->det_pin) {
867                 ret = gpio_request(host->board->det_pin, "mmc_detect");
868                 if (ret < 0) {
869                         dev_dbg(&pdev->dev, "couldn't claim card detect pin\n");
870                         goto fail5;
871                 }
872         }
873         if (host->board->wp_pin) {
874                 ret = gpio_request(host->board->wp_pin, "mmc_wp");
875                 if (ret < 0) {
876                         dev_dbg(&pdev->dev, "couldn't claim wp sense pin\n");
877                         goto fail4;
878                 }
879         }
880         if (host->board->vcc_pin) {
881                 ret = gpio_request(host->board->vcc_pin, "mmc_vcc");
882                 if (ret < 0) {
883                         dev_dbg(&pdev->dev, "couldn't claim vcc switch pin\n");
884                         goto fail3;
885                 }
886         }
887
888         /*
889          * Get Clock
890          */
891         host->mci_clk = clk_get(&pdev->dev, "mci_clk");
892         if (IS_ERR(host->mci_clk)) {
893                 ret = -ENODEV;
894                 dev_dbg(&pdev->dev, "no mci_clk?\n");
895                 goto fail2;
896         }
897
898         /*
899          * Map I/O region
900          */
901         host->baseaddr = ioremap(res->start, res->end - res->start + 1);
902         if (!host->baseaddr) {
903                 ret = -ENOMEM;
904                 goto fail1;
905         }
906
907         /*
908          * Reset hardware
909          */
910         clk_enable(host->mci_clk);              /* Enable the peripheral clock */
911         at91_mci_disable(host);
912         at91_mci_enable(host);
913
914         /*
915          * Allocate the MCI interrupt
916          */
917         host->irq = platform_get_irq(pdev, 0);
918         ret = request_irq(host->irq, at91_mci_irq, IRQF_SHARED,
919                         mmc_hostname(mmc), host);
920         if (ret) {
921                 dev_dbg(&pdev->dev, "request MCI interrupt failed\n");
922                 goto fail0;
923         }
924
925         platform_set_drvdata(pdev, mmc);
926
927         /*
928          * Add host to MMC layer
929          */
930         if (host->board->det_pin) {
931                 host->present = !gpio_get_value(host->board->det_pin);
932         }
933         else
934                 host->present = -1;
935
936         mmc_add_host(mmc);
937
938         /*
939          * monitor card insertion/removal if we can
940          */
941         if (host->board->det_pin) {
942                 ret = request_irq(gpio_to_irq(host->board->det_pin),
943                                 at91_mmc_det_irq, 0, mmc_hostname(mmc), host);
944                 if (ret)
945                         dev_warn(&pdev->dev, "request MMC detect irq failed\n");
946                 else
947                         device_init_wakeup(&pdev->dev, 1);
948         }
949
950         pr_debug("Added MCI driver\n");
951
952         return 0;
953
954 fail0:
955         clk_disable(host->mci_clk);
956         iounmap(host->baseaddr);
957 fail1:
958         clk_put(host->mci_clk);
959 fail2:
960         if (host->board->vcc_pin)
961                 gpio_free(host->board->vcc_pin);
962 fail3:
963         if (host->board->wp_pin)
964                 gpio_free(host->board->wp_pin);
965 fail4:
966         if (host->board->det_pin)
967                 gpio_free(host->board->det_pin);
968 fail5:
969         mmc_free_host(mmc);
970 fail6:
971         release_mem_region(res->start, res->end - res->start + 1);
972         dev_err(&pdev->dev, "probe failed, err %d\n", ret);
973         return ret;
974 }
975
976 /*
977  * Remove a device
978  */
979 static int __exit at91_mci_remove(struct platform_device *pdev)
980 {
981         struct mmc_host *mmc = platform_get_drvdata(pdev);
982         struct at91mci_host *host;
983         struct resource *res;
984
985         if (!mmc)
986                 return -1;
987
988         host = mmc_priv(mmc);
989
990         if (host->board->det_pin) {
991                 if (device_can_wakeup(&pdev->dev))
992                         free_irq(gpio_to_irq(host->board->det_pin), host);
993                 device_init_wakeup(&pdev->dev, 0);
994                 gpio_free(host->board->det_pin);
995         }
996
997         at91_mci_disable(host);
998         mmc_remove_host(mmc);
999         free_irq(host->irq, host);
1000
1001         clk_disable(host->mci_clk);                     /* Disable the peripheral clock */
1002         clk_put(host->mci_clk);
1003
1004         if (host->board->vcc_pin)
1005                 gpio_free(host->board->vcc_pin);
1006         if (host->board->wp_pin)
1007                 gpio_free(host->board->wp_pin);
1008
1009         iounmap(host->baseaddr);
1010         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1011         release_mem_region(res->start, res->end - res->start + 1);
1012
1013         mmc_free_host(mmc);
1014         platform_set_drvdata(pdev, NULL);
1015         pr_debug("MCI Removed\n");
1016
1017         return 0;
1018 }
1019
1020 #ifdef CONFIG_PM
1021 static int at91_mci_suspend(struct platform_device *pdev, pm_message_t state)
1022 {
1023         struct mmc_host *mmc = platform_get_drvdata(pdev);
1024         struct at91mci_host *host = mmc_priv(mmc);
1025         int ret = 0;
1026
1027         if (host->board->det_pin && device_may_wakeup(&pdev->dev))
1028                 enable_irq_wake(host->board->det_pin);
1029
1030         if (mmc)
1031                 ret = mmc_suspend_host(mmc, state);
1032
1033         return ret;
1034 }
1035
1036 static int at91_mci_resume(struct platform_device *pdev)
1037 {
1038         struct mmc_host *mmc = platform_get_drvdata(pdev);
1039         struct at91mci_host *host = mmc_priv(mmc);
1040         int ret = 0;
1041
1042         if (host->board->det_pin && device_may_wakeup(&pdev->dev))
1043                 disable_irq_wake(host->board->det_pin);
1044
1045         if (mmc)
1046                 ret = mmc_resume_host(mmc);
1047
1048         return ret;
1049 }
1050 #else
1051 #define at91_mci_suspend        NULL
1052 #define at91_mci_resume         NULL
1053 #endif
1054
1055 static struct platform_driver at91_mci_driver = {
1056         .remove         = __exit_p(at91_mci_remove),
1057         .suspend        = at91_mci_suspend,
1058         .resume         = at91_mci_resume,
1059         .driver         = {
1060                 .name   = DRIVER_NAME,
1061                 .owner  = THIS_MODULE,
1062         },
1063 };
1064
1065 static int __init at91_mci_init(void)
1066 {
1067         return platform_driver_probe(&at91_mci_driver, at91_mci_probe);
1068 }
1069
1070 static void __exit at91_mci_exit(void)
1071 {
1072         platform_driver_unregister(&at91_mci_driver);
1073 }
1074
1075 module_init(at91_mci_init);
1076 module_exit(at91_mci_exit);
1077
1078 MODULE_DESCRIPTION("AT91 Multimedia Card Interface driver");
1079 MODULE_AUTHOR("Nick Randell");
1080 MODULE_LICENSE("GPL");
1081 MODULE_ALIAS("platform:at91_mci");