at91_cf.c revision 1fbece150a230d0ab447cfb2fc4df10fb89f0d8c
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/*
322c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * A0..A10 work in each range; A23 indicates I/O space;  A25 is CFRNW;
332c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * some other bit in {A24,A22..A11} is nREG to flag memory access
342c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor * (vs attributes).  So more than 2KB/region would just be waste.
352c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor */
362c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#define	CF_ATTR_PHYS	(AT91_CF_BASE)
372c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#define	CF_IO_PHYS	(AT91_CF_BASE  + (1 << 23))
382c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#define	CF_MEM_PHYS	(AT91_CF_BASE  + 0x017ff800)
392c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
402c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*--------------------------------------------------------------------------*/
412c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
422c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic const char driver_name[] = "at91_cf";
432c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
442c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstruct at91_cf_socket {
452c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct pcmcia_socket	socket;
462c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
472c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	unsigned		present:1;
482c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
492c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct platform_device	*pdev;
502c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_data	*board;
512c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor};
522c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
532c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor#define	SZ_2K			(2 * SZ_1K)
542c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
552c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic inline int at91_cf_present(struct at91_cf_socket *cf)
562c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
572c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return !at91_get_gpio_value(cf->board->det_pin);
582c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
592c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
602c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*--------------------------------------------------------------------------*/
612c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
622c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int at91_cf_ss_init(struct pcmcia_socket *s)
632c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
642c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
652c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
662c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
677d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t at91_cf_irq(int irq, void *_cf)
682c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
69c7bec5aba52392aa8d675b8722735caf4a8b7265Jeff Garzik	struct at91_cf_socket *cf = _cf;
702c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
712c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (irq == cf->board->det_pin) {
722c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		unsigned present = at91_cf_present(cf);
732c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
742c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		/* kick pccard as needed */
752c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		if (present != cf->present) {
762c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			cf->present = present;
772c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell			pr_debug("%s: card %s\n", driver_name,
782c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell					present ? "present" : "gone");
792c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			pcmcia_parse_events(&cf->socket, SS_DETECT);
802c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		}
812c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	}
822c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
832c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return IRQ_HANDLED;
842c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
852c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
862c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int at91_cf_get_status(struct pcmcia_socket *s, u_int *sp)
872c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
882c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket	*cf;
892c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
902c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!sp)
912c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		return -EINVAL;
922c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
932c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf = container_of(s, struct at91_cf_socket, socket);
942c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
952c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	/* NOTE: CF is always 3VCARD */
962c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (at91_cf_present(cf)) {
972c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		int rdy	= cf->board->irq_pin;	/* RDY/nIRQ */
982c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		int vcc	= cf->board->vcc_pin;
992c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1002c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		*sp = SS_DETECT | SS_3VCARD;
1012c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		if (!rdy || at91_get_gpio_value(rdy))
1022c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			*sp |= SS_READY;
1032c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		if (!vcc || at91_get_gpio_value(vcc))
1042c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			*sp |= SS_POWERON;
1052c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	} else
1062c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		*sp = 0;
1072c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1082c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
1092c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
1102c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1112c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownellstatic int
1122c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownellat91_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 */
1872c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownellstatic int
1882c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownellat91_cf_set_mem_map(struct pcmcia_socket *s, struct pccard_mem_map *map)
1892c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
1902c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket	*cf;
1912c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1922c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (map->card_start)
1932c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		return -EINVAL;
1942c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1952c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf = container_of(s, struct at91_cf_socket, socket);
1962c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
1972c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	map->flags &= MAP_ACTIVE|MAP_ATTRIB|MAP_16BIT;
1982c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (map->flags & MAP_ATTRIB)
1992c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		map->static_start = CF_ATTR_PHYS;
2002c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	else
2012c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		map->static_start = CF_MEM_PHYS;
2022c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2032c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
2042c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
2052c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2062c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic struct pccard_operations at91_cf_ops = {
2072c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.init			= at91_cf_ss_init,
2082c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.suspend		= at91_cf_ss_suspend,
2092c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.get_status		= at91_cf_get_status,
2102c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.set_socket		= at91_cf_set_socket,
2112c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.set_io_map		= at91_cf_set_io_map,
2122c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.set_mem_map		= at91_cf_set_mem_map,
2132c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor};
2142c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2152c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*--------------------------------------------------------------------------*/
2162c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2170db6095d4ff8918350797dfe299d572980e82fa0David Brownellstatic int __init at91_cf_probe(struct platform_device *pdev)
2182c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
2192c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	struct at91_cf_socket	*cf;
2200db6095d4ff8918350797dfe299d572980e82fa0David Brownell	struct at91_cf_data	*board = pdev->dev.platform_data;
2212c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	struct resource		*io;
2222c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	unsigned int		csa;
2232c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	int			status;
2242c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2252c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!board || !board->det_pin || !board->rst_pin)
2262c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		return -ENODEV;
2272c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2282c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	io = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2292c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	if (!io)
2302c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell		return -ENODEV;
2312c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell
2322c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf = kcalloc(1, sizeof *cf, GFP_KERNEL);
2332c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!cf)
2342c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		return -ENOMEM;
2352c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2362c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->board = board;
2372c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->pdev = pdev;
2380db6095d4ff8918350797dfe299d572980e82fa0David Brownell	platform_set_drvdata(pdev, cf);
2392c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2402c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* CF takes over CS4, CS5, CS6 */
2412c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	csa = at91_sys_read(AT91_EBI_CSA);
2422c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	at91_sys_write(AT91_EBI_CSA, csa | AT91_EBI_CS4A_SMC_COMPACTFLASH);
2432c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2442c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* nWAIT is _not_ a default setting */
2452c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	(void) at91_set_A_periph(AT91_PIN_PC6, 1);	/*  nWAIT */
2462c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2472c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/*
2482c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * Static memory controller timing adjustments.
2492c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * REVISIT:  these timings are in terms of MCK cycles, so
2502c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * when MCK changes (cpufreq etc) so must these values...
2512c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 */
2522c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	at91_sys_write(AT91_SMC_CSR(4),
2532c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell				  AT91_SMC_ACSS_STD
2542c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell				| AT91_SMC_DBW_16
2552c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell				| AT91_SMC_BAT
2562c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell				| AT91_SMC_WSEN
2572c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell				| AT91_SMC_NWS_(32)	/* wait states */
2582c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell				| AT91_SMC_RWSETUP_(6)	/* setup time */
2592c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell				| AT91_SMC_RWHOLD_(4)	/* hold time */
2602c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	);
2612c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2622c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* must be a GPIO; ergo must trigger on both edges */
2632c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	status = request_irq(board->det_pin, at91_cf_irq,
264dace145374b8e39aeb920304c358ab5e220341abThomas Gleixner			IRQF_SAMPLE_RANDOM, driver_name, cf);
2652c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (status < 0)
2662c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		goto fail0;
2670db6095d4ff8918350797dfe299d572980e82fa0David Brownell	device_init_wakeup(&pdev->dev, 1);
2682c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2692c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/*
2702c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * The card driver will request this irq later as needed.
2712c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * but it causes lots of "irqNN: nobody cared" messages
2722c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * unless we report that we handle everything (sigh).
2732c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 * (Note:  DK board doesn't wire the IRQ pin...)
2742c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	 */
2752c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (board->irq_pin) {
2762c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		status = request_irq(board->irq_pin, at91_cf_irq,
277dace145374b8e39aeb920304c358ab5e220341abThomas Gleixner				IRQF_SHARED, driver_name, cf);
2782c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		if (status < 0)
2792c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor			goto fail0a;
2802c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		cf->socket.pci_irq = board->irq_pin;
2812c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	} else
2822c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		cf->socket.pci_irq = NR_IRQS + 1;
2832c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2842c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* pcmcia layer only remaps "real" memory not iospace */
2852c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.io_offset = (unsigned long) ioremap(CF_IO_PHYS, SZ_2K);
2862c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (!cf->socket.io_offset)
2872c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		goto fail1;
2882c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2892c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	/* reserve CS4, CS5, and CS6 regions; but use just CS4 */
2902c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	if (!request_mem_region(io->start, io->end + 1 - io->start,
2912c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell				driver_name))
2922c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		goto fail1;
2932c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2942c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	pr_info("%s: irqs det #%d, io #%d\n", driver_name,
2952c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		board->det_pin, board->irq_pin);
2962c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
2972c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.owner = THIS_MODULE;
2980db6095d4ff8918350797dfe299d572980e82fa0David Brownell	cf->socket.dev.dev = &pdev->dev;
2992c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.ops = &at91_cf_ops;
3002c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.resource_ops = &pccard_static_ops;
3012c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.features = SS_CAP_PCCARD | SS_CAP_STATIC_MAP
3022c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor				| SS_CAP_MEM_ALIGN;
3032c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	cf->socket.map_size = SZ_2K;
3042c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	cf->socket.io[0].res = io;
3052c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3062c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	status = pcmcia_register_socket(&cf->socket);
3072c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (status < 0)
3082c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		goto fail2;
3092c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3102c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
3112c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3122c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorfail2:
3132c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	iounmap((void __iomem *) cf->socket.io_offset);
3142c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	release_mem_region(io->start, io->end + 1 - io->start);
3152c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorfail1:
3162c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	if (board->irq_pin)
3172c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor		free_irq(board->irq_pin, cf);
3182c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorfail0a:
3191fbece150a230d0ab447cfb2fc4df10fb89f0d8cDavid Brownell	device_init_wakeup(&pdev->dev, 0);
3202c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	free_irq(board->det_pin, cf);
3210db6095d4ff8918350797dfe299d572980e82fa0David Brownell	device_init_wakeup(&pdev->dev, 0);
3222c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorfail0:
3232c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	at91_sys_write(AT91_EBI_CSA, csa);
3242c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	kfree(cf);
3252c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return status;
3262c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
3272c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3280db6095d4ff8918350797dfe299d572980e82fa0David Brownellstatic int __exit at91_cf_remove(struct platform_device *pdev)
3292c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
3300db6095d4ff8918350797dfe299d572980e82fa0David Brownell	struct at91_cf_socket	*cf = platform_get_drvdata(pdev);
3310db6095d4ff8918350797dfe299d572980e82fa0David Brownell	struct at91_cf_data	*board = cf->board;
3322c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	struct resource		*io = cf->socket.io[0].res;
3332c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	unsigned int		csa;
3342c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3352c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	pcmcia_unregister_socket(&cf->socket);
3360db6095d4ff8918350797dfe299d572980e82fa0David Brownell	if (board->irq_pin)
3370db6095d4ff8918350797dfe299d572980e82fa0David Brownell		free_irq(board->irq_pin, cf);
3380db6095d4ff8918350797dfe299d572980e82fa0David Brownell	free_irq(board->det_pin, cf);
3390db6095d4ff8918350797dfe299d572980e82fa0David Brownell	device_init_wakeup(&pdev->dev, 0);
3402c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	iounmap((void __iomem *) cf->socket.io_offset);
3412c5362007bc0a46461a9d94958cdd53bb027004cDavid Brownell	release_mem_region(io->start, io->end + 1 - io->start);
3422c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3432c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	csa = at91_sys_read(AT91_EBI_CSA);
3442c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	at91_sys_write(AT91_EBI_CSA, csa & ~AT91_EBI_CS4A);
3452c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3462c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	kfree(cf);
3472c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	return 0;
3482c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
3492c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3500db6095d4ff8918350797dfe299d572980e82fa0David Brownell#ifdef	CONFIG_PM
3510db6095d4ff8918350797dfe299d572980e82fa0David Brownell
3520db6095d4ff8918350797dfe299d572980e82fa0David Brownellstatic int at91_cf_suspend(struct platform_device *pdev, pm_message_t mesg)
3530db6095d4ff8918350797dfe299d572980e82fa0David Brownell{
3540db6095d4ff8918350797dfe299d572980e82fa0David Brownell	struct at91_cf_socket	*cf = platform_get_drvdata(pdev);
3550db6095d4ff8918350797dfe299d572980e82fa0David Brownell	struct at91_cf_data	*board = cf->board;
3560db6095d4ff8918350797dfe299d572980e82fa0David Brownell
3570db6095d4ff8918350797dfe299d572980e82fa0David Brownell	pcmcia_socket_dev_suspend(&pdev->dev, mesg);
3581fbece150a230d0ab447cfb2fc4df10fb89f0d8cDavid Brownell	if (device_may_wakeup(&pdev->dev)) {
3590db6095d4ff8918350797dfe299d572980e82fa0David Brownell		enable_irq_wake(board->det_pin);
3601fbece150a230d0ab447cfb2fc4df10fb89f0d8cDavid Brownell		if (board->irq_pin)
3611fbece150a230d0ab447cfb2fc4df10fb89f0d8cDavid Brownell			enable_irq_wake(board->irq_pin);
3621fbece150a230d0ab447cfb2fc4df10fb89f0d8cDavid Brownell	} else {
3630db6095d4ff8918350797dfe299d572980e82fa0David Brownell		disable_irq_wake(board->det_pin);
3641fbece150a230d0ab447cfb2fc4df10fb89f0d8cDavid Brownell		if (board->irq_pin)
3651fbece150a230d0ab447cfb2fc4df10fb89f0d8cDavid Brownell			disable_irq_wake(board->irq_pin);
3660db6095d4ff8918350797dfe299d572980e82fa0David Brownell	}
3670db6095d4ff8918350797dfe299d572980e82fa0David Brownell	return 0;
3680db6095d4ff8918350797dfe299d572980e82fa0David Brownell}
3690db6095d4ff8918350797dfe299d572980e82fa0David Brownell
3700db6095d4ff8918350797dfe299d572980e82fa0David Brownellstatic int at91_cf_resume(struct platform_device *pdev)
3710db6095d4ff8918350797dfe299d572980e82fa0David Brownell{
3720db6095d4ff8918350797dfe299d572980e82fa0David Brownell	pcmcia_socket_dev_resume(&pdev->dev);
3730db6095d4ff8918350797dfe299d572980e82fa0David Brownell	return 0;
3740db6095d4ff8918350797dfe299d572980e82fa0David Brownell}
3750db6095d4ff8918350797dfe299d572980e82fa0David Brownell
3760db6095d4ff8918350797dfe299d572980e82fa0David Brownell#else
3770db6095d4ff8918350797dfe299d572980e82fa0David Brownell#define	at91_cf_suspend		NULL
3780db6095d4ff8918350797dfe299d572980e82fa0David Brownell#define	at91_cf_resume		NULL
3790db6095d4ff8918350797dfe299d572980e82fa0David Brownell#endif
3800db6095d4ff8918350797dfe299d572980e82fa0David Brownell
3810db6095d4ff8918350797dfe299d572980e82fa0David Brownellstatic struct platform_driver at91_cf_driver = {
3820db6095d4ff8918350797dfe299d572980e82fa0David Brownell	.driver = {
3830db6095d4ff8918350797dfe299d572980e82fa0David Brownell		.name		= (char *) driver_name,
3840db6095d4ff8918350797dfe299d572980e82fa0David Brownell		.owner		= THIS_MODULE,
3850db6095d4ff8918350797dfe299d572980e82fa0David Brownell	},
3862c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.probe		= at91_cf_probe,
3872c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor	.remove		= __exit_p(at91_cf_remove),
3880db6095d4ff8918350797dfe299d572980e82fa0David Brownell	.suspend	= at91_cf_suspend,
3890db6095d4ff8918350797dfe299d572980e82fa0David Brownell	.resume		= at91_cf_resume,
3902c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor};
3912c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3922c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor/*--------------------------------------------------------------------------*/
3932c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
3942c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic int __init at91_cf_init(void)
3952c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
3960db6095d4ff8918350797dfe299d572980e82fa0David Brownell	return platform_driver_register(&at91_cf_driver);
3972c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
3982c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victormodule_init(at91_cf_init);
3992c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
4002c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victorstatic void __exit at91_cf_exit(void)
4012c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor{
4020db6095d4ff8918350797dfe299d572980e82fa0David Brownell	platform_driver_unregister(&at91_cf_driver);
4032c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor}
4042c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victormodule_exit(at91_cf_exit);
4052c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew Victor
4062c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew VictorMODULE_DESCRIPTION("AT91 Compact Flash Driver");
4072c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew VictorMODULE_AUTHOR("David Brownell");
4082c1f3b7a30286c16ba151fadb0abf0b20e2a1e45Andrew VictorMODULE_LICENSE("GPL");
409