at91_cf.c revision 2c1f3b7a30286c16ba151fadb0abf0b20e2a1e45
12c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*
22c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * at91_cf.c -- AT91 CompactFlash controller driver
32c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor *
42c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * Copyright (C) 2005 David Brownell
52c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor *
62c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * This program is free software; you can redistribute it and/or modify
72c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * it under the terms of the GNU General Public License as published by
82c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * the Free Software Foundation; either version 2 of the License, or
92c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * (at your option) any later version.
102c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor */
112c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
122c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <linux/module.h>
132c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <linux/kernel.h>
142c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <linux/sched.h>
152c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <linux/platform_device.h>
162c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <linux/errno.h>
172c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <linux/init.h>
182c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <linux/interrupt.h>
192c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
202c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <pcmcia/ss.h>
212c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
222c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <asm/hardware.h>
232c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <asm/io.h>
242c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <asm/sizes.h>
252c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
262c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <asm/arch/at91rm9200.h>
272c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <asm/arch/board.h>
282c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#include <asm/arch/gpio.h>
292c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
302c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
312c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#define	CF_SIZE		0x30000000	/* CS5+CS6: unavailable */
322c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
332c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*
342c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * A0..A10 work in each range; A23 indicates I/O space;  A25 is CFRNW;
352c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * some other bit in {A24,A22..A11} is nREG to flag memory access
362c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * (vs attributes).  So more than 2KB/region would just be waste.
372c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor */
382c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#define	CF_ATTR_PHYS	(AT91_CF_BASE)
392c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#define	CF_IO_PHYS	(AT91_CF_BASE  + (1 << 23))
402c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#define	CF_MEM_PHYS	(AT91_CF_BASE  + 0x017ff800)
412c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
422c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*--------------------------------------------------------------------------*/
432c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
442c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic const char driver_name[] = "at91_cf";
452c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
462c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstruct at91_cf_socket {
472c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct pcmcia_socket	socket;
482c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
492c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	unsigned		present:1;
502c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
512c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct platform_device	*pdev;
522c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_data	*board;
532c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor};
542c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
552c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#define	SZ_2K			(2 * SZ_1K)
562c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
572c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic inline int at91_cf_present(struct at91_cf_socket *cf)
582c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
592c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return !at91_get_gpio_value(cf->board->det_pin);
602c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
612c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
622c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*--------------------------------------------------------------------------*/
632c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
642c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int at91_cf_ss_init(struct pcmcia_socket *s)
652c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
662c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
672c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
682c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
692c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic irqreturn_t at91_cf_irq(int irq, void *_cf, struct pt_regs *r)
702c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
712c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket	*cf = (struct at91_cf_socket *) _cf;
722c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
732c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (irq == cf->board->det_pin) {
742c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		unsigned present = at91_cf_present(cf);
752c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
762c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		/* kick pccard as needed */
772c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		if (present != cf->present) {
782c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			cf->present = present;
792c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			pr_debug("%s: card %s\n", driver_name, present ? "present" : "gone");
802c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			pcmcia_parse_events(&cf->socket, SS_DETECT);
812c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		}
822c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	}
832c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
842c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return IRQ_HANDLED;
852c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
862c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
872c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int at91_cf_get_status(struct pcmcia_socket *s, u_int *sp)
882c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
892c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket	*cf;
902c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
912c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!sp)
922c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		return -EINVAL;
932c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
942c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf = container_of(s, struct at91_cf_socket, socket);
952c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
962c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* NOTE: we assume 3VCARD, not XVCARD...  */
972c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (at91_cf_present(cf)) {
982c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		int rdy	= cf->board->irq_pin;	/* RDY/nIRQ */
992c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		int vcc	= cf->board->vcc_pin;
1002c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1012c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		*sp = SS_DETECT | SS_3VCARD;
1022c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		if (!rdy || at91_get_gpio_value(rdy))
1032c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			*sp |= SS_READY;
1042c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		if (!vcc || at91_get_gpio_value(vcc))
1052c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			*sp |= SS_POWERON;
1062c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	} else
1072c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		*sp = 0;
1082c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1092c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
1102c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
1112c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1122c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int at91_cf_set_socket(struct pcmcia_socket *sock, struct socket_state_t *s)
1132c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
1142c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket	*cf;
1152c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1162c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf = container_of(sock, struct at91_cf_socket, socket);
1172c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1182c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* switch Vcc if needed and possible */
1192c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (cf->board->vcc_pin) {
1202c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		switch (s->Vcc) {
1212c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			case 0:
1222c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				at91_set_gpio_value(cf->board->vcc_pin, 0);
1232c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				break;
1242c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			case 33:
1252c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				at91_set_gpio_value(cf->board->vcc_pin, 1);
1262c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				break;
1272c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			default:
1282c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				return -EINVAL;
1292c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		}
1302c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	}
1312c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1322c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* toggle reset if needed */
1332c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	at91_set_gpio_value(cf->board->rst_pin, s->flags & SS_RESET);
1342c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1352c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	pr_debug("%s: Vcc %d, io_irq %d, flags %04x csc %04x\n",
1362c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		driver_name, s->Vcc, s->io_irq, s->flags, s->csc_mask);
1372c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1382c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
1392c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
1402c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1412c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int at91_cf_ss_suspend(struct pcmcia_socket *s)
1422c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
1432c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return at91_cf_set_socket(s, &dead_socket);
1442c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
1452c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1462c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/* we already mapped the I/O region */
1472c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int at91_cf_set_io_map(struct pcmcia_socket *s, struct pccard_io_map *io)
1482c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
1492c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket	*cf;
1502c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	u32			csr;
1512c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1522c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf = container_of(s, struct at91_cf_socket, socket);
1532c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	io->flags &= (MAP_ACTIVE | MAP_16BIT | MAP_AUTOSZ);
1542c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1552c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/*
1562c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * Use 16 bit accesses unless/until we need 8-bit i/o space.
1572c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * Always set CSR4 ... PCMCIA won't always unmap things.
1582c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 */
1592c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	csr = at91_sys_read(AT91_SMC_CSR(4)) & ~AT91_SMC_DBW;
1602c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1612c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/*
1622c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * NOTE: this CF controller ignores IOIS16, so we can't really do
1632c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * MAP_AUTOSZ.  The 16bit mode allows single byte access on either
1642c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * D0-D7 (even addr) or D8-D15 (odd), so it's close enough for many
1652c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * purposes (and handles ide-cs).
1662c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 *
1672c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * The 8bit mode is needed for odd byte access on D0-D7.  It seems
1682c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * some cards only like that way to get at the odd byte, despite
1692c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * CF 3.0 spec table 35 also giving the D8-D15 option.
1702c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 */
1712c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!(io->flags & (MAP_16BIT|MAP_AUTOSZ))) {
1722c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		csr |= AT91_SMC_DBW_8;
1732c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		pr_debug("%s: 8bit i/o bus\n", driver_name);
1742c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	} else {
1752c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		csr |= AT91_SMC_DBW_16;
1762c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		pr_debug("%s: 16bit i/o bus\n", driver_name);
1772c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	}
1782c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	at91_sys_write(AT91_SMC_CSR(4), csr);
1792c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1802c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	io->start = cf->socket.io_offset;
1812c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	io->stop = io->start + SZ_2K - 1;
1822c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1832c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
1842c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
1852c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1862c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/* pcmcia layer maps/unmaps mem regions */
1872c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int at91_cf_set_mem_map(struct pcmcia_socket *s, struct pccard_mem_map *map)
1882c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
1892c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket	*cf;
1902c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1912c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (map->card_start)
1922c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		return -EINVAL;
1932c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1942c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf = container_of(s, struct at91_cf_socket, socket);
1952c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1962c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	map->flags &= MAP_ACTIVE|MAP_ATTRIB|MAP_16BIT;
1972c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (map->flags & MAP_ATTRIB)
1982c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		map->static_start = CF_ATTR_PHYS;
1992c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	else
2002c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		map->static_start = CF_MEM_PHYS;
2012c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2022c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
2032c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
2042c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2052c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic struct pccard_operations at91_cf_ops = {
2062c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.init			= at91_cf_ss_init,
2072c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.suspend		= at91_cf_ss_suspend,
2082c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.get_status		= at91_cf_get_status,
2092c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.set_socket		= at91_cf_set_socket,
2102c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.set_io_map		= at91_cf_set_io_map,
2112c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.set_mem_map		= at91_cf_set_mem_map,
2122c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor};
2132c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2142c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*--------------------------------------------------------------------------*/
2152c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2162c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int __init at91_cf_probe(struct device *dev)
2172c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
2182c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket	*cf;
2192c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_data	*board = dev->platform_data;
2202c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct platform_device	*pdev = to_platform_device(dev);
2212c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	unsigned int		csa;
2222c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	int			status;
2232c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2242c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!board || !board->det_pin || !board->rst_pin)
2252c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		return -ENODEV;
2262c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2272c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf = kcalloc(1, sizeof *cf, GFP_KERNEL);
2282c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!cf)
2292c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		return -ENOMEM;
2302c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2312c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->board = board;
2322c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->pdev = pdev;
2332c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	dev_set_drvdata(dev, cf);
2342c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2352c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* CF takes over CS4, CS5, CS6 */
2362c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	csa = at91_sys_read(AT91_EBI_CSA);
2372c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	at91_sys_write(AT91_EBI_CSA, csa | AT91_EBI_CS4A_SMC_COMPACTFLASH);
2382c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2392c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* force poweron defaults for these pins ... */
2402c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	(void) at91_set_A_periph(AT91_PIN_PC9, 0);	/* A25/CFRNW */
2412c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	(void) at91_set_A_periph(AT91_PIN_PC10, 0);	/* NCS4/CFCS */
2422c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	(void) at91_set_A_periph(AT91_PIN_PC11, 0);	/* NCS5/CFCE1 */
2432c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	(void) at91_set_A_periph(AT91_PIN_PC12, 0);	/* NCS6/CFCE2 */
2442c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2452c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* nWAIT is _not_ a default setting */
2462c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	(void) at91_set_A_periph(AT91_PIN_PC6, 1);	/*  nWAIT */
2472c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2482c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/*
2492c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * Static memory controller timing adjustments.
2502c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * REVISIT:  these timings are in terms of MCK cycles, so
2512c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * when MCK changes (cpufreq etc) so must these values...
2522c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 */
2532c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	at91_sys_write(AT91_SMC_CSR(4), AT91_SMC_ACSS_STD | AT91_SMC_DBW_16 | AT91_SMC_BAT | AT91_SMC_WSEN
2542c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				| AT91_SMC_NWS_(32)		/* wait states */
2552c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				| AT91_SMC_RWSETUP_(6)		/* setup time */
2562c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				| AT91_SMC_RWHOLD_(4)		/* hold time */
2572c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	);
2582c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2592c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* must be a GPIO; ergo must trigger on both edges */
2602c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	status = request_irq(board->det_pin, at91_cf_irq,
2612c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			SA_SAMPLE_RANDOM, driver_name, cf);
2622c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (status < 0)
2632c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		goto fail0;
2642c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2652c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/*
2662c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * The card driver will request this irq later as needed.
2672c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * but it causes lots of "irqNN: nobody cared" messages
2682c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * unless we report that we handle everything (sigh).
2692c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * (Note:  DK board doesn't wire the IRQ pin...)
2702c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 */
2712c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (board->irq_pin) {
2722c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		status = request_irq(board->irq_pin, at91_cf_irq,
2732c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				SA_SHIRQ, driver_name, cf);
2742c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		if (status < 0)
2752c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			goto fail0a;
2762c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		cf->socket.pci_irq = board->irq_pin;
2772c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	}
2782c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	else
2792c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		cf->socket.pci_irq = NR_IRQS + 1;
2802c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2812c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* pcmcia layer only remaps "real" memory not iospace */
2822c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.io_offset = (unsigned long) ioremap(CF_IO_PHYS, SZ_2K);
2832c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!cf->socket.io_offset)
2842c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		goto fail1;
2852c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2862c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* reserve CS4, CS5, and CS6 regions; but use just CS4 */
2872c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!request_mem_region(AT91_CF_BASE, CF_SIZE, driver_name))
2882c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		goto fail1;
2892c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2902c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	pr_info("%s: irqs det #%d, io #%d\n", driver_name,
2912c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		board->det_pin, board->irq_pin);
2922c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2932c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.owner = THIS_MODULE;
2942c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.dev.dev = dev;
2952c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.ops = &at91_cf_ops;
2962c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.resource_ops = &pccard_static_ops;
2972c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.features = SS_CAP_PCCARD | SS_CAP_STATIC_MAP
2982c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				| SS_CAP_MEM_ALIGN;
2992c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.map_size = SZ_2K;
3002c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.io[0].NumPorts = SZ_2K;
3012c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3022c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	status = pcmcia_register_socket(&cf->socket);
3032c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (status < 0)
3042c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		goto fail2;
3052c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3062c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
3072c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3082c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorfail2:
3092c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	iounmap((void __iomem *) cf->socket.io_offset);
3102c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	release_mem_region(AT91_CF_BASE, CF_SIZE);
3112c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorfail1:
3122c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (board->irq_pin)
3132c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		free_irq(board->irq_pin, cf);
3142c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorfail0a:
3152c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	free_irq(board->det_pin, cf);
3162c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorfail0:
3172c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	at91_sys_write(AT91_EBI_CSA, csa);
3182c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	kfree(cf);
3192c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return status;
3202c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
3212c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3222c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int __exit at91_cf_remove(struct device *dev)
3232c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
3242c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket *cf = dev_get_drvdata(dev);
3252c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	unsigned int csa;
3262c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3272c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	pcmcia_unregister_socket(&cf->socket);
3282c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	free_irq(cf->board->irq_pin, cf);
3292c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	free_irq(cf->board->det_pin, cf);
3302c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	iounmap((void __iomem *) cf->socket.io_offset);
3312c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	release_mem_region(AT91_CF_BASE, CF_SIZE);
3322c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3332c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	csa = at91_sys_read(AT91_EBI_CSA);
3342c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	at91_sys_write(AT91_EBI_CSA, csa & ~AT91_EBI_CS4A);
3352c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3362c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	kfree(cf);
3372c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
3382c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
3392c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3402c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic struct device_driver at91_cf_driver = {
3412c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.name		= (char *) driver_name,
3422c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.bus		= &platform_bus_type,
3432c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.probe		= at91_cf_probe,
3442c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.remove		= __exit_p(at91_cf_remove),
3452c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.suspend 	= pcmcia_socket_dev_suspend,
3462c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.resume 	= pcmcia_socket_dev_resume,
3472c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor};
3482c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3492c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*--------------------------------------------------------------------------*/
3502c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3512c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int __init at91_cf_init(void)
3522c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
3532c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return driver_register(&at91_cf_driver);
3542c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
3552c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victormodule_init(at91_cf_init);
3562c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3572c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic void __exit at91_cf_exit(void)
3582c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
3592c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	driver_unregister(&at91_cf_driver);
3602c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
3612c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victormodule_exit(at91_cf_exit);
3622c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3632c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew VictorMODULE_DESCRIPTION("AT91 Compact Flash Driver");
3642c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew VictorMODULE_AUTHOR("David Brownell");
3652c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew VictorMODULE_LICENSE("GPL");
366