Doug / smarc-fsl-linux-kernel | Embedian Git Server

Commit 5d95f8e2dd263f3e05ae4bf9a3309552363e13af

Authored by Axel Lin 2011-11-27 12:53:06 +0800

Committed by Dominik Brodowski 2012-03-03 21:43:37 +0800

Exists in smarc-l5.0.0_1.0.0-ga and in 5 other branches

pcmcia: convert drivers/pcmcia/* to use module_platform_driver()

This patch converts the drivers in drivers/pcmcia/* to use the
module_platform_driver() macro which makes the code smaller and a bit
simpler.

Signed-off-by: Axel Lin <axel.lin@gmail.com>
Acked-by: Wolfram Sang <w.sang@pengutronix.de>
Acked-by: Olof Johansson <olof@lixom.net>
Acked-by: Michael Hennerich <michael.hennerich@analog.com>
Acked-by: Marc Zyngier <maz@misterjones.org> [for the viper part]
Acked-by: Manuel Lauss <manuel.lauss@googlemail.com> [for the db1xxx_ss.c part]
Signed-off-by: Dominik Brodowski <linux@dominikbrodowski.net>

Showing 6 changed files with 6 additions and 71 deletions Inline Diff

drivers/pcmcia/bfin_cf_pcmcia.c
drivers/pcmcia/db1xxx_ss.c
drivers/pcmcia/electra_cf.c
drivers/pcmcia/m8xx_pcmcia.c
drivers/pcmcia/pxa2xx_viper.c
drivers/pcmcia/xxs1500_ss.c

drivers/pcmcia/bfin_cf_pcmcia.c

Diff comments View file @ 5d95f8e

 /*
  * file: drivers/pcmcia/bfin_cf.c
  *
  * based on: drivers/pcmcia/omap_cf.c
  * omap_cf.c -- OMAP 16xx CompactFlash controller driver
  *
  * Copyright (c) 2005 David Brownell
  * Copyright (c) 2006-2008 Michael Hennerich Analog Devices Inc.
  *
  * bugs:         enter bugs at http://blackfin.uclinux.org/
  *
  * this program is free software; you can redistribute it and/or modify
  * it under the terms of the gnu general public license as published by
  * the free software foundation; either version 2, or (at your option)
  * any later version.
  *
  * this program is distributed in the hope that it will be useful,
  * but without any warranty; without even the implied warranty of
  * merchantability or fitness for a particular purpose.  see the
  * gnu general public license for more details.
  *
  * you should have received a copy of the gnu general public license
  * along with this program; see the file copying.
  * if not, write to the free software foundation,
  * 59 temple place - suite 330, boston, ma 02111-1307, usa.
  */
 #include <linux/module.h>
 #include <linux/kernel.h>
 #include <linux/sched.h>
 #include <linux/platform_device.h>
 #include <linux/errno.h>
 #include <linux/init.h>
 #include <linux/slab.h>
 #include <linux/delay.h>
 #include <linux/interrupt.h>
 #include <linux/irq.h>
 #include <linux/io.h>
 #include <pcmcia/ss.h>
 #include <pcmcia/cisreg.h>
 #include <asm/gpio.h>
 #define	SZ_1K	0x00000400
 #define	SZ_8K	0x00002000
 #define	SZ_2K	(2 * SZ_1K)
 #define	POLL_INTERVAL	(2 * HZ)
 #define	CF_ATASEL_ENA 	0x20311802	/* Inverts RESET */
 #define	CF_ATASEL_DIS 	0x20311800
 #define bfin_cf_present(pfx) (gpio_get_value(pfx))
 /*--------------------------------------------------------------------------*/
 static const char driver_name[] = "bfin_cf_pcmcia";
 struct bfin_cf_socket {
 	struct pcmcia_socket socket;
 	struct timer_list timer;
 	unsigned present:1;
 	unsigned active:1;
 	struct platform_device *pdev;
 	unsigned long phys_cf_io;
 	unsigned long phys_cf_attr;
 	u_int irq;
 	u_short cd_pfx;
 };
 /*--------------------------------------------------------------------------*/
 static int bfin_cf_reset(void)
 {
 	outw(0, CF_ATASEL_ENA);
 	mdelay(200);
 	outw(0, CF_ATASEL_DIS);
 	return 0;
 }
 static int bfin_cf_ss_init(struct pcmcia_socket *s)
 {
 	return 0;
 }
 /* the timer is primarily to kick this socket's pccardd */
 static void bfin_cf_timer(unsigned long _cf)
 {
 	struct bfin_cf_socket *cf = (void *)_cf;
 	unsigned short present = bfin_cf_present(cf->cd_pfx);
 	if (present != cf->present) {
 		cf->present = present;
 		dev_dbg(&cf->pdev->dev, ": card %s\n",
 			 present ? "present" : "gone");
 		pcmcia_parse_events(&cf->socket, SS_DETECT);
 	}
 	if (cf->active)
 		mod_timer(&cf->timer, jiffies + POLL_INTERVAL);
 }
 static int bfin_cf_get_status(struct pcmcia_socket *s, u_int *sp)
 {
 	struct bfin_cf_socket *cf;
 	if (!sp)
 		return -EINVAL;
 	cf = container_of(s, struct bfin_cf_socket, socket);
 	if (bfin_cf_present(cf->cd_pfx)) {
 		*sp = SS_READY | SS_DETECT | SS_POWERON | SS_3VCARD;
 		s->pcmcia_irq = 0;
 		s->pci_irq = cf->irq;
 	} else
 		*sp = 0;
 	return 0;
 }
 static int
 bfin_cf_set_socket(struct pcmcia_socket *sock, struct socket_state_t *s)
 {
 	struct bfin_cf_socket *cf;
 	cf = container_of(sock, struct bfin_cf_socket, socket);
 	switch (s->Vcc) {
 	case 0:
 	case 33:
 		break;
 	case 50:
 		break;
 	default:
 		return -EINVAL;
 	}
 	if (s->flags & SS_RESET) {
 		disable_irq(cf->irq);
 		bfin_cf_reset();
 		enable_irq(cf->irq);
 	}
 	dev_dbg(&cf->pdev->dev, ": Vcc %d, io_irq %d, flags %04x csc %04x\n",
 		 s->Vcc, s->io_irq, s->flags, s->csc_mask);
 	return 0;
 }
 static int bfin_cf_ss_suspend(struct pcmcia_socket *s)
 {
 	return bfin_cf_set_socket(s, &dead_socket);
 }
 /* regions are 2K each:  mem, attrib, io (and reserved-for-ide) */
 static int bfin_cf_set_io_map(struct pcmcia_socket *s, struct pccard_io_map *io)
 {
 	struct bfin_cf_socket *cf;
 	cf = container_of(s, struct bfin_cf_socket, socket);
 	io->flags &= MAP_ACTIVE | MAP_ATTRIB | MAP_16BIT;
 	io->start = cf->phys_cf_io;
 	io->stop = io->start + SZ_2K - 1;
 	return 0;
 }
 static int
 bfin_cf_set_mem_map(struct pcmcia_socket *s, struct pccard_mem_map *map)
 {
 	struct bfin_cf_socket *cf;
 	if (map->card_start)
 		return -EINVAL;
 	cf = container_of(s, struct bfin_cf_socket, socket);
 	map->static_start = cf->phys_cf_io;
 	map->flags &= MAP_ACTIVE | MAP_ATTRIB | MAP_16BIT;
 	if (map->flags & MAP_ATTRIB)
 		map->static_start = cf->phys_cf_attr;
 	return 0;
 }
 static struct pccard_operations bfin_cf_ops = {
 	.init = bfin_cf_ss_init,
 	.suspend = bfin_cf_ss_suspend,
 	.get_status = bfin_cf_get_status,
 	.set_socket = bfin_cf_set_socket,
 	.set_io_map = bfin_cf_set_io_map,
 	.set_mem_map = bfin_cf_set_mem_map,
 };
 /*--------------------------------------------------------------------------*/
 static int __devinit bfin_cf_probe(struct platform_device *pdev)
 {
 	struct bfin_cf_socket *cf;
 	struct resource *io_mem, *attr_mem;
 	int irq;
 	unsigned short cd_pfx;
 	int status = 0;
 	dev_info(&pdev->dev, "Blackfin CompactFlash/PCMCIA Socket Driver\n");
 	irq = platform_get_irq(pdev, 0);
 	if (irq <= 0)
 		return -EINVAL;
 	cd_pfx = platform_get_irq(pdev, 1);	/*Card Detect GPIO PIN */
 	if (gpio_request(cd_pfx, "pcmcia: CD")) {
 		dev_err(&pdev->dev,
 		       "Failed ro request Card Detect GPIO_%d\n",
 		       cd_pfx);
 		return -EBUSY;
 	}
 	gpio_direction_input(cd_pfx);
 	cf = kzalloc(sizeof *cf, GFP_KERNEL);
 	if (!cf) {
 		gpio_free(cd_pfx);
 		return -ENOMEM;
 	}
 	cf->cd_pfx = cd_pfx;
 	setup_timer(&cf->timer, bfin_cf_timer, (unsigned long)cf);
 	cf->pdev = pdev;
 	platform_set_drvdata(pdev, cf);
 	cf->irq = irq;
 	cf->socket.pci_irq = irq;
 	irq_set_irq_type(irq, IRQF_TRIGGER_LOW);
 	io_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 	attr_mem = platform_get_resource(pdev, IORESOURCE_MEM, 1);
 	if (!io_mem || !attr_mem)
 		goto fail0;
 	cf->phys_cf_io = io_mem->start;
 	cf->phys_cf_attr = attr_mem->start;
 	/* pcmcia layer only remaps "real" memory */
 	cf->socket.io_offset = (unsigned long)
 	    ioremap(cf->phys_cf_io, SZ_2K);
 	if (!cf->socket.io_offset)
 		goto fail0;
 	dev_err(&pdev->dev, ": on irq %d\n", irq);
 	dev_dbg(&pdev->dev, ": %s\n",
 		 bfin_cf_present(cf->cd_pfx) ? "present" : "(not present)");
 	cf->socket.owner = THIS_MODULE;
 	cf->socket.dev.parent = &pdev->dev;
 	cf->socket.ops = &bfin_cf_ops;
 	cf->socket.resource_ops = &pccard_static_ops;
 	cf->socket.features = SS_CAP_PCCARD | SS_CAP_STATIC_MAP
 	    | SS_CAP_MEM_ALIGN;
 	cf->socket.map_size = SZ_2K;
 	status = pcmcia_register_socket(&cf->socket);
 	if (status < 0)
 		goto fail2;
 	cf->active = 1;
 	mod_timer(&cf->timer, jiffies + POLL_INTERVAL);
 	return 0;
 fail2:
 	iounmap((void __iomem *)cf->socket.io_offset);
 	release_mem_region(cf->phys_cf_io, SZ_8K);
 fail0:
 	gpio_free(cf->cd_pfx);
 	kfree(cf);
 	platform_set_drvdata(pdev, NULL);
 	return status;
 }
 static int __devexit bfin_cf_remove(struct platform_device *pdev)
 {
 	struct bfin_cf_socket *cf = platform_get_drvdata(pdev);
 	gpio_free(cf->cd_pfx);
 	cf->active = 0;
 	pcmcia_unregister_socket(&cf->socket);
 	del_timer_sync(&cf->timer);
 	iounmap((void __iomem *)cf->socket.io_offset);
 	release_mem_region(cf->phys_cf_io, SZ_8K);
 	platform_set_drvdata(pdev, NULL);
 	kfree(cf);
 	return 0;
 }
 static struct platform_driver bfin_cf_driver = {
 	.driver = {
 		   .name = (char *)driver_name,
 		   .owner = THIS_MODULE,
 		   },
 	.probe = bfin_cf_probe,
 	.remove = __devexit_p(bfin_cf_remove),
 };
-static int __init bfin_cf_init(void)
+module_platform_driver(bfin_cf_driver);
-{
-	return platform_driver_register(&bfin_cf_driver);
-}
-static void __exit bfin_cf_exit(void)
-{
-	platform_driver_unregister(&bfin_cf_driver);
-}
-module_init(bfin_cf_init);
-module_exit(bfin_cf_exit);
 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
 MODULE_DESCRIPTION("BFIN CF/PCMCIA Driver");
 MODULE_LICENSE("GPL");

drivers/pcmcia/db1xxx_ss.c

Diff comments View file @ 5d95f8e

 /*
  * PCMCIA socket code for the Alchemy Db1xxx/Pb1xxx boards.
  *
  * Copyright (c) 2009 Manuel Lauss <manuel.lauss@gmail.com>
  *
  */
 /* This is a fairly generic PCMCIA socket driver suitable for the
  * following Alchemy Development boards:
  *  Db1000, Db/Pb1500, Db/Pb1100, Db/Pb1550, Db/Pb1200, Db1300
  *
  * The Db1000 is used as a reference:  Per-socket card-, carddetect- and
  *  statuschange IRQs connected to SoC GPIOs, control and status register
  *  bits arranged in per-socket groups in an external PLD.  All boards
  *  listed here use this layout, including bit positions and meanings.
  *  Of course there are exceptions in later boards:
  *
  *	- Pb1100/Pb1500:  single socket only; voltage key bits VS are
  *			  at STATUS[5:4] (instead of STATUS[1:0]).
  *	- Au1200-based:	  additional card-eject irqs, irqs not gpios!
  *	- Db1300:	  Db1200-like, no pwr ctrl, single socket (#1).
  */
 #include <linux/delay.h>
 #include <linux/gpio.h>
 #include <linux/interrupt.h>
 #include <linux/pm.h>
 #include <linux/module.h>
 #include <linux/platform_device.h>
 #include <linux/resource.h>
 #include <linux/slab.h>
 #include <linux/spinlock.h>
 #include <pcmcia/ss.h>
 #include <asm/mach-au1x00/au1000.h>
 #include <asm/mach-db1x00/bcsr.h>
 #define MEM_MAP_SIZE	0x400000
 #define IO_MAP_SIZE	0x1000
 struct db1x_pcmcia_sock {
 	struct pcmcia_socket	socket;
 	int		nr;		/* socket number */
 	void		*virt_io;
 	phys_addr_t	phys_io;
 	phys_addr_t	phys_attr;
 	phys_addr_t	phys_mem;
 	/* previous flags for set_socket() */
 	unsigned int old_flags;
 	/* interrupt sources: linux irq numbers! */
 	int	insert_irq;	/* default carddetect irq */
 	int	stschg_irq;	/* card-status-change irq */
 	int	card_irq;	/* card irq */
 	int	eject_irq;	/* db1200/pb1200 have these */
 #define BOARD_TYPE_DEFAULT	0	/* most boards */
 #define BOARD_TYPE_DB1200	1	/* IRQs aren't gpios */
 #define BOARD_TYPE_PB1100	2	/* VS bits slightly different */
 #define BOARD_TYPE_DB1300	3	/* no power control */
 	int	board_type;
 };
 #define to_db1x_socket(x) container_of(x, struct db1x_pcmcia_sock, socket)
 static int db1300_card_inserted(struct db1x_pcmcia_sock *sock)
 {
 	return bcsr_read(BCSR_SIGSTAT) & (1 << 8);
 }
 /* DB/PB1200: check CPLD SIGSTATUS register bit 10/12 */
 static int db1200_card_inserted(struct db1x_pcmcia_sock *sock)
 {
 	unsigned short sigstat;
 	sigstat = bcsr_read(BCSR_SIGSTAT);
 	return sigstat & 1 << (8 + 2 * sock->nr);
 }
 /* carddetect gpio: low-active */
 static int db1000_card_inserted(struct db1x_pcmcia_sock *sock)
 {
 	return !gpio_get_value(irq_to_gpio(sock->insert_irq));
 }
 static int db1x_card_inserted(struct db1x_pcmcia_sock *sock)
 {
 	switch (sock->board_type) {
 	case BOARD_TYPE_DB1200:
 		return db1200_card_inserted(sock);
 	case BOARD_TYPE_DB1300:
 		return db1300_card_inserted(sock);
 	default:
 		return db1000_card_inserted(sock);
 	}
 }
 /* STSCHG tends to bounce heavily when cards are inserted/ejected.
  * To avoid this, the interrupt is normally disabled and only enabled
  * after reset to a card has been de-asserted.
  */
 static inline void set_stschg(struct db1x_pcmcia_sock *sock, int en)
 {
 	if (sock->stschg_irq != -1) {
 		if (en)
 			enable_irq(sock->stschg_irq);
 		else
 			disable_irq(sock->stschg_irq);
 	}
 }
 static irqreturn_t db1000_pcmcia_cdirq(int irq, void *data)
 {
 	struct db1x_pcmcia_sock *sock = data;
 	pcmcia_parse_events(&sock->socket, SS_DETECT);
 	return IRQ_HANDLED;
 }
 static irqreturn_t db1000_pcmcia_stschgirq(int irq, void *data)
 {
 	struct db1x_pcmcia_sock *sock = data;
 	pcmcia_parse_events(&sock->socket, SS_STSCHG);
 	return IRQ_HANDLED;
 }
 static irqreturn_t db1200_pcmcia_cdirq(int irq, void *data)
 {
 	struct db1x_pcmcia_sock *sock = data;
 	/* Db/Pb1200 have separate per-socket insertion and ejection
 	 * interrupts which stay asserted as long as the card is
 	 * inserted/missing.  The one which caused us to be called
 	 * needs to be disabled and the other one enabled.
 	 */
 	if (irq == sock->insert_irq) {
 		disable_irq_nosync(sock->insert_irq);
 		enable_irq(sock->eject_irq);
 	} else {
 		disable_irq_nosync(sock->eject_irq);
 		enable_irq(sock->insert_irq);
 	}
 	pcmcia_parse_events(&sock->socket, SS_DETECT);
 	return IRQ_HANDLED;
 }
 static int db1x_pcmcia_setup_irqs(struct db1x_pcmcia_sock *sock)
 {
 	int ret;
 	if (sock->stschg_irq != -1) {
 		ret = request_irq(sock->stschg_irq, db1000_pcmcia_stschgirq,
 				  0, "pcmcia_stschg", sock);
 		if (ret)
 			return ret;
 	}
 	/* Db/Pb1200 have separate per-socket insertion and ejection
 	 * interrupts, which should show edge behaviour but don't.
 	 * So interrupts are disabled until both insertion and
 	 * ejection handler have been registered and the currently
 	 * active one disabled.
 	 */
 	if ((sock->board_type == BOARD_TYPE_DB1200) ||
 	    (sock->board_type == BOARD_TYPE_DB1300)) {
 		ret = request_irq(sock->insert_irq, db1200_pcmcia_cdirq,
 				  0, "pcmcia_insert", sock);
 		if (ret)
 			goto out1;
 		ret = request_irq(sock->eject_irq, db1200_pcmcia_cdirq,
 				  0, "pcmcia_eject", sock);
 		if (ret) {
 			free_irq(sock->insert_irq, sock);
 			goto out1;
 		}
 		/* enable the currently silent one */
 		if (db1x_card_inserted(sock))
 			enable_irq(sock->eject_irq);
 		else
 			enable_irq(sock->insert_irq);
 	} else {
 		/* all other (older) Db1x00 boards use a GPIO to show
 		 * card detection status:  use both-edge triggers.
 		 */
 		irq_set_irq_type(sock->insert_irq, IRQ_TYPE_EDGE_BOTH);
 		ret = request_irq(sock->insert_irq, db1000_pcmcia_cdirq,
 				  0, "pcmcia_carddetect", sock);
 		if (ret)
 			goto out1;
 	}
 	return 0;	/* all done */
 out1:
 	if (sock->stschg_irq != -1)
 		free_irq(sock->stschg_irq, sock);
 	return ret;
 }
 static void db1x_pcmcia_free_irqs(struct db1x_pcmcia_sock *sock)
 {
 	if (sock->stschg_irq != -1)
 		free_irq(sock->stschg_irq, sock);
 	free_irq(sock->insert_irq, sock);
 	if (sock->eject_irq != -1)
 		free_irq(sock->eject_irq, sock);
 }
 /*
  * configure a PCMCIA socket on the Db1x00 series of boards (and
  * compatibles).
  *
  * 2 external registers are involved:
  *   pcmcia_status (offset 0x04): bits [0:1/2:3]: read card voltage id
  *   pcmcia_control(offset 0x10):
  *	bits[0:1] set vcc for card
  *	bits[2:3] set vpp for card
  *	bit 4:	enable data buffers
  *	bit 7:	reset# for card
  *	add 8 for second socket.
  */
 static int db1x_pcmcia_configure(struct pcmcia_socket *skt,
 				 struct socket_state_t *state)
 {
 	struct db1x_pcmcia_sock *sock = to_db1x_socket(skt);
 	unsigned short cr_clr, cr_set;
 	unsigned int changed;
 	int v, p, ret;
 	/* card voltage setup */
 	cr_clr = (0xf << (sock->nr * 8)); /* clear voltage settings */
 	cr_set = 0;
 	v = p = ret = 0;
 	switch (state->Vcc) {
 	case 50:
 		++v;
 	case 33:
 		++v;
 	case 0:
 		break;
 	default:
 		printk(KERN_INFO "pcmcia%d unsupported Vcc %d\n",
 			sock->nr, state->Vcc);
 	}
 	switch (state->Vpp) {
 	case 12:
 		++p;
 	case 33:
 	case 50:
 		++p;
 	case 0:
 		break;
 	default:
 		printk(KERN_INFO "pcmcia%d unsupported Vpp %d\n",
 			sock->nr, state->Vpp);
 	}
 	/* sanity check: Vpp must be 0, 12, or Vcc */
 	if (((state->Vcc == 33) && (state->Vpp == 50)) ||
 	    ((state->Vcc == 50) && (state->Vpp == 33))) {
 		printk(KERN_INFO "pcmcia%d bad Vcc/Vpp combo (%d %d)\n",
 			sock->nr, state->Vcc, state->Vpp);
 		v = p = 0;
 		ret = -EINVAL;
 	}
 	/* create new voltage code */
 	if (sock->board_type != BOARD_TYPE_DB1300)
 		cr_set |= ((v << 2) | p) << (sock->nr * 8);
 	changed = state->flags ^ sock->old_flags;
 	if (changed & SS_RESET) {
 		if (state->flags & SS_RESET) {
 			set_stschg(sock, 0);
 			/* assert reset, disable io buffers */
 			cr_clr |= (1 << (7 + (sock->nr * 8)));
 			cr_clr |= (1 << (4 + (sock->nr * 8)));
 		} else {
 			/* de-assert reset, enable io buffers */
 			cr_set |= 1 << (7 + (sock->nr * 8));
 			cr_set |= 1 << (4 + (sock->nr * 8));
 		}
 	}
 	/* update PCMCIA configuration */
 	bcsr_mod(BCSR_PCMCIA, cr_clr, cr_set);
 	sock->old_flags = state->flags;
 	/* reset was taken away: give card time to initialize properly */
 	if ((changed & SS_RESET) && !(state->flags & SS_RESET)) {
 		msleep(500);
 		set_stschg(sock, 1);
 	}
 	return ret;
 }
 /* VCC bits at [3:2]/[11:10] */
 #define GET_VCC(cr, socknr)		\
 	((((cr) >> 2) >> ((socknr) * 8)) & 3)
 /* VS bits at [0:1]/[3:2] */
 #define GET_VS(sr, socknr)		\
 	(((sr) >> (2 * (socknr))) & 3)
 /* reset bits at [7]/[15] */
 #define GET_RESET(cr, socknr)		\
 	((cr) & (1 << (7 + (8 * (socknr)))))
 static int db1x_pcmcia_get_status(struct pcmcia_socket *skt,
 				  unsigned int *value)
 {
 	struct db1x_pcmcia_sock *sock = to_db1x_socket(skt);
 	unsigned short cr, sr;
 	unsigned int status;
 	status = db1x_card_inserted(sock) ? SS_DETECT : 0;
 	cr = bcsr_read(BCSR_PCMCIA);
 	sr = bcsr_read(BCSR_STATUS);
 	/* PB1100/PB1500: voltage key bits are at [5:4] */
 	if (sock->board_type == BOARD_TYPE_PB1100)
 		sr >>= 4;
 	/* determine card type */
 	switch (GET_VS(sr, sock->nr)) {
 	case 0:
 	case 2:
 		status |= SS_3VCARD;	/* 3V card */
 	case 3:
 		break;			/* 5V card: set nothing */
 	default:
 		status |= SS_XVCARD;	/* treated as unsupported in core */
 	}
 	/* if Vcc is not zero, we have applied power to a card */
 	status |= GET_VCC(cr, sock->nr) ? SS_POWERON : 0;
 	/* DB1300: power always on, but don't tell when no card present */
 	if ((sock->board_type == BOARD_TYPE_DB1300) && (status & SS_DETECT))
 		status = SS_POWERON | SS_3VCARD | SS_DETECT;
 	/* reset de-asserted? then we're ready */
 	status |= (GET_RESET(cr, sock->nr)) ? SS_READY : SS_RESET;
 	*value = status;
 	return 0;
 }
 static int db1x_pcmcia_sock_init(struct pcmcia_socket *skt)
 {
 	return 0;
 }
 static int db1x_pcmcia_sock_suspend(struct pcmcia_socket *skt)
 {
 	return 0;
 }
 static int au1x00_pcmcia_set_io_map(struct pcmcia_socket *skt,
 				    struct pccard_io_map *map)
 {
 	struct db1x_pcmcia_sock *sock = to_db1x_socket(skt);
 	map->start = (u32)sock->virt_io;
 	map->stop = map->start + IO_MAP_SIZE;
 	return 0;
 }
 static int au1x00_pcmcia_set_mem_map(struct pcmcia_socket *skt,
 				     struct pccard_mem_map *map)
 {
 	struct db1x_pcmcia_sock *sock = to_db1x_socket(skt);
 	if (map->flags & MAP_ATTRIB)
 		map->static_start = sock->phys_attr + map->card_start;
 	else
 		map->static_start = sock->phys_mem + map->card_start;
 	return 0;
 }
 static struct pccard_operations db1x_pcmcia_operations = {
 	.init			= db1x_pcmcia_sock_init,
 	.suspend		= db1x_pcmcia_sock_suspend,
 	.get_status		= db1x_pcmcia_get_status,
 	.set_socket		= db1x_pcmcia_configure,
 	.set_io_map		= au1x00_pcmcia_set_io_map,
 	.set_mem_map		= au1x00_pcmcia_set_mem_map,
 };
 static int __devinit db1x_pcmcia_socket_probe(struct platform_device *pdev)
 {
 	struct db1x_pcmcia_sock *sock;
 	struct resource *r;
 	int ret, bid;
 	sock = kzalloc(sizeof(struct db1x_pcmcia_sock), GFP_KERNEL);
 	if (!sock)
 		return -ENOMEM;
 	sock->nr = pdev->id;
 	bid = BCSR_WHOAMI_BOARD(bcsr_read(BCSR_WHOAMI));
 	switch (bid) {
 	case BCSR_WHOAMI_PB1500:
 	case BCSR_WHOAMI_PB1500R2:
 	case BCSR_WHOAMI_PB1100:
 		sock->board_type = BOARD_TYPE_PB1100;
 		break;
 	case BCSR_WHOAMI_DB1000 ... BCSR_WHOAMI_PB1550_SDR:
 		sock->board_type = BOARD_TYPE_DEFAULT;
 		break;
 	case BCSR_WHOAMI_PB1200 ... BCSR_WHOAMI_DB1200:
 		sock->board_type = BOARD_TYPE_DB1200;
 		break;
 	case BCSR_WHOAMI_DB1300:
 		sock->board_type = BOARD_TYPE_DB1300;
 		break;
 	default:
 		printk(KERN_INFO "db1xxx-ss: unknown board %d!\n", bid);
 		ret = -ENODEV;
 		goto out0;
 	};
 	/*
 	 * gather resources necessary and optional nice-to-haves to
 	 * operate a socket:
 	 * This includes IRQs for Carddetection/ejection, the card
 	 *  itself and optional status change detection.
 	 * Also, the memory areas covered by a socket.  For these
 	 *  we require the real 36bit addresses (see the au1000.h
 	 *  header for more information).
 	 */
 	/* card: irq assigned to the card itself. */
 	r = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "card");
 	sock->card_irq = r ? r->start : 0;
 	/* insert: irq which triggers on card insertion/ejection */
 	r = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "insert");
 	sock->insert_irq = r ? r->start : -1;
 	/* stschg: irq which trigger on card status change (optional) */
 	r = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "stschg");
 	sock->stschg_irq = r ? r->start : -1;
 	/* eject: irq which triggers on ejection (DB1200/PB1200 only) */
 	r = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "eject");
 	sock->eject_irq = r ? r->start : -1;
 	ret = -ENODEV;
 	/* 36bit PCMCIA Attribute area address */
 	r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pcmcia-attr");
 	if (!r) {
 		printk(KERN_ERR "pcmcia%d has no 'pseudo-attr' resource!\n",
 			sock->nr);
 		goto out0;
 	}
 	sock->phys_attr = r->start;
 	/* 36bit PCMCIA Memory area address */
 	r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pcmcia-mem");
 	if (!r) {
 		printk(KERN_ERR "pcmcia%d has no 'pseudo-mem' resource!\n",
 			sock->nr);
 		goto out0;
 	}
 	sock->phys_mem = r->start;
 	/* 36bit PCMCIA IO area address */
 	r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pcmcia-io");
 	if (!r) {
 		printk(KERN_ERR "pcmcia%d has no 'pseudo-io' resource!\n",
 			sock->nr);
 		goto out0;
 	}
 	sock->phys_io = r->start;
 	/*
 	 * PCMCIA client drivers use the inb/outb macros to access
 	 * the IO registers.  Since mips_io_port_base is added
 	 * to the access address of the mips implementation of
 	 * inb/outb, we need to subtract it here because we want
 	 * to access the I/O or MEM address directly, without
 	 * going through this "mips_io_port_base" mechanism.
 	 */
 	sock->virt_io = (void *)(ioremap(sock->phys_io, IO_MAP_SIZE) -
 				 mips_io_port_base);
 	if (!sock->virt_io) {
 		printk(KERN_ERR "pcmcia%d: cannot remap IO area\n",
 			sock->nr);
 		ret = -ENOMEM;
 		goto out0;
 	}
 	sock->socket.ops	= &db1x_pcmcia_operations;
 	sock->socket.owner	= THIS_MODULE;
 	sock->socket.pci_irq	= sock->card_irq;
 	sock->socket.features	= SS_CAP_STATIC_MAP | SS_CAP_PCCARD;
 	sock->socket.map_size	= MEM_MAP_SIZE;
 	sock->socket.io_offset	= (unsigned long)sock->virt_io;
 	sock->socket.dev.parent	= &pdev->dev;
 	sock->socket.resource_ops = &pccard_static_ops;
 	platform_set_drvdata(pdev, sock);
 	ret = db1x_pcmcia_setup_irqs(sock);
 	if (ret) {
 		printk(KERN_ERR "pcmcia%d cannot setup interrupts\n",
 			sock->nr);
 		goto out1;
 	}
 	set_stschg(sock, 0);
 	ret = pcmcia_register_socket(&sock->socket);
 	if (ret) {
 		printk(KERN_ERR "pcmcia%d failed to register\n", sock->nr);
 		goto out2;
 	}
 	printk(KERN_INFO "Alchemy Db/Pb1xxx pcmcia%d @ io/attr/mem %09llx"
 		"(%p) %09llx %09llx  card/insert/stschg/eject irqs @ %d "
 		"%d %d %d\n", sock->nr, sock->phys_io, sock->virt_io,
 		sock->phys_attr, sock->phys_mem, sock->card_irq,
 		sock->insert_irq, sock->stschg_irq, sock->eject_irq);
 	return 0;
 out2:
 	db1x_pcmcia_free_irqs(sock);
 out1:
 	iounmap((void *)(sock->virt_io + (u32)mips_io_port_base));
 out0:
 	kfree(sock);
 	return ret;
 }
 static int __devexit db1x_pcmcia_socket_remove(struct platform_device *pdev)
 {
 	struct db1x_pcmcia_sock *sock = platform_get_drvdata(pdev);
 	db1x_pcmcia_free_irqs(sock);
 	pcmcia_unregister_socket(&sock->socket);
 	iounmap((void *)(sock->virt_io + (u32)mips_io_port_base));
 	kfree(sock);
 	return 0;
 }
 static struct platform_driver db1x_pcmcia_socket_driver = {
 	.driver	= {
 		.name	= "db1xxx_pcmcia",
 		.owner	= THIS_MODULE,
 	},
 	.probe		= db1x_pcmcia_socket_probe,
 	.remove		= __devexit_p(db1x_pcmcia_socket_remove),
 };
-int __init db1x_pcmcia_socket_load(void)
+module_platform_driver(db1x_pcmcia_socket_driver);
-{
-	return platform_driver_register(&db1x_pcmcia_socket_driver);
-}
-void  __exit db1x_pcmcia_socket_unload(void)
-{
-	platform_driver_unregister(&db1x_pcmcia_socket_driver);
-}
-module_init(db1x_pcmcia_socket_load);
-module_exit(db1x_pcmcia_socket_unload);
 MODULE_LICENSE("GPL");
 MODULE_DESCRIPTION("PCMCIA Socket Services for Alchemy Db/Pb1x00 boards");
 MODULE_AUTHOR("Manuel Lauss");

drivers/pcmcia/electra_cf.c

Diff comments View file @ 5d95f8e

 /*
  * Copyright (C) 2007 PA Semi, Inc
  *
  * Maintained by: Olof Johansson <olof@lixom.net>
  *
  * Based on drivers/pcmcia/omap_cf.c
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
  * the Free Software Foundation; either version 2 of the License, or
  * (at your option) any later version.
  *
  * This program is distributed in the hope that it will be useful,
  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  * GNU General Public License for more details.
  *
  * You should have received a copy of the GNU General Public License
  * along with this program; if not, write to the Free Software
  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  */
 #include <linux/module.h>
 #include <linux/kernel.h>
 #include <linux/sched.h>
 #include <linux/platform_device.h>
 #include <linux/errno.h>
 #include <linux/init.h>
 #include <linux/delay.h>
 #include <linux/interrupt.h>
 #include <linux/mm.h>
 #include <linux/vmalloc.h>
 #include <linux/of_platform.h>
 #include <linux/slab.h>
 #include <pcmcia/ss.h>
 static const char driver_name[] = "electra-cf";
 struct electra_cf_socket {
 	struct pcmcia_socket	socket;
 	struct timer_list	timer;
 	unsigned		present:1;
 	unsigned		active:1;
 	struct platform_device	*ofdev;
 	unsigned long		mem_phys;
 	void __iomem *		mem_base;
 	unsigned long		mem_size;
 	void __iomem *		io_virt;
 	unsigned int		io_base;
 	unsigned int		io_size;
 	u_int			irq;
 	struct resource		iomem;
 	void __iomem *		gpio_base;
 	int			gpio_detect;
 	int			gpio_vsense;
 	int			gpio_3v;
 	int			gpio_5v;
 };
 #define	POLL_INTERVAL		(2 * HZ)
 static int electra_cf_present(struct electra_cf_socket *cf)
 {
 	unsigned int gpio;
 	gpio = in_le32(cf->gpio_base+0x40);
 	return !(gpio & (1 << cf->gpio_detect));
 }
 static int electra_cf_ss_init(struct pcmcia_socket *s)
 {
 	return 0;
 }
 /* the timer is primarily to kick this socket's pccardd */
 static void electra_cf_timer(unsigned long _cf)
 {
 	struct electra_cf_socket *cf = (void *) _cf;
 	int present = electra_cf_present(cf);
 	if (present != cf->present) {
 		cf->present = present;
 		pcmcia_parse_events(&cf->socket, SS_DETECT);
 	}
 	if (cf->active)
 		mod_timer(&cf->timer, jiffies + POLL_INTERVAL);
 }
 static irqreturn_t electra_cf_irq(int irq, void *_cf)
 {
 	electra_cf_timer((unsigned long)_cf);
 	return IRQ_HANDLED;
 }
 static int electra_cf_get_status(struct pcmcia_socket *s, u_int *sp)
 {
 	struct electra_cf_socket *cf;
 	if (!sp)
 		return -EINVAL;
 	cf = container_of(s, struct electra_cf_socket, socket);
 	/* NOTE CF is always 3VCARD */
 	if (electra_cf_present(cf)) {
 		*sp = SS_READY | SS_DETECT | SS_POWERON | SS_3VCARD;
 		s->pci_irq = cf->irq;
 	} else
 		*sp = 0;
 	return 0;
 }
 static int electra_cf_set_socket(struct pcmcia_socket *sock,
 				 struct socket_state_t *s)
 {
 	unsigned int gpio;
 	unsigned int vcc;
 	struct electra_cf_socket *cf;
 	cf = container_of(sock, struct electra_cf_socket, socket);
 	/* "reset" means no power in our case */
 	vcc = (s->flags & SS_RESET) ? 0 : s->Vcc;
 	switch (vcc) {
 	case 0:
 		gpio = 0;
 		break;
 	case 33:
 		gpio = (1 << cf->gpio_3v);
 		break;
 	case 5:
 		gpio = (1 << cf->gpio_5v);
 		break;
 	default:
 		return -EINVAL;
 	}
 	gpio |= 1 << (cf->gpio_3v + 16); /* enwr */
 	gpio |= 1 << (cf->gpio_5v + 16); /* enwr */
 	out_le32(cf->gpio_base+0x90, gpio);
 	pr_debug("%s: Vcc %d, io_irq %d, flags %04x csc %04x\n",
 		driver_name, s->Vcc, s->io_irq, s->flags, s->csc_mask);
 	return 0;
 }
 static int electra_cf_set_io_map(struct pcmcia_socket *s,
 				 struct pccard_io_map *io)
 {
 	return 0;
 }
 static int electra_cf_set_mem_map(struct pcmcia_socket *s,
 				  struct pccard_mem_map *map)
 {
 	struct electra_cf_socket *cf;
 	if (map->card_start)
 		return -EINVAL;
 	cf = container_of(s, struct electra_cf_socket, socket);
 	map->static_start = cf->mem_phys;
 	map->flags &= MAP_ACTIVE|MAP_ATTRIB;
 	if (!(map->flags & MAP_ATTRIB))
 		map->static_start += 0x800;
 	return 0;
 }
 static struct pccard_operations electra_cf_ops = {
 	.init			= electra_cf_ss_init,
 	.get_status		= electra_cf_get_status,
 	.set_socket		= electra_cf_set_socket,
 	.set_io_map		= electra_cf_set_io_map,
 	.set_mem_map		= electra_cf_set_mem_map,
 };
 static int __devinit electra_cf_probe(struct platform_device *ofdev)
 {
 	struct device *device = &ofdev->dev;
 	struct device_node *np = ofdev->dev.of_node;
 	struct electra_cf_socket   *cf;
 	struct resource mem, io;
 	int status;
 	const unsigned int *prop;
 	int err;
 	struct vm_struct *area;
 	err = of_address_to_resource(np, 0, &mem);
 	if (err)
 		return -EINVAL;
 	err = of_address_to_resource(np, 1, &io);
 	if (err)
 		return -EINVAL;
 	cf = kzalloc(sizeof *cf, GFP_KERNEL);
 	if (!cf)
 		return -ENOMEM;
 	setup_timer(&cf->timer, electra_cf_timer, (unsigned long)cf);
 	cf->irq = NO_IRQ;
 	cf->ofdev = ofdev;
 	cf->mem_phys = mem.start;
 	cf->mem_size = PAGE_ALIGN(resource_size(&mem));
 	cf->mem_base = ioremap(cf->mem_phys, cf->mem_size);
 	cf->io_size = PAGE_ALIGN(resource_size(&io));
 	area = __get_vm_area(cf->io_size, 0, PHB_IO_BASE, PHB_IO_END);
 	if (area == NULL)
 		return -ENOMEM;
 	cf->io_virt = (void __iomem *)(area->addr);
 	cf->gpio_base = ioremap(0xfc103000, 0x1000);
 	dev_set_drvdata(device, cf);
 	if (!cf->mem_base || !cf->io_virt || !cf->gpio_base ||
 	    (__ioremap_at(io.start, cf->io_virt, cf->io_size,
 		_PAGE_NO_CACHE | _PAGE_GUARDED) == NULL)) {
 		dev_err(device, "can't ioremap ranges\n");
 		status = -ENOMEM;
 		goto fail1;
 	}
 	cf->io_base = (unsigned long)cf->io_virt - VMALLOC_END;
 	cf->iomem.start = (unsigned long)cf->mem_base;
 	cf->iomem.end = (unsigned long)cf->mem_base + (mem.end - mem.start);
 	cf->iomem.flags = IORESOURCE_MEM;
 	cf->irq = irq_of_parse_and_map(np, 0);
 	status = request_irq(cf->irq, electra_cf_irq, IRQF_SHARED,
 			     driver_name, cf);
 	if (status < 0) {
 		dev_err(device, "request_irq failed\n");
 		goto fail1;
 	}
 	cf->socket.pci_irq = cf->irq;
 	prop = of_get_property(np, "card-detect-gpio", NULL);
 	if (!prop)
 		goto fail1;
 	cf->gpio_detect = *prop;
 	prop = of_get_property(np, "card-vsense-gpio", NULL);
 	if (!prop)
 		goto fail1;
 	cf->gpio_vsense = *prop;
 	prop = of_get_property(np, "card-3v-gpio", NULL);
 	if (!prop)
 		goto fail1;
 	cf->gpio_3v = *prop;
 	prop = of_get_property(np, "card-5v-gpio", NULL);
 	if (!prop)
 		goto fail1;
 	cf->gpio_5v = *prop;
 	cf->socket.io_offset = cf->io_base;
 	/* reserve chip-select regions */
 	if (!request_mem_region(cf->mem_phys, cf->mem_size, driver_name)) {
 		status = -ENXIO;
 		dev_err(device, "Can't claim memory region\n");
 		goto fail1;
 	}
 	if (!request_region(cf->io_base, cf->io_size, driver_name)) {
 		status = -ENXIO;
 		dev_err(device, "Can't claim I/O region\n");
 		goto fail2;
 	}
 	cf->socket.owner = THIS_MODULE;
 	cf->socket.dev.parent = &ofdev->dev;
 	cf->socket.ops = &electra_cf_ops;
 	cf->socket.resource_ops = &pccard_static_ops;
 	cf->socket.features = SS_CAP_PCCARD | SS_CAP_STATIC_MAP |
 				SS_CAP_MEM_ALIGN;
 	cf->socket.map_size = 0x800;
 	status = pcmcia_register_socket(&cf->socket);
 	if (status < 0) {
 		dev_err(device, "pcmcia_register_socket failed\n");
 		goto fail3;
 	}
 	dev_info(device, "at mem 0x%lx io 0x%llx irq %d\n",
 		 cf->mem_phys, io.start, cf->irq);
 	cf->active = 1;
 	electra_cf_timer((unsigned long)cf);
 	return 0;
 fail3:
 	release_region(cf->io_base, cf->io_size);
 fail2:
 	release_mem_region(cf->mem_phys, cf->mem_size);
 fail1:
 	if (cf->irq != NO_IRQ)
 		free_irq(cf->irq, cf);
 	if (cf->io_virt)
 		__iounmap_at(cf->io_virt, cf->io_size);
 	if (cf->mem_base)
 		iounmap(cf->mem_base);
 	if (cf->gpio_base)
 		iounmap(cf->gpio_base);
 	device_init_wakeup(&ofdev->dev, 0);
 	kfree(cf);
 	return status;
 }
 static int __devexit electra_cf_remove(struct platform_device *ofdev)
 {
 	struct device *device = &ofdev->dev;
 	struct electra_cf_socket *cf;
 	cf = dev_get_drvdata(device);
 	cf->active = 0;
 	pcmcia_unregister_socket(&cf->socket);
 	free_irq(cf->irq, cf);
 	del_timer_sync(&cf->timer);
 	__iounmap_at(cf->io_virt, cf->io_size);
 	iounmap(cf->mem_base);
 	iounmap(cf->gpio_base);
 	release_mem_region(cf->mem_phys, cf->mem_size);
 	release_region(cf->io_base, cf->io_size);
 	kfree(cf);
 	return 0;
 }
 static const struct of_device_id electra_cf_match[] = {
 	{
 		.compatible   = "electra-cf",
 	},
 	{},
 };
 MODULE_DEVICE_TABLE(of, electra_cf_match);
 static struct platform_driver electra_cf_driver = {
 	.driver = {
 		.name = (char *)driver_name,
 		.owner = THIS_MODULE,
 		.of_match_table = electra_cf_match,
 	},
 	.probe	  = electra_cf_probe,
 	.remove   = electra_cf_remove,
 };
-static int __init electra_cf_init(void)
+module_platform_driver(electra_cf_driver);
-{
-	return platform_driver_register(&electra_cf_driver);
-}
-module_init(electra_cf_init);
-static void __exit electra_cf_exit(void)
-{
-	platform_driver_unregister(&electra_cf_driver);
-}
-module_exit(electra_cf_exit);
 MODULE_LICENSE("GPL");
 MODULE_AUTHOR ("Olof Johansson <olof@lixom.net>");
 MODULE_DESCRIPTION("PA Semi Electra CF driver");

drivers/pcmcia/m8xx_pcmcia.c

Diff comments View file @ 5d95f8e

 /*
  * m8xx_pcmcia.c - Linux PCMCIA socket driver for the mpc8xx series.
  *
  * (C) 1999-2000 Magnus Damm <damm@opensource.se>
  * (C) 2001-2002 Montavista Software, Inc.
  *     <mlocke@mvista.com>
  *
  * Support for two slots by Cyclades Corporation
  *     <oliver.kurth@cyclades.de>
  * Further fixes, v2.6 kernel port
  *     <marcelo.tosatti@cyclades.com>
  *
  * Some fixes, additions (C) 2005-2007 Montavista Software, Inc.
  *     <vbordug@ru.mvista.com>
  *
  * "The ExCA standard specifies that socket controllers should provide
  * two IO and five memory windows per socket, which can be independently
  * configured and positioned in the host address space and mapped to
  * arbitrary segments of card address space. " - David A Hinds. 1999
  *
  * This controller does _not_ meet the ExCA standard.
  *
  * m8xx pcmcia controller brief info:
  * + 8 windows (attrib, mem, i/o)
  * + up to two slots (SLOT_A and SLOT_B)
  * + inputpins, outputpins, event and mask registers.
  * - no offset register. sigh.
  *
  * Because of the lacking offset register we must map the whole card.
  * We assign each memory window PCMCIA_MEM_WIN_SIZE address space.
  * Make sure there is (PCMCIA_MEM_WIN_SIZE * PCMCIA_MEM_WIN_NO
  * * PCMCIA_SOCKETS_NO) bytes at PCMCIA_MEM_WIN_BASE.
  * The i/o windows are dynamically allocated at PCMCIA_IO_WIN_BASE.
  * They are maximum 64KByte each...
  */
 #include <linux/module.h>
 #include <linux/init.h>
 #include <linux/types.h>
 #include <linux/fcntl.h>
 #include <linux/string.h>
 #include <linux/kernel.h>
 #include <linux/errno.h>
 #include <linux/timer.h>
 #include <linux/ioport.h>
 #include <linux/delay.h>
 #include <linux/interrupt.h>
 #include <linux/fsl_devices.h>
 #include <linux/bitops.h>
 #include <linux/of_device.h>
 #include <linux/of_platform.h>
 #include <asm/io.h>
 #include <asm/system.h>
 #include <asm/time.h>
 #include <asm/mpc8xx.h>
 #include <asm/8xx_immap.h>
 #include <asm/irq.h>
 #include <asm/fs_pd.h>
 #include <pcmcia/ss.h>
 #define pcmcia_info(args...) printk(KERN_INFO "m8xx_pcmcia: "args)
 #define pcmcia_error(args...) printk(KERN_ERR "m8xx_pcmcia: "args)
 static const char *version = "Version 0.06, Aug 2005";
 MODULE_LICENSE("Dual MPL/GPL");
 #if !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B)
 /* The RPX series use SLOT_B */
 #if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
 #define CONFIG_PCMCIA_SLOT_B
 #define CONFIG_BD_IS_MHZ
 #endif
 /* The ADS board use SLOT_A */
 #ifdef CONFIG_ADS
 #define CONFIG_PCMCIA_SLOT_A
 #define CONFIG_BD_IS_MHZ
 #endif
 /* The FADS series are a mess */
 #ifdef CONFIG_FADS
 #if defined(CONFIG_MPC860T) || defined(CONFIG_MPC860) || defined(CONFIG_MPC821)
 #define CONFIG_PCMCIA_SLOT_A
 #else
 #define CONFIG_PCMCIA_SLOT_B
 #endif
 #endif
 #if defined(CONFIG_MPC885ADS)
 #define CONFIG_PCMCIA_SLOT_A
 #define PCMCIA_GLITCHY_CD
 #endif
 /* Cyclades ACS uses both slots */
 #ifdef CONFIG_PRxK
 #define CONFIG_PCMCIA_SLOT_A
 #define CONFIG_PCMCIA_SLOT_B
 #endif
 #endif				/* !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B) */
 #if defined(CONFIG_PCMCIA_SLOT_A) && defined(CONFIG_PCMCIA_SLOT_B)
 #define PCMCIA_SOCKETS_NO 2
 /* We have only 8 windows, dualsocket support will be limited. */
 #define PCMCIA_MEM_WIN_NO 2
 #define PCMCIA_IO_WIN_NO  2
 #define PCMCIA_SLOT_MSG "SLOT_A and SLOT_B"
 #elif defined(CONFIG_PCMCIA_SLOT_A) || defined(CONFIG_PCMCIA_SLOT_B)
 #define PCMCIA_SOCKETS_NO 1
 /* full support for one slot */
 #define PCMCIA_MEM_WIN_NO 5
 #define PCMCIA_IO_WIN_NO  2
 /* define _slot_ to be able to optimize macros */
 #ifdef CONFIG_PCMCIA_SLOT_A
 #define _slot_ 0
 #define PCMCIA_SLOT_MSG "SLOT_A"
 #else
 #define _slot_ 1
 #define PCMCIA_SLOT_MSG "SLOT_B"
 #endif
 #else
 #error m8xx_pcmcia: Bad configuration!
 #endif
 /* ------------------------------------------------------------------------- */
 #define PCMCIA_MEM_WIN_BASE 0xe0000000	/* base address for memory window 0   */
 #define PCMCIA_MEM_WIN_SIZE 0x04000000	/* each memory window is 64 MByte     */
 #define PCMCIA_IO_WIN_BASE  _IO_BASE	/* base address for io window 0       */
 /* ------------------------------------------------------------------------- */
 static int pcmcia_schlvl;
 static DEFINE_SPINLOCK(events_lock);
 #define PCMCIA_SOCKET_KEY_5V 1
 #define PCMCIA_SOCKET_KEY_LV 2
 /* look up table for pgcrx registers */
 static u32 *m8xx_pgcrx[2];
 /*
  * This structure is used to address each window in the PCMCIA controller.
  *
  * Keep in mind that we assume that pcmcia_win[n+1] is mapped directly
  * after pcmcia_win[n]...
  */
 struct pcmcia_win {
 	u32 br;
 	u32 or;
 };
 /*
  * For some reason the hardware guys decided to make both slots share
  * some registers.
  *
  * Could someone invent object oriented hardware ?
  *
  * The macros are used to get the right bit from the registers.
  * SLOT_A : slot = 0
  * SLOT_B : slot = 1
  */
 #define M8XX_PCMCIA_VS1(slot)      (0x80000000 >> (slot << 4))
 #define M8XX_PCMCIA_VS2(slot)      (0x40000000 >> (slot << 4))
 #define M8XX_PCMCIA_VS_MASK(slot)  (0xc0000000 >> (slot << 4))
 #define M8XX_PCMCIA_VS_SHIFT(slot) (30 - (slot << 4))
 #define M8XX_PCMCIA_WP(slot)       (0x20000000 >> (slot << 4))
 #define M8XX_PCMCIA_CD2(slot)      (0x10000000 >> (slot << 4))
 #define M8XX_PCMCIA_CD1(slot)      (0x08000000 >> (slot << 4))
 #define M8XX_PCMCIA_BVD2(slot)     (0x04000000 >> (slot << 4))
 #define M8XX_PCMCIA_BVD1(slot)     (0x02000000 >> (slot << 4))
 #define M8XX_PCMCIA_RDY(slot)      (0x01000000 >> (slot << 4))
 #define M8XX_PCMCIA_RDY_L(slot)    (0x00800000 >> (slot << 4))
 #define M8XX_PCMCIA_RDY_H(slot)    (0x00400000 >> (slot << 4))
 #define M8XX_PCMCIA_RDY_R(slot)    (0x00200000 >> (slot << 4))
 #define M8XX_PCMCIA_RDY_F(slot)    (0x00100000 >> (slot << 4))
 #define M8XX_PCMCIA_MASK(slot)     (0xFFFF0000 >> (slot << 4))
 #define M8XX_PCMCIA_POR_VALID    0x00000001
 #define M8XX_PCMCIA_POR_WRPROT   0x00000002
 #define M8XX_PCMCIA_POR_ATTRMEM  0x00000010
 #define M8XX_PCMCIA_POR_IO       0x00000018
 #define M8XX_PCMCIA_POR_16BIT    0x00000040
 #define M8XX_PGCRX(slot)  m8xx_pgcrx[slot]
 #define M8XX_PGCRX_CXOE    0x00000080
 #define M8XX_PGCRX_CXRESET 0x00000040
 /* we keep one lookup table per socket to check flags */
 #define PCMCIA_EVENTS_MAX 5	/* 4 max at a time + termination */
 struct event_table {
 	u32 regbit;
 	u32 eventbit;
 };
 static const char driver_name[] = "m8xx-pcmcia";
 struct socket_info {
 	void (*handler) (void *info, u32 events);
 	void *info;
 	u32 slot;
 	pcmconf8xx_t *pcmcia;
 	u32 bus_freq;
 	int hwirq;
 	socket_state_t state;
 	struct pccard_mem_map mem_win[PCMCIA_MEM_WIN_NO];
 	struct pccard_io_map io_win[PCMCIA_IO_WIN_NO];
 	struct event_table events[PCMCIA_EVENTS_MAX];
 	struct pcmcia_socket socket;
 };
 static struct socket_info socket[PCMCIA_SOCKETS_NO];
 /*
  * Search this table to see if the windowsize is
  * supported...
  */
 #define M8XX_SIZES_NO 32
 static const u32 m8xx_size_to_gray[M8XX_SIZES_NO] = {
 	0x00000001, 0x00000002, 0x00000008, 0x00000004,
 	0x00000080, 0x00000040, 0x00000010, 0x00000020,
 	0x00008000, 0x00004000, 0x00001000, 0x00002000,
 	0x00000100, 0x00000200, 0x00000800, 0x00000400,
 	0x0fffffff, 0xffffffff, 0xffffffff, 0xffffffff,
 	0x01000000, 0x02000000, 0xffffffff, 0x04000000,
 	0x00010000, 0x00020000, 0x00080000, 0x00040000,
 	0x00800000, 0x00400000, 0x00100000, 0x00200000
 };
 /* ------------------------------------------------------------------------- */
 static irqreturn_t m8xx_interrupt(int irq, void *dev);
 #define PCMCIA_BMT_LIMIT (15*4)	/* Bus Monitor Timeout value */
 /* ------------------------------------------------------------------------- */
 /* board specific stuff:                                                     */
 /* voltage_set(), hardware_enable() and hardware_disable()                   */
 /* ------------------------------------------------------------------------- */
 /* RPX Boards from Embedded Planet                                           */
 #if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
 /* The RPX boards seems to have it's bus monitor timeout set to 6*8 clocks.
  * SYPCR is write once only, therefore must the slowest memory be faster
  * than the bus monitor or we will get a machine check due to the bus timeout.
  */
 #define PCMCIA_BOARD_MSG "RPX CLASSIC or RPX LITE"
 #undef PCMCIA_BMT_LIMIT
 #define PCMCIA_BMT_LIMIT (6*8)
 static int voltage_set(int slot, int vcc, int vpp)
 {
 	u32 reg = 0;
 	switch (vcc) {
 	case 0:
 		break;
 	case 33:
 		reg |= BCSR1_PCVCTL4;
 		break;
 	case 50:
 		reg |= BCSR1_PCVCTL5;
 		break;
 	default:
 		return 1;
 	}
 	switch (vpp) {
 	case 0:
 		break;
 	case 33:
 	case 50:
 		if (vcc == vpp)
 			reg |= BCSR1_PCVCTL6;
 		else
 			return 1;
 		break;
 	case 120:
 		reg |= BCSR1_PCVCTL7;
 	default:
 		return 1;
 	}
 	if (!((vcc == 50) || (vcc == 0)))
 		return 1;
 	/* first, turn off all power */
 	out_be32(((u32 *) RPX_CSR_ADDR),
 		 in_be32(((u32 *) RPX_CSR_ADDR)) & ~(BCSR1_PCVCTL4 |
 						     BCSR1_PCVCTL5 |
 						     BCSR1_PCVCTL6 |
 						     BCSR1_PCVCTL7));
 	/* enable new powersettings */
 	out_be32(((u32 *) RPX_CSR_ADDR), in_be32(((u32 *) RPX_CSR_ADDR)) | reg);
 	return 0;
 }
 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
 #define hardware_enable(_slot_)	/* No hardware to enable */
 #define hardware_disable(_slot_)	/* No hardware to disable */
 #endif				/* CONFIG_RPXCLASSIC */
 /* FADS Boards from Motorola                                               */
 #if defined(CONFIG_FADS)
 #define PCMCIA_BOARD_MSG "FADS"
 static int voltage_set(int slot, int vcc, int vpp)
 {
 	u32 reg = 0;
 	switch (vcc) {
 	case 0:
 		break;
 	case 33:
 		reg |= BCSR1_PCCVCC0;
 		break;
 	case 50:
 		reg |= BCSR1_PCCVCC1;
 		break;
 	default:
 		return 1;
 	}
 	switch (vpp) {
 	case 0:
 		break;
 	case 33:
 	case 50:
 		if (vcc == vpp)
 			reg |= BCSR1_PCCVPP1;
 		else
 			return 1;
 		break;
 	case 120:
 		if ((vcc == 33) || (vcc == 50))
 			reg |= BCSR1_PCCVPP0;
 		else
 			return 1;
 	default:
 		return 1;
 	}
 	/* first, turn off all power */
 	out_be32((u32 *) BCSR1,
 		 in_be32((u32 *) BCSR1) & ~(BCSR1_PCCVCC_MASK |
 					    BCSR1_PCCVPP_MASK));
 	/* enable new powersettings */
 	out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) | reg);
 	return 0;
 }
 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
 static void hardware_enable(int slot)
 {
 	out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) & ~BCSR1_PCCEN);
 }
 static void hardware_disable(int slot)
 {
 	out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) | BCSR1_PCCEN);
 }
 #endif
 /* MPC885ADS Boards */
 #if defined(CONFIG_MPC885ADS)
 #define PCMCIA_BOARD_MSG "MPC885ADS"
 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
 static inline void hardware_enable(int slot)
 {
 	m8xx_pcmcia_ops.hw_ctrl(slot, 1);
 }
 static inline void hardware_disable(int slot)
 {
 	m8xx_pcmcia_ops.hw_ctrl(slot, 0);
 }
 static inline int voltage_set(int slot, int vcc, int vpp)
 {
 	return m8xx_pcmcia_ops.voltage_set(slot, vcc, vpp);
 }
 #endif
 /* ------------------------------------------------------------------------- */
 /* Motorola MBX860                                                           */
 #if defined(CONFIG_MBX)
 #define PCMCIA_BOARD_MSG "MBX"
 static int voltage_set(int slot, int vcc, int vpp)
 {
 	u8 reg = 0;
 	switch (vcc) {
 	case 0:
 		break;
 	case 33:
 		reg |= CSR2_VCC_33;
 		break;
 	case 50:
 		reg |= CSR2_VCC_50;
 		break;
 	default:
 		return 1;
 	}
 	switch (vpp) {
 	case 0:
 		break;
 	case 33:
 	case 50:
 		if (vcc == vpp)
 			reg |= CSR2_VPP_VCC;
 		else
 			return 1;
 		break;
 	case 120:
 		if ((vcc == 33) || (vcc == 50))
 			reg |= CSR2_VPP_12;
 		else
 			return 1;
 	default:
 		return 1;
 	}
 	/* first, turn off all power */
 	out_8((u8 *) MBX_CSR2_ADDR,
 	      in_8((u8 *) MBX_CSR2_ADDR) & ~(CSR2_VCC_MASK | CSR2_VPP_MASK));
 	/* enable new powersettings */
 	out_8((u8 *) MBX_CSR2_ADDR, in_8((u8 *) MBX_CSR2_ADDR) | reg);
 	return 0;
 }
 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
 #define hardware_enable(_slot_)	/* No hardware to enable */
 #define hardware_disable(_slot_)	/* No hardware to disable */
 #endif				/* CONFIG_MBX */
 #if defined(CONFIG_PRxK)
 #include <asm/cpld.h>
 extern volatile fpga_pc_regs *fpga_pc;
 #define PCMCIA_BOARD_MSG "MPC855T"
 static int voltage_set(int slot, int vcc, int vpp)
 {
 	u8 reg = 0;
 	u8 regread;
 	cpld_regs *ccpld = get_cpld();
 	switch (vcc) {
 	case 0:
 		break;
 	case 33:
 		reg |= PCMCIA_VCC_33;
 		break;
 	case 50:
 		reg |= PCMCIA_VCC_50;
 		break;
 	default:
 		return 1;
 	}
 	switch (vpp) {
 	case 0:
 		break;
 	case 33:
 	case 50:
 		if (vcc == vpp)
 			reg |= PCMCIA_VPP_VCC;
 		else
 			return 1;
 		break;
 	case 120:
 		if ((vcc == 33) || (vcc == 50))
 			reg |= PCMCIA_VPP_12;
 		else
 			return 1;
 	default:
 		return 1;
 	}
 	reg = reg >> (slot << 2);
 	regread = in_8(&ccpld->fpga_pc_ctl);
 	if (reg !=
 	    (regread & ((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >> (slot << 2)))) {
 		/* enable new powersettings */
 		regread =
 		    regread & ~((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >>
 				(slot << 2));
 		out_8(&ccpld->fpga_pc_ctl, reg | regread);
 		msleep(100);
 	}
 	return 0;
 }
 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_LV
 #define hardware_enable(_slot_)	/* No hardware to enable */
 #define hardware_disable(_slot_)	/* No hardware to disable */
 #endif				/* CONFIG_PRxK */
 static u32 pending_events[PCMCIA_SOCKETS_NO];
 static DEFINE_SPINLOCK(pending_event_lock);
 static irqreturn_t m8xx_interrupt(int irq, void *dev)
 {
 	struct socket_info *s;
 	struct event_table *e;
 	unsigned int i, events, pscr, pipr, per;
 	pcmconf8xx_t *pcmcia = socket[0].pcmcia;
 	pr_debug("m8xx_pcmcia: Interrupt!\n");
 	/* get interrupt sources */
 	pscr = in_be32(&pcmcia->pcmc_pscr);
 	pipr = in_be32(&pcmcia->pcmc_pipr);
 	per = in_be32(&pcmcia->pcmc_per);
 	for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
 		s = &socket[i];
 		e = &s->events[0];
 		events = 0;
 		while (e->regbit) {
 			if (pscr & e->regbit)
 				events |= e->eventbit;
 			e++;
 		}
 		/*
 		 * report only if both card detect signals are the same
 		 * not too nice done,
 		 * we depend on that CD2 is the bit to the left of CD1...
 		 */
 		if (events & SS_DETECT)
 			if (((pipr & M8XX_PCMCIA_CD2(i)) >> 1) ^
 			    (pipr & M8XX_PCMCIA_CD1(i))) {
 				events &= ~SS_DETECT;
 			}
 #ifdef PCMCIA_GLITCHY_CD
 		/*
 		 * I've experienced CD problems with my ADS board.
 		 * We make an extra check to see if there was a
 		 * real change of Card detection.
 		 */
 		if ((events & SS_DETECT) &&
 		    ((pipr &
 		      (M8XX_PCMCIA_CD2(i) | M8XX_PCMCIA_CD1(i))) == 0) &&
 		    (s->state.Vcc | s->state.Vpp)) {
 			events &= ~SS_DETECT;
 			/*printk( "CD glitch workaround - CD = 0x%08x!\n",
 			   (pipr & (M8XX_PCMCIA_CD2(i)
 			   | M8XX_PCMCIA_CD1(i)))); */
 		}
 #endif
 		/* call the handler */
 		pr_debug("m8xx_pcmcia: slot %u: events = 0x%02x, pscr = 0x%08x, "
 			"pipr = 0x%08x\n", i, events, pscr, pipr);
 		if (events) {
 			spin_lock(&pending_event_lock);
 			pending_events[i] |= events;
 			spin_unlock(&pending_event_lock);
 			/*
 			 * Turn off RDY_L bits in the PER mask on
 			 * CD interrupt receival.
 			 *
 			 * They can generate bad interrupts on the
 			 * ACS4,8,16,32.   - marcelo
 			 */
 			per &= ~M8XX_PCMCIA_RDY_L(0);
 			per &= ~M8XX_PCMCIA_RDY_L(1);
 			out_be32(&pcmcia->pcmc_per, per);
 			if (events)
 				pcmcia_parse_events(&socket[i].socket, events);
 		}
 	}
 	/* clear the interrupt sources */
 	out_be32(&pcmcia->pcmc_pscr, pscr);
 	pr_debug("m8xx_pcmcia: Interrupt done.\n");
 	return IRQ_HANDLED;
 }
 static u32 m8xx_get_graycode(u32 size)
 {
 	u32 k;
 	for (k = 0; k < M8XX_SIZES_NO; k++)
 		if (m8xx_size_to_gray[k] == size)
 			break;
 	if ((k == M8XX_SIZES_NO) || (m8xx_size_to_gray[k] == -1))
 		k = -1;
 	return k;
 }
 static u32 m8xx_get_speed(u32 ns, u32 is_io, u32 bus_freq)
 {
 	u32 reg, clocks, psst, psl, psht;
 	if (!ns) {
 		/*
 		 * We get called with IO maps setup to 0ns
 		 * if not specified by the user.
 		 * They should be 255ns.
 		 */
 		if (is_io)
 			ns = 255;
 		else
 			ns = 100;	/* fast memory if 0 */
 	}
 	/*
 	 * In PSST, PSL, PSHT fields we tell the controller
 	 * timing parameters in CLKOUT clock cycles.
 	 * CLKOUT is the same as GCLK2_50.
 	 */
 /* how we want to adjust the timing - in percent */
 #define ADJ 180			/* 80 % longer accesstime - to be sure */
 	clocks = ((bus_freq / 1000) * ns) / 1000;
 	clocks = (clocks * ADJ) / (100 * 1000);
 	if (clocks >= PCMCIA_BMT_LIMIT) {
 		printk("Max access time limit reached\n");
 		clocks = PCMCIA_BMT_LIMIT - 1;
 	}
 	psst = clocks / 7;	/* setup time */
 	psht = clocks / 7;	/* hold time */
 	psl = (clocks * 5) / 7;	/* strobe length */
 	psst += clocks - (psst + psht + psl);
 	reg = psst << 12;
 	reg |= psl << 7;
 	reg |= psht << 16;
 	return reg;
 }
 static int m8xx_get_status(struct pcmcia_socket *sock, unsigned int *value)
 {
 	int lsock = container_of(sock, struct socket_info, socket)->slot;
 	struct socket_info *s = &socket[lsock];
 	unsigned int pipr, reg;
 	pcmconf8xx_t *pcmcia = s->pcmcia;
 	pipr = in_be32(&pcmcia->pcmc_pipr);
 	*value = ((pipr & (M8XX_PCMCIA_CD1(lsock)
 			   | M8XX_PCMCIA_CD2(lsock))) == 0) ? SS_DETECT : 0;
 	*value |= (pipr & M8XX_PCMCIA_WP(lsock)) ? SS_WRPROT : 0;
 	if (s->state.flags & SS_IOCARD)
 		*value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_STSCHG : 0;
 	else {
 		*value |= (pipr & M8XX_PCMCIA_RDY(lsock)) ? SS_READY : 0;
 		*value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_BATDEAD : 0;
 		*value |= (pipr & M8XX_PCMCIA_BVD2(lsock)) ? SS_BATWARN : 0;
 	}
 	if (s->state.Vcc | s->state.Vpp)
 		*value |= SS_POWERON;
 	/*
 	 * Voltage detection:
 	 * This driver only supports 16-Bit pc-cards.
 	 * Cardbus is not handled here.
 	 *
 	 * To determine what voltage to use we must read the VS1 and VS2 pin.
 	 * Depending on what socket type is present,
 	 * different combinations mean different things.
 	 *
 	 * Card Key  Socket Key   VS1   VS2   Card         Vcc for CIS parse
 	 *
 	 * 5V        5V, LV*      NC    NC    5V only       5V (if available)
 	 *
 	 * 5V        5V, LV*      GND   NC    5 or 3.3V     as low as possible
 	 *
 	 * 5V        5V, LV*      GND   GND   5, 3.3, x.xV  as low as possible
 	 *
 	 * LV*       5V            -     -    shall not fit into socket
 	 *
 	 * LV*       LV*          GND   NC    3.3V only     3.3V
 	 *
 	 * LV*       LV*          NC    GND   x.xV          x.xV (if avail.)
 	 *
 	 * LV*       LV*          GND   GND   3.3 or x.xV   as low as possible
 	 *
 	 * *LV means Low Voltage
 	 *
 	 *
 	 * That gives us the following table:
 	 *
 	 * Socket    VS1  VS2   Voltage
 	 *
 	 * 5V        NC   NC    5V
 	 * 5V        NC   GND   none (should not be possible)
 	 * 5V        GND  NC    >= 3.3V
 	 * 5V        GND  GND   >= x.xV
 	 *
 	 * LV        NC   NC    5V   (if available)
 	 * LV        NC   GND   x.xV (if available)
 	 * LV        GND  NC    3.3V
 	 * LV        GND  GND   >= x.xV
 	 *
 	 * So, how do I determine if I have a 5V or a LV
 	 * socket on my board?  Look at the socket!
 	 *
 	 *
 	 * Socket with 5V key:
 	 * ++--------------------------------------------+
 	 * ||                                            |
 	 * ||                                           ||
 	 * ||                                           ||
 	 * |                                             |
 	 * +---------------------------------------------+
 	 *
 	 * Socket with LV key:
 	 * ++--------------------------------------------+
 	 * ||                                            |
 	 * |                                            ||
 	 * |                                            ||
 	 * |                                             |
 	 * +---------------------------------------------+
 	 *
 	 *
 	 * With other words - LV only cards does not fit
 	 * into the 5V socket!
 	 */
 	/* read out VS1 and VS2 */
 	reg = (pipr & M8XX_PCMCIA_VS_MASK(lsock))
 	    >> M8XX_PCMCIA_VS_SHIFT(lsock);
 	if (socket_get(lsock) == PCMCIA_SOCKET_KEY_LV) {
 		switch (reg) {
 		case 1:
 			*value |= SS_3VCARD;
 			break;	/* GND, NC - 3.3V only */
 		case 2:
 			*value |= SS_XVCARD;
 			break;	/* NC. GND - x.xV only */
 		};
 	}
 	pr_debug("m8xx_pcmcia: GetStatus(%d) = %#2.2x\n", lsock, *value);
 	return 0;
 }
 static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t * state)
 {
 	int lsock = container_of(sock, struct socket_info, socket)->slot;
 	struct socket_info *s = &socket[lsock];
 	struct event_table *e;
 	unsigned int reg;
 	unsigned long flags;
 	pcmconf8xx_t *pcmcia = socket[0].pcmcia;
 	pr_debug("m8xx_pcmcia: SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, "
 		"io_irq %d, csc_mask %#2.2x)\n", lsock, state->flags,
 		state->Vcc, state->Vpp, state->io_irq, state->csc_mask);
 	/* First, set voltage - bail out if invalid */
 	if (voltage_set(lsock, state->Vcc, state->Vpp))
 		return -EINVAL;
 	/* Take care of reset... */
 	if (state->flags & SS_RESET)
 		out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) | M8XX_PGCRX_CXRESET);	/* active high */
 	else
 		out_be32(M8XX_PGCRX(lsock),
 			 in_be32(M8XX_PGCRX(lsock)) & ~M8XX_PGCRX_CXRESET);
 	/* ... and output enable. */
 	/* The CxOE signal is connected to a 74541 on the ADS.
 	   I guess most other boards used the ADS as a reference.
 	   I tried to control the CxOE signal with SS_OUTPUT_ENA,
 	   but the reset signal seems connected via the 541.
 	   If the CxOE is left high are some signals tristated and
 	   no pullups are present -> the cards act weird.
 	   So right now the buffers are enabled if the power is on. */
 	if (state->Vcc || state->Vpp)
 		out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) & ~M8XX_PGCRX_CXOE);	/* active low */
 	else
 		out_be32(M8XX_PGCRX(lsock),
 			 in_be32(M8XX_PGCRX(lsock)) | M8XX_PGCRX_CXOE);
 	/*
 	 * We'd better turn off interrupts before
 	 * we mess with the events-table..
 	 */
 	spin_lock_irqsave(&events_lock, flags);
 	/*
 	 * Play around with the interrupt mask to be able to
 	 * give the events the generic pcmcia driver wants us to.
 	 */
 	e = &s->events[0];
 	reg = 0;
 	if (state->csc_mask & SS_DETECT) {
 		e->eventbit = SS_DETECT;
 		reg |= e->regbit = (M8XX_PCMCIA_CD2(lsock)
 				    | M8XX_PCMCIA_CD1(lsock));
 		e++;
 	}
 	if (state->flags & SS_IOCARD) {
 		/*
 		 * I/O card
 		 */
 		if (state->csc_mask & SS_STSCHG) {
 			e->eventbit = SS_STSCHG;
 			reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
 			e++;
 		}
 		/*
 		 * If io_irq is non-zero we should enable irq.
 		 */
 		if (state->io_irq) {
 			out_be32(M8XX_PGCRX(lsock),
 				 in_be32(M8XX_PGCRX(lsock)) |
 				 mk_int_int_mask(s->hwirq) << 24);
 			/*
 			 * Strange thing here:
 			 * The manual does not tell us which interrupt
 			 * the sources generate.
 			 * Anyhow, I found out that RDY_L generates IREQLVL.
 			 *
 			 * We use level triggerd interrupts, and they don't
 			 * have to be cleared in PSCR in the interrupt handler.
 			 */
 			reg |= M8XX_PCMCIA_RDY_L(lsock);
 		} else
 			out_be32(M8XX_PGCRX(lsock),
 				 in_be32(M8XX_PGCRX(lsock)) & 0x00ffffff);
 	} else {
 		/*
 		 * Memory card
 		 */
 		if (state->csc_mask & SS_BATDEAD) {
 			e->eventbit = SS_BATDEAD;
 			reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
 			e++;
 		}
 		if (state->csc_mask & SS_BATWARN) {
 			e->eventbit = SS_BATWARN;
 			reg |= e->regbit = M8XX_PCMCIA_BVD2(lsock);
 			e++;
 		}
 		/* What should I trigger on - low/high,raise,fall? */
 		if (state->csc_mask & SS_READY) {
 			e->eventbit = SS_READY;
 			reg |= e->regbit = 0;	//??
 			e++;
 		}
 	}
 	e->regbit = 0;		/* terminate list */
 	/*
 	 * Clear the status changed .
 	 * Port A and Port B share the same port.
 	 * Writing ones will clear the bits.
 	 */
 	out_be32(&pcmcia->pcmc_pscr, reg);
 	/*
 	 * Write the mask.
 	 * Port A and Port B share the same port.
 	 * Need for read-modify-write.
 	 * Ones will enable the interrupt.
 	 */
 	reg |=
 	    in_be32(&pcmcia->
 		    pcmc_per) & (M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
 	out_be32(&pcmcia->pcmc_per, reg);
 	spin_unlock_irqrestore(&events_lock, flags);
 	/* copy the struct and modify the copy */
 	s->state = *state;
 	return 0;
 }
 static int m8xx_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *io)
 {
 	int lsock = container_of(sock, struct socket_info, socket)->slot;
 	struct socket_info *s = &socket[lsock];
 	struct pcmcia_win *w;
 	unsigned int reg, winnr;
 	pcmconf8xx_t *pcmcia = s->pcmcia;
 #define M8XX_SIZE (io->stop - io->start + 1)
 #define M8XX_BASE (PCMCIA_IO_WIN_BASE + io->start)
 	pr_debug("m8xx_pcmcia: SetIOMap(%d, %d, %#2.2x, %d ns, "
 		"%#4.4llx-%#4.4llx)\n", lsock, io->map, io->flags,
 		io->speed, (unsigned long long)io->start,
 		(unsigned long long)io->stop);
 	if ((io->map >= PCMCIA_IO_WIN_NO) || (io->start > 0xffff)
 	    || (io->stop > 0xffff) || (io->stop < io->start))
 		return -EINVAL;
 	if ((reg = m8xx_get_graycode(M8XX_SIZE)) == -1)
 		return -EINVAL;
 	if (io->flags & MAP_ACTIVE) {
 		pr_debug("m8xx_pcmcia: io->flags & MAP_ACTIVE\n");
 		winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
 		    + (lsock * PCMCIA_IO_WIN_NO) + io->map;
 		/* setup registers */
 		w = (void *)&pcmcia->pcmc_pbr0;
 		w += winnr;
 		out_be32(&w->or, 0);	/* turn off window first */
 		out_be32(&w->br, M8XX_BASE);
 		reg <<= 27;
 		reg |= M8XX_PCMCIA_POR_IO | (lsock << 2);
 		reg |= m8xx_get_speed(io->speed, 1, s->bus_freq);
 		if (io->flags & MAP_WRPROT)
 			reg |= M8XX_PCMCIA_POR_WRPROT;
 		/*if(io->flags & (MAP_16BIT | MAP_AUTOSZ)) */
 		if (io->flags & MAP_16BIT)
 			reg |= M8XX_PCMCIA_POR_16BIT;
 		if (io->flags & MAP_ACTIVE)
 			reg |= M8XX_PCMCIA_POR_VALID;
 		out_be32(&w->or, reg);
 		pr_debug("m8xx_pcmcia: Socket %u: Mapped io window %u at "
 			"%#8.8x, OR = %#8.8x.\n", lsock, io->map, w->br, w->or);
 	} else {
 		/* shutdown IO window */
 		winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
 		    + (lsock * PCMCIA_IO_WIN_NO) + io->map;
 		/* setup registers */
 		w = (void *)&pcmcia->pcmc_pbr0;
 		w += winnr;
 		out_be32(&w->or, 0);	/* turn off window */
 		out_be32(&w->br, 0);	/* turn off base address */
 		pr_debug("m8xx_pcmcia: Socket %u: Unmapped io window %u at "
 			"%#8.8x, OR = %#8.8x.\n", lsock, io->map, w->br, w->or);
 	}
 	/* copy the struct and modify the copy */
 	s->io_win[io->map] = *io;
 	s->io_win[io->map].flags &= (MAP_WRPROT | MAP_16BIT | MAP_ACTIVE);
 	pr_debug("m8xx_pcmcia: SetIOMap exit\n");
 	return 0;
 }
 static int m8xx_set_mem_map(struct pcmcia_socket *sock,
 			    struct pccard_mem_map *mem)
 {
 	int lsock = container_of(sock, struct socket_info, socket)->slot;
 	struct socket_info *s = &socket[lsock];
 	struct pcmcia_win *w;
 	struct pccard_mem_map *old;
 	unsigned int reg, winnr;
 	pcmconf8xx_t *pcmcia = s->pcmcia;
 	pr_debug("m8xx_pcmcia: SetMemMap(%d, %d, %#2.2x, %d ns, "
 		"%#5.5llx, %#5.5x)\n", lsock, mem->map, mem->flags,
 		mem->speed, (unsigned long long)mem->static_start,
 		mem->card_start);
 	if ((mem->map >= PCMCIA_MEM_WIN_NO)
 //          || ((mem->s) >= PCMCIA_MEM_WIN_SIZE)
 	    || (mem->card_start >= 0x04000000)
 	    || (mem->static_start & 0xfff)	/* 4KByte resolution */
 	    ||(mem->card_start & 0xfff))
 		return -EINVAL;
 	if ((reg = m8xx_get_graycode(PCMCIA_MEM_WIN_SIZE)) == -1) {
 		printk("Cannot set size to 0x%08x.\n", PCMCIA_MEM_WIN_SIZE);
 		return -EINVAL;
 	}
 	reg <<= 27;
 	winnr = (lsock * PCMCIA_MEM_WIN_NO) + mem->map;
 	/* Setup the window in the pcmcia controller */
 	w = (void *)&pcmcia->pcmc_pbr0;
 	w += winnr;
 	reg |= lsock << 2;
 	reg |= m8xx_get_speed(mem->speed, 0, s->bus_freq);
 	if (mem->flags & MAP_ATTRIB)
 		reg |= M8XX_PCMCIA_POR_ATTRMEM;
 	if (mem->flags & MAP_WRPROT)
 		reg |= M8XX_PCMCIA_POR_WRPROT;
 	if (mem->flags & MAP_16BIT)
 		reg |= M8XX_PCMCIA_POR_16BIT;
 	if (mem->flags & MAP_ACTIVE)
 		reg |= M8XX_PCMCIA_POR_VALID;
 	out_be32(&w->or, reg);
 	pr_debug("m8xx_pcmcia: Socket %u: Mapped memory window %u at %#8.8x, "
 		"OR = %#8.8x.\n", lsock, mem->map, w->br, w->or);
 	if (mem->flags & MAP_ACTIVE) {
 		/* get the new base address */
 		mem->static_start = PCMCIA_MEM_WIN_BASE +
 		    (PCMCIA_MEM_WIN_SIZE * winnr)
 		    + mem->card_start;
 	}
 	pr_debug("m8xx_pcmcia: SetMemMap(%d, %d, %#2.2x, %d ns, "
 		"%#5.5llx, %#5.5x)\n", lsock, mem->map, mem->flags,
 		mem->speed, (unsigned long long)mem->static_start,
 		mem->card_start);
 	/* copy the struct and modify the copy */
 	old = &s->mem_win[mem->map];
 	*old = *mem;
 	old->flags &= (MAP_ATTRIB | MAP_WRPROT | MAP_16BIT | MAP_ACTIVE);
 	return 0;
 }
 static int m8xx_sock_init(struct pcmcia_socket *sock)
 {
 	int i;
 	pccard_io_map io = { 0, 0, 0, 0, 1 };
 	pccard_mem_map mem = { 0, 0, 0, 0, 0, 0 };
 	pr_debug("m8xx_pcmcia: sock_init(%d)\n", s);
 	m8xx_set_socket(sock, &dead_socket);
 	for (i = 0; i < PCMCIA_IO_WIN_NO; i++) {
 		io.map = i;
 		m8xx_set_io_map(sock, &io);
 	}
 	for (i = 0; i < PCMCIA_MEM_WIN_NO; i++) {
 		mem.map = i;
 		m8xx_set_mem_map(sock, &mem);
 	}
 	return 0;
 }
 static int m8xx_sock_suspend(struct pcmcia_socket *sock)
 {
 	return m8xx_set_socket(sock, &dead_socket);
 }
 static struct pccard_operations m8xx_services = {
 	.init = m8xx_sock_init,
 	.suspend = m8xx_sock_suspend,
 	.get_status = m8xx_get_status,
 	.set_socket = m8xx_set_socket,
 	.set_io_map = m8xx_set_io_map,
 	.set_mem_map = m8xx_set_mem_map,
 };
 static int __init m8xx_probe(struct platform_device *ofdev)
 {
 	struct pcmcia_win *w;
 	unsigned int i, m, hwirq;
 	pcmconf8xx_t *pcmcia;
 	int status;
 	struct device_node *np = ofdev->dev.of_node;
 	pcmcia_info("%s\n", version);
 	pcmcia = of_iomap(np, 0);
 	if (pcmcia == NULL)
 		return -EINVAL;
 	pcmcia_schlvl = irq_of_parse_and_map(np, 0);
 	hwirq = irq_map[pcmcia_schlvl].hwirq;
 	if (pcmcia_schlvl < 0) {
 		iounmap(pcmcia);
 		return -EINVAL;
 	}
 	m8xx_pgcrx[0] = &pcmcia->pcmc_pgcra;
 	m8xx_pgcrx[1] = &pcmcia->pcmc_pgcrb;
 	pcmcia_info(PCMCIA_BOARD_MSG " using " PCMCIA_SLOT_MSG
 		    " with IRQ %u  (%d). \n", pcmcia_schlvl, hwirq);
 	/* Configure Status change interrupt */
 	if (request_irq(pcmcia_schlvl, m8xx_interrupt, IRQF_SHARED,
 			driver_name, socket)) {
 		pcmcia_error("Cannot allocate IRQ %u for SCHLVL!\n",
 			     pcmcia_schlvl);
 		iounmap(pcmcia);
 		return -1;
 	}
 	w = (void *)&pcmcia->pcmc_pbr0;
 	out_be32(&pcmcia->pcmc_pscr, M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
 	clrbits32(&pcmcia->pcmc_per, M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
 	/* connect interrupt and disable CxOE */
 	out_be32(M8XX_PGCRX(0),
 		 M8XX_PGCRX_CXOE | (mk_int_int_mask(hwirq) << 16));
 	out_be32(M8XX_PGCRX(1),
 		 M8XX_PGCRX_CXOE | (mk_int_int_mask(hwirq) << 16));
 	/* initialize the fixed memory windows */
 	for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
 		for (m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
 			out_be32(&w->br, PCMCIA_MEM_WIN_BASE +
 				 (PCMCIA_MEM_WIN_SIZE
 				  * (m + i * PCMCIA_MEM_WIN_NO)));
 			out_be32(&w->or, 0);	/* set to not valid */
 			w++;
 		}
 	}
 	/* turn off voltage */
 	voltage_set(0, 0, 0);
 	voltage_set(1, 0, 0);
 	/* Enable external hardware */
 	hardware_enable(0);
 	hardware_enable(1);
 	for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
 		socket[i].slot = i;
 		socket[i].socket.owner = THIS_MODULE;
 		socket[i].socket.features =
 		    SS_CAP_PCCARD | SS_CAP_MEM_ALIGN | SS_CAP_STATIC_MAP;
 		socket[i].socket.irq_mask = 0x000;
 		socket[i].socket.map_size = 0x1000;
 		socket[i].socket.io_offset = 0;
 		socket[i].socket.pci_irq = pcmcia_schlvl;
 		socket[i].socket.ops = &m8xx_services;
 		socket[i].socket.resource_ops = &pccard_iodyn_ops;
 		socket[i].socket.cb_dev = NULL;
 		socket[i].socket.dev.parent = &ofdev->dev;
 		socket[i].pcmcia = pcmcia;
 		socket[i].bus_freq = ppc_proc_freq;
 		socket[i].hwirq = hwirq;
 	}
 	for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
 		status = pcmcia_register_socket(&socket[i].socket);
 		if (status < 0)
 			pcmcia_error("Socket register failed\n");
 	}
 	return 0;
 }
 static int m8xx_remove(struct platform_device *ofdev)
 {
 	u32 m, i;
 	struct pcmcia_win *w;
 	pcmconf8xx_t *pcmcia = socket[0].pcmcia;
 	for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
 		w = (void *)&pcmcia->pcmc_pbr0;
 		out_be32(&pcmcia->pcmc_pscr, M8XX_PCMCIA_MASK(i));
 		out_be32(&pcmcia->pcmc_per,
 			 in_be32(&pcmcia->pcmc_per) & ~M8XX_PCMCIA_MASK(i));
 		/* turn off interrupt and disable CxOE */
 		out_be32(M8XX_PGCRX(i), M8XX_PGCRX_CXOE);
 		/* turn off memory windows */
 		for (m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
 			out_be32(&w->or, 0);	/* set to not valid */
 			w++;
 		}
 		/* turn off voltage */
 		voltage_set(i, 0, 0);
 		/* disable external hardware */
 		hardware_disable(i);
 	}
 	for (i = 0; i < PCMCIA_SOCKETS_NO; i++)
 		pcmcia_unregister_socket(&socket[i].socket);
 	iounmap(pcmcia);
 	free_irq(pcmcia_schlvl, NULL);
 	return 0;
 }
 static const struct of_device_id m8xx_pcmcia_match[] = {
 	{
 	 .type = "pcmcia",
 	 .compatible = "fsl,pq-pcmcia",
 	 },
 	{},
 };
 MODULE_DEVICE_TABLE(of, m8xx_pcmcia_match);
 static struct platform_driver m8xx_pcmcia_driver = {
 	.driver = {
 		.name = driver_name,
 		.owner = THIS_MODULE,
 		.of_match_table = m8xx_pcmcia_match,
 	},
 	.probe = m8xx_probe,
 	.remove = m8xx_remove,
 };
-static int __init m8xx_init(void)
+module_platform_driver(m8xx_pcmcia_driver);
-{
-	return platform_driver_register(&m8xx_pcmcia_driver);
-}
-static void __exit m8xx_exit(void)
-{
-	platform_driver_unregister(&m8xx_pcmcia_driver);
-}
-module_init(m8xx_init);
-module_exit(m8xx_exit);

drivers/pcmcia/pxa2xx_viper.c

Diff comments View file @ 5d95f8e

 /*
  * Viper/Zeus PCMCIA support
  *   Copyright 2004 Arcom Control Systems
  *
  * Maintained by Marc Zyngier <maz@misterjones.org>
  *
  * Based on:
  *   iPAQ h2200 PCMCIA support
  *   Copyright 2004 Koen Kooi <koen@vestingbar.nl>
  *
  * This file is subject to the terms and conditions of the GNU General Public
  * License.  See the file COPYING in the main directory of this archive for
  * more details.
  */
 #include <linux/module.h>
 #include <linux/init.h>
 #include <linux/kernel.h>
 #include <linux/errno.h>
 #include <linux/interrupt.h>
 #include <linux/platform_device.h>
 #include <linux/gpio.h>
 #include <pcmcia/ss.h>
 #include <asm/irq.h>
 #include <mach/arcom-pcmcia.h>
 #include "soc_common.h"
 #include "pxa2xx_base.h"
 static struct platform_device *arcom_pcmcia_dev;
 static struct pcmcia_irqs irqs[] = {
 	{
 		.sock	= 0,
 		.str	= "PCMCIA_CD",
 	},
 };
 static inline struct arcom_pcmcia_pdata *viper_get_pdata(void)
 {
 	return arcom_pcmcia_dev->dev.platform_data;
 }
 static int viper_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
 {
 	struct arcom_pcmcia_pdata *pdata = viper_get_pdata();
 	unsigned long flags;
 	skt->socket.pci_irq = gpio_to_irq(pdata->rdy_gpio);
 	irqs[0].irq = gpio_to_irq(pdata->cd_gpio);
 	if (gpio_request(pdata->cd_gpio, "CF detect"))
 		goto err_request_cd;
 	if (gpio_request(pdata->rdy_gpio, "CF ready"))
 		goto err_request_rdy;
 	if (gpio_request(pdata->pwr_gpio, "CF power"))
 		goto err_request_pwr;
 	local_irq_save(flags);
 	if (gpio_direction_output(pdata->pwr_gpio, 0) ||
 	    gpio_direction_input(pdata->cd_gpio) ||
 	    gpio_direction_input(pdata->rdy_gpio)) {
 		local_irq_restore(flags);
 		goto err_dir;
 	}
 	local_irq_restore(flags);
 	return soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs));
 err_dir:
 	gpio_free(pdata->pwr_gpio);
 err_request_pwr:
 	gpio_free(pdata->rdy_gpio);
 err_request_rdy:
 	gpio_free(pdata->cd_gpio);
 err_request_cd:
 	dev_err(&arcom_pcmcia_dev->dev, "Failed to setup PCMCIA GPIOs\n");
 	return -1;
 }
 /*
  * Release all resources.
  */
 static void viper_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
 {
 	struct arcom_pcmcia_pdata *pdata = viper_get_pdata();
 	soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs));
 	gpio_free(pdata->pwr_gpio);
 	gpio_free(pdata->rdy_gpio);
 	gpio_free(pdata->cd_gpio);
 }
 static void viper_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
 				      struct pcmcia_state *state)
 {
 	struct arcom_pcmcia_pdata *pdata = viper_get_pdata();
 	state->detect = !gpio_get_value(pdata->cd_gpio);
 	state->ready  = !!gpio_get_value(pdata->rdy_gpio);
 	state->bvd1   = 1;
 	state->bvd2   = 1;
 	state->wrprot = 0;
 	state->vs_3v  = 1; /* Can only apply 3.3V */
 	state->vs_Xv  = 0;
 }
 static int viper_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
 					 const socket_state_t *state)
 {
 	struct arcom_pcmcia_pdata *pdata = viper_get_pdata();
 	/* Silently ignore Vpp, output enable, speaker enable. */
 	pdata->reset(state->flags & SS_RESET);
 	/* Apply socket voltage */
 	switch (state->Vcc) {
 	case 0:
 		gpio_set_value(pdata->pwr_gpio, 0);
 		break;
 	case 33:
 		gpio_set_value(pdata->pwr_gpio, 1);
 		break;
 	default:
 		dev_err(&arcom_pcmcia_dev->dev, "Unsupported Vcc:%d\n", state->Vcc);
 		return -1;
 	}
 	return 0;
 }
 static struct pcmcia_low_level viper_pcmcia_ops = {
 	.owner          	= THIS_MODULE,
 	.hw_init        	= viper_pcmcia_hw_init,
 	.hw_shutdown		= viper_pcmcia_hw_shutdown,
 	.socket_state		= viper_pcmcia_socket_state,
 	.configure_socket	= viper_pcmcia_configure_socket,
 	.nr         		= 1,
 };
 static struct platform_device *viper_pcmcia_device;
 static int viper_pcmcia_probe(struct platform_device *pdev)
 {
 	int ret;
 	/* I can't imagine more than one device, but you never know... */
 	if (arcom_pcmcia_dev)
 		return -EEXIST;
 	if (!pdev->dev.platform_data)
 		return -EINVAL;
 	viper_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1);
 	if (!viper_pcmcia_device)
 		return -ENOMEM;
 	arcom_pcmcia_dev = pdev;
 	viper_pcmcia_device->dev.parent = &pdev->dev;
 	ret = platform_device_add_data(viper_pcmcia_device,
 				       &viper_pcmcia_ops,
 				       sizeof(viper_pcmcia_ops));
 	if (!ret)
 		ret = platform_device_add(viper_pcmcia_device);
 	if (ret) {
 		platform_device_put(viper_pcmcia_device);
 		arcom_pcmcia_dev = NULL;
 	}
 	return ret;
 }
 static int viper_pcmcia_remove(struct platform_device *pdev)
 {
 	platform_device_unregister(viper_pcmcia_device);
 	arcom_pcmcia_dev = NULL;
 	return 0;
 }
 static struct platform_device_id viper_pcmcia_id_table[] = {
 	{ .name = "viper-pcmcia", },
 	{ .name = "zeus-pcmcia",  },
 	{ },
 };
 static struct platform_driver viper_pcmcia_driver = {
 	.probe		= viper_pcmcia_probe,
 	.remove		= viper_pcmcia_remove,
 	.driver		= {
 		.name	= "arcom-pcmcia",
 		.owner	= THIS_MODULE,
 	},
 	.id_table	= viper_pcmcia_id_table,
 };
-static int __init viper_pcmcia_init(void)
+module_platform_driver(viper_pcmcia_driver);
-{
-	return platform_driver_register(&viper_pcmcia_driver);
-}
-static void __exit viper_pcmcia_exit(void)
-{
-	return platform_driver_unregister(&viper_pcmcia_driver);
-}
-module_init(viper_pcmcia_init);
-module_exit(viper_pcmcia_exit);
 MODULE_DEVICE_TABLE(platform, viper_pcmcia_id_table);
 MODULE_LICENSE("GPL");

drivers/pcmcia/xxs1500_ss.c

Diff comments View file @ 5d95f8e

 /*
  * PCMCIA socket code for the MyCable XXS1500 system.
  *
  * Copyright (c) 2009 Manuel Lauss <manuel.lauss@gmail.com>
  *
  */
 #include <linux/delay.h>
 #include <linux/gpio.h>
 #include <linux/interrupt.h>
 #include <linux/io.h>
 #include <linux/ioport.h>
 #include <linux/mm.h>
 #include <linux/platform_device.h>
 #include <linux/pm.h>
 #include <linux/resource.h>
 #include <linux/slab.h>
 #include <linux/spinlock.h>
 #include <pcmcia/ss.h>
 #include <pcmcia/cistpl.h>
 #include <asm/irq.h>
 #include <asm/system.h>
 #include <asm/mach-au1x00/au1000.h>
 #define MEM_MAP_SIZE	0x400000
 #define IO_MAP_SIZE	0x1000
 /*
  * 3.3V cards only; all interfacing is done via gpios:
  *
  * 0/1:  carddetect (00 = card present, xx = huh)
  * 4:	 card irq
  * 204:  reset (high-act)
  * 205:  buffer enable (low-act)
  * 208/209: card voltage key (00,01,10,11)
  * 210:  battwarn
  * 211:  batdead
  * 214:  power (low-act)
  */
 #define GPIO_CDA	0
 #define GPIO_CDB	1
 #define GPIO_CARDIRQ	4
 #define GPIO_RESET	204
 #define GPIO_OUTEN	205
 #define GPIO_VSL	208
 #define GPIO_VSH	209
 #define GPIO_BATTDEAD	210
 #define GPIO_BATTWARN	211
 #define GPIO_POWER	214
 struct xxs1500_pcmcia_sock {
 	struct pcmcia_socket	socket;
 	void		*virt_io;
 	phys_addr_t	phys_io;
 	phys_addr_t	phys_attr;
 	phys_addr_t	phys_mem;
 	/* previous flags for set_socket() */
 	unsigned int old_flags;
 };
 #define to_xxs_socket(x) container_of(x, struct xxs1500_pcmcia_sock, socket)
 static irqreturn_t cdirq(int irq, void *data)
 {
 	struct xxs1500_pcmcia_sock *sock = data;
 	pcmcia_parse_events(&sock->socket, SS_DETECT);
 	return IRQ_HANDLED;
 }
 static int xxs1500_pcmcia_configure(struct pcmcia_socket *skt,
 				    struct socket_state_t *state)
 {
 	struct xxs1500_pcmcia_sock *sock = to_xxs_socket(skt);
 	unsigned int changed;
 	/* power control */
 	switch (state->Vcc) {
 	case 0:
 		gpio_set_value(GPIO_POWER, 1);	/* power off */
 		break;
 	case 33:
 		gpio_set_value(GPIO_POWER, 0);	/* power on */
 		break;
 	case 50:
 	default:
 		return -EINVAL;
 	}
 	changed = state->flags ^ sock->old_flags;
 	if (changed & SS_RESET) {
 		if (state->flags & SS_RESET) {
 			gpio_set_value(GPIO_RESET, 1);	/* assert reset */
 			gpio_set_value(GPIO_OUTEN, 1);	/* buffers off */
 		} else {
 			gpio_set_value(GPIO_RESET, 0);	/* deassert reset */
 			gpio_set_value(GPIO_OUTEN, 0);	/* buffers on */
 			msleep(500);
 		}
 	}
 	sock->old_flags = state->flags;
 	return 0;
 }
 static int xxs1500_pcmcia_get_status(struct pcmcia_socket *skt,
 				     unsigned int *value)
 {
 	unsigned int status;
 	int i;
 	status = 0;
 	/* check carddetects: GPIO[0:1] must both be low */
 	if (!gpio_get_value(GPIO_CDA) && !gpio_get_value(GPIO_CDB))
 		status |= SS_DETECT;
 	/* determine card voltage: GPIO[208:209] binary value */
 	i = (!!gpio_get_value(GPIO_VSL)) | ((!!gpio_get_value(GPIO_VSH)) << 1);
 	switch (i) {
 	case 0:
 	case 1:
 	case 2:
 		status |= SS_3VCARD;	/* 3V card */
 		break;
 	case 3:				/* 5V card, unsupported */
 	default:
 		status |= SS_XVCARD;	/* treated as unsupported in core */
 	}
 	/* GPIO214: low active power switch */
 	status |= gpio_get_value(GPIO_POWER) ? 0 : SS_POWERON;
 	/* GPIO204: high-active reset line */
 	status |= gpio_get_value(GPIO_RESET) ? SS_RESET : SS_READY;
 	/* other stuff */
 	status |= gpio_get_value(GPIO_BATTDEAD) ? 0 : SS_BATDEAD;
 	status |= gpio_get_value(GPIO_BATTWARN) ? 0 : SS_BATWARN;
 	*value = status;
 	return 0;
 }
 static int xxs1500_pcmcia_sock_init(struct pcmcia_socket *skt)
 {
 	gpio_direction_input(GPIO_CDA);
 	gpio_direction_input(GPIO_CDB);
 	gpio_direction_input(GPIO_VSL);
 	gpio_direction_input(GPIO_VSH);
 	gpio_direction_input(GPIO_BATTDEAD);
 	gpio_direction_input(GPIO_BATTWARN);
 	gpio_direction_output(GPIO_RESET, 1);	/* assert reset */
 	gpio_direction_output(GPIO_OUTEN, 1);	/* disable buffers */
 	gpio_direction_output(GPIO_POWER, 1);	/* power off */
 	return 0;
 }
 static int xxs1500_pcmcia_sock_suspend(struct pcmcia_socket *skt)
 {
 	return 0;
 }
 static int au1x00_pcmcia_set_io_map(struct pcmcia_socket *skt,
 				    struct pccard_io_map *map)
 {
 	struct xxs1500_pcmcia_sock *sock = to_xxs_socket(skt);
 	map->start = (u32)sock->virt_io;
 	map->stop = map->start + IO_MAP_SIZE;
 	return 0;
 }
 static int au1x00_pcmcia_set_mem_map(struct pcmcia_socket *skt,
 				     struct pccard_mem_map *map)
 {
 	struct xxs1500_pcmcia_sock *sock = to_xxs_socket(skt);
 	if (map->flags & MAP_ATTRIB)
 		map->static_start = sock->phys_attr + map->card_start;
 	else
 		map->static_start = sock->phys_mem + map->card_start;
 	return 0;
 }
 static struct pccard_operations xxs1500_pcmcia_operations = {
 	.init			= xxs1500_pcmcia_sock_init,
 	.suspend		= xxs1500_pcmcia_sock_suspend,
 	.get_status		= xxs1500_pcmcia_get_status,
 	.set_socket		= xxs1500_pcmcia_configure,
 	.set_io_map		= au1x00_pcmcia_set_io_map,
 	.set_mem_map		= au1x00_pcmcia_set_mem_map,
 };
 static int __devinit xxs1500_pcmcia_probe(struct platform_device *pdev)
 {
 	struct xxs1500_pcmcia_sock *sock;
 	struct resource *r;
 	int ret, irq;
 	sock = kzalloc(sizeof(struct xxs1500_pcmcia_sock), GFP_KERNEL);
 	if (!sock)
 		return -ENOMEM;
 	ret = -ENODEV;
 	/* 36bit PCMCIA Attribute area address */
 	r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pcmcia-attr");
 	if (!r) {
 		dev_err(&pdev->dev, "missing 'pcmcia-attr' resource!\n");
 		goto out0;
 	}
 	sock->phys_attr = r->start;
 	/* 36bit PCMCIA Memory area address */
 	r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pcmcia-mem");
 	if (!r) {
 		dev_err(&pdev->dev, "missing 'pcmcia-mem' resource!\n");
 		goto out0;
 	}
 	sock->phys_mem = r->start;
 	/* 36bit PCMCIA IO area address */
 	r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pcmcia-io");
 	if (!r) {
 		dev_err(&pdev->dev, "missing 'pcmcia-io' resource!\n");
 		goto out0;
 	}
 	sock->phys_io = r->start;
 	/*
 	 * PCMCIA client drivers use the inb/outb macros to access
 	 * the IO registers.  Since mips_io_port_base is added
 	 * to the access address of the mips implementation of
 	 * inb/outb, we need to subtract it here because we want
 	 * to access the I/O or MEM address directly, without
 	 * going through this "mips_io_port_base" mechanism.
 	 */
 	sock->virt_io = (void *)(ioremap(sock->phys_io, IO_MAP_SIZE) -
 				 mips_io_port_base);
 	if (!sock->virt_io) {
 		dev_err(&pdev->dev, "cannot remap IO area\n");
 		ret = -ENOMEM;
 		goto out0;
 	}
 	sock->socket.ops	= &xxs1500_pcmcia_operations;
 	sock->socket.owner	= THIS_MODULE;
 	sock->socket.pci_irq	= gpio_to_irq(GPIO_CARDIRQ);
 	sock->socket.features	= SS_CAP_STATIC_MAP | SS_CAP_PCCARD;
 	sock->socket.map_size	= MEM_MAP_SIZE;
 	sock->socket.io_offset	= (unsigned long)sock->virt_io;
 	sock->socket.dev.parent	= &pdev->dev;
 	sock->socket.resource_ops = &pccard_static_ops;
 	platform_set_drvdata(pdev, sock);
 	/* setup carddetect irq: use one of the 2 GPIOs as an
 	 * edge detector.
 	 */
 	irq = gpio_to_irq(GPIO_CDA);
 	irq_set_irq_type(irq, IRQ_TYPE_EDGE_BOTH);
 	ret = request_irq(irq, cdirq, 0, "pcmcia_carddetect", sock);
 	if (ret) {
 		dev_err(&pdev->dev, "cannot setup cd irq\n");
 		goto out1;
 	}
 	ret = pcmcia_register_socket(&sock->socket);
 	if (ret) {
 		dev_err(&pdev->dev, "failed to register\n");
 		goto out2;
 	}
 	printk(KERN_INFO "MyCable XXS1500 PCMCIA socket services\n");
 	return 0;
 out2:
 	free_irq(gpio_to_irq(GPIO_CDA), sock);
 out1:
 	iounmap((void *)(sock->virt_io + (u32)mips_io_port_base));
 out0:
 	kfree(sock);
 	return ret;
 }
 static int __devexit xxs1500_pcmcia_remove(struct platform_device *pdev)
 {
 	struct xxs1500_pcmcia_sock *sock = platform_get_drvdata(pdev);
 	pcmcia_unregister_socket(&sock->socket);
 	free_irq(gpio_to_irq(GPIO_CDA), sock);
 	iounmap((void *)(sock->virt_io + (u32)mips_io_port_base));
 	kfree(sock);
 	return 0;
 }
 static struct platform_driver xxs1500_pcmcia_socket_driver = {
 	.driver	= {
 		.name	= "xxs1500_pcmcia",
 		.owner	= THIS_MODULE,
 	},
 	.probe		= xxs1500_pcmcia_probe,
 	.remove		= __devexit_p(xxs1500_pcmcia_remove),
 };
-int __init xxs1500_pcmcia_socket_load(void)
+module_platform_driver(xxs1500_pcmcia_socket_driver);
-{
-	return platform_driver_register(&xxs1500_pcmcia_socket_driver);
-}
-void  __exit xxs1500_pcmcia_socket_unload(void)
-{
-	platform_driver_unregister(&xxs1500_pcmcia_socket_driver);
-}
-module_init(xxs1500_pcmcia_socket_load);
-module_exit(xxs1500_pcmcia_socket_unload);
 MODULE_LICENSE("GPL");
 MODULE_DESCRIPTION("PCMCIA Socket Services for MyCable XXS1500 systems");
 MODULE_AUTHOR("Manuel Lauss");