1 files changed, 579 insertions, 0 deletions

diff --git a/drivers/pcmcia/au1000_generic.c b/drivers/pcmcia/au1000_generic.c
new file mode 100644
index 000000000000..9fa7f15d89e5
--- /dev/null
+++ b/drivers/pcmcia/au1000_generic.c
@@ -0,0 +1,579 @@
+/*
+ *
+ * Alchemy Semi Au1000 pcmcia driver
+ *
+ * Copyright 2001-2003 MontaVista Software Inc.
+ * Author: MontaVista Software, Inc.
+ *              ppopov@embeddedalley.com or source@mvista.com
+ *
+ * Copyright 2004 Pete Popov, Embedded Alley Solutions, Inc.
+ * Updated the driver to 2.6. Followed the sa11xx API and largely
+ * copied many of the hardware independent functions.
+ *
+ * ########################################################################
+ *
+ *  This program is free software; you can distribute it and/or modify it
+ *  under the terms of the GNU General Public License (Version 2) as
+ *  published by the Free Software Foundation.
+ *
+ *  This program is distributed in the hope 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/moduleparam.h>
+#include <linux/init.h>
+#include <linux/config.h>
+#include <linux/cpufreq.h>
+#include <linux/ioport.h>
+#include <linux/kernel.h>
+#include <linux/timer.h>
+#include <linux/mm.h>
+#include <linux/notifier.h>
+#include <linux/interrupt.h>
+#include <linux/spinlock.h>
+#include <linux/device.h>
+
+#include <asm/io.h>
+#include <asm/irq.h>
+#include <asm/system.h>
+
+#include <asm/mach-au1x00/au1000.h>
+#include "au1000_generic.h"
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Pete Popov <ppopov@embeddedalley.com>");
+MODULE_DESCRIPTION("Linux PCMCIA Card Services: Au1x00 Socket Controller");
+
+#if 0
+#define debug(x,args...) printk(KERN_DEBUG "%s: " x, __func__ , ##args)
+#else
+#define debug(x,args...)
+#endif
+
+#define MAP_SIZE 0x100000
+extern struct au1000_pcmcia_socket au1000_pcmcia_socket[];
+#define PCMCIA_SOCKET(x)        (au1000_pcmcia_socket + (x))
+#define to_au1000_socket(x)     container_of(x, struct au1000_pcmcia_socket, socket)
+
+/* Some boards like to support CF cards as IDE root devices, so they
+ * grab pcmcia sockets directly.
+ */
+u32 *pcmcia_base_vaddrs[2];
+extern const unsigned long mips_io_port_base;
+
+DECLARE_MUTEX(pcmcia_sockets_lock);
+
+static int (*au1x00_pcmcia_hw_init[])(struct device *dev) = {
+        au1x_board_init,
+};
+
+static int
+au1x00_pcmcia_skt_state(struct au1000_pcmcia_socket *skt)
+{
+        struct pcmcia_state state;
+        unsigned int stat;
+
+        memset(&state, 0, sizeof(struct pcmcia_state));
+
+        skt->ops->socket_state(skt, &state);
+
+        stat = state.detect  ? SS_DETECT : 0;
+        stat |= state.ready  ? SS_READY  : 0;
+        stat |= state.wrprot ? SS_WRPROT : 0;
+        stat |= state.vs_3v  ? SS_3VCARD : 0;
+        stat |= state.vs_Xv  ? SS_XVCARD : 0;
+        stat |= skt->cs_state.Vcc ? SS_POWERON : 0;
+
+        if (skt->cs_state.flags & SS_IOCARD)
+                stat |= state.bvd1 ? SS_STSCHG : 0;
+        else {
+                if (state.bvd1 == 0)
+                        stat |= SS_BATDEAD;
+                else if (state.bvd2 == 0)
+                        stat |= SS_BATWARN;
+        }
+        return stat;
+}
+
+/*
+ * au100_pcmcia_config_skt
+ *
+ * Convert PCMCIA socket state to our socket configure structure.
+ */
+static int
+au1x00_pcmcia_config_skt(struct au1000_pcmcia_socket *skt, socket_state_t *state)
+{
+        int ret;
+
+        ret = skt->ops->configure_socket(skt, state);
+        if (ret == 0) {
+                skt->cs_state = *state;
+        }
+
+        if (ret < 0)
+                debug("unable to configure socket %d\n", skt->nr);
+
+        return ret;
+}
+
+/* au1x00_pcmcia_sock_init()
+ *
+ * (Re-)Initialise the socket, turning on status interrupts
+ * and PCMCIA bus.  This must wait for power to stabilise
+ * so that the card status signals report correctly.
+ *
+ * Returns: 0
+ */
+static int au1x00_pcmcia_sock_init(struct pcmcia_socket *sock)
+{
+        struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
+
+        debug("initializing socket %u\n", skt->nr);
+
+        skt->ops->socket_init(skt);
+        return 0;
+}
+
+/*
+ * au1x00_pcmcia_suspend()
+ *
+ * Remove power on the socket, disable IRQs from the card.
+ * Turn off status interrupts, and disable the PCMCIA bus.
+ *
+ * Returns: 0
+ */
+static int au1x00_pcmcia_suspend(struct pcmcia_socket *sock)
+{
+        struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
+
+        debug("suspending socket %u\n", skt->nr);
+
+        skt->ops->socket_suspend(skt);
+
+        return 0;
+}
+
+static DEFINE_SPINLOCK(status_lock);
+
+/*
+ * au1x00_check_status()
+ */
+static void au1x00_check_status(struct au1000_pcmcia_socket *skt)
+{
+        unsigned int events;
+
+        debug("entering PCMCIA monitoring thread\n");
+
+        do {
+                unsigned int status;
+                unsigned long flags;
+
+                status = au1x00_pcmcia_skt_state(skt);
+
+                spin_lock_irqsave(&status_lock, flags);
+                events = (status ^ skt->status) & skt->cs_state.csc_mask;
+                skt->status = status;
+                spin_unlock_irqrestore(&status_lock, flags);
+
+                debug("events: %s%s%s%s%s%s\n",
+                        events == 0         ? "<NONE>"   : "",
+                        events & SS_DETECT  ? "DETECT "  : "",
+                        events & SS_READY   ? "READY "   : "",
+                        events & SS_BATDEAD ? "BATDEAD " : "",
+                        events & SS_BATWARN ? "BATWARN " : "",
+                        events & SS_STSCHG  ? "STSCHG "  : "");
+
+                if (events)
+                        pcmcia_parse_events(&skt->socket, events);
+        } while (events);
+}
+
+/* 
+ * au1x00_pcmcia_poll_event()
+ * Let's poll for events in addition to IRQs since IRQ only is unreliable...
+ */
+static void au1x00_pcmcia_poll_event(unsigned long dummy)
+{
+        struct au1000_pcmcia_socket *skt = (struct au1000_pcmcia_socket *)dummy;
+        debug("polling for events\n");
+
+        mod_timer(&skt->poll_timer, jiffies + AU1000_PCMCIA_POLL_PERIOD);
+
+        au1x00_check_status(skt);
+}
+
+/* au1x00_pcmcia_get_status()
+ *
+ * From the sa11xx_core.c:
+ * Implements the get_status() operation for the in-kernel PCMCIA
+ * service (formerly SS_GetStatus in Card Services). Essentially just
+ * fills in bits in `status' according to internal driver state or
+ * the value of the voltage detect chipselect register.
+ *
+ * As a debugging note, during card startup, the PCMCIA core issues
+ * three set_socket() commands in a row the first with RESET deasserted,
+ * the second with RESET asserted, and the last with RESET deasserted
+ * again. Following the third set_socket(), a get_status() command will
+ * be issued. The kernel is looking for the SS_READY flag (see
+ * setup_socket(), reset_socket(), and unreset_socket() in cs.c).
+ *
+ * Returns: 0
+ */
+static int
+au1x00_pcmcia_get_status(struct pcmcia_socket *sock, unsigned int *status)
+{
+        struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
+
+        skt->status = au1x00_pcmcia_skt_state(skt);
+        *status = skt->status;
+
+        return 0;
+}
+
+/* au1x00_pcmcia_get_socket()
+ * Implements the get_socket() operation for the in-kernel PCMCIA
+ * service (formerly SS_GetSocket in Card Services). Not a very
+ * exciting routine.
+ *
+ * Returns: 0
+ */
+static int
+au1x00_pcmcia_get_socket(struct pcmcia_socket *sock, socket_state_t *state)
+{
+  struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
+
+  debug("for sock %u\n", skt->nr);
+  *state = skt->cs_state;
+  return 0;
+}
+
+/* au1x00_pcmcia_set_socket()
+ * Implements the set_socket() operation for the in-kernel PCMCIA
+ * service (formerly SS_SetSocket in Card Services). We more or
+ * less punt all of this work and let the kernel handle the details
+ * of power configuration, reset, &c. We also record the value of
+ * `state' in order to regurgitate it to the PCMCIA core later.
+ *
+ * Returns: 0
+ */
+static int
+au1x00_pcmcia_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
+{
+  struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
+
+  debug("for sock %u\n", skt->nr);
+
+  debug("\tmask:  %s%s%s%s%s%s\n\tflags: %s%s%s%s%s%s\n",
+        (state->csc_mask==0)?"<NONE>":"",
+        (state->csc_mask&SS_DETECT)?"DETECT ":"",
+        (state->csc_mask&SS_READY)?"READY ":"",
+        (state->csc_mask&SS_BATDEAD)?"BATDEAD ":"",
+        (state->csc_mask&SS_BATWARN)?"BATWARN ":"",
+        (state->csc_mask&SS_STSCHG)?"STSCHG ":"",
+        (state->flags==0)?"<NONE>":"",
+        (state->flags&SS_PWR_AUTO)?"PWR_AUTO ":"",
+        (state->flags&SS_IOCARD)?"IOCARD ":"",
+        (state->flags&SS_RESET)?"RESET ":"",
+        (state->flags&SS_SPKR_ENA)?"SPKR_ENA ":"",
+        (state->flags&SS_OUTPUT_ENA)?"OUTPUT_ENA ":"");
+  debug("\tVcc %d  Vpp %d  irq %d\n",
+        state->Vcc, state->Vpp, state->io_irq);
+
+  return au1x00_pcmcia_config_skt(skt, state);
+}
+
+int 
+au1x00_pcmcia_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *map)
+{
+        struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
+        unsigned int speed;
+
+        if(map->map>=MAX_IO_WIN){
+                debug("map (%d) out of range\n", map->map);
+                return -1;
+        }
+
+        if(map->flags&MAP_ACTIVE){
+                speed=(map->speed>0)?map->speed:AU1000_PCMCIA_IO_SPEED;
+                skt->spd_io[map->map] = speed;
+        }
+
+        map->start=(ioaddr_t)(u32)skt->virt_io;
+        map->stop=map->start+MAP_SIZE;
+        return 0;
+
+}  /* au1x00_pcmcia_set_io_map() */
+
+
+static int 
+au1x00_pcmcia_set_mem_map(struct pcmcia_socket *sock, struct pccard_mem_map *map)
+{
+        struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
+        unsigned short speed = map->speed;
+
+        if(map->map>=MAX_WIN){
+                debug("map (%d) out of range\n", map->map);
+                return -1;
+        }
+
+        if (map->flags & MAP_ATTRIB) {
+                skt->spd_attr[map->map] = speed;
+                skt->spd_mem[map->map] = 0;
+        } else {
+                skt->spd_attr[map->map] = 0;
+                skt->spd_mem[map->map] = speed;
+        }
+
+        if (map->flags & MAP_ATTRIB) {
+                map->static_start = skt->phys_attr + map->card_start;
+        }
+        else {
+                map->static_start = skt->phys_mem + map->card_start;
+        }
+
+        debug("set_mem_map %d start %08lx card_start %08x\n",
+                        map->map, map->static_start, map->card_start);
+        return 0;
+
+}  /* au1x00_pcmcia_set_mem_map() */
+
+static struct pccard_operations au1x00_pcmcia_operations = {
+        .init                   = au1x00_pcmcia_sock_init,
+        .suspend                = au1x00_pcmcia_suspend,
+        .get_status             = au1x00_pcmcia_get_status,
+        .get_socket             = au1x00_pcmcia_get_socket,
+        .set_socket             = au1x00_pcmcia_set_socket,
+        .set_io_map             = au1x00_pcmcia_set_io_map,
+        .set_mem_map            = au1x00_pcmcia_set_mem_map,
+};
+
+static const char *skt_names[] = {
+        "PCMCIA socket 0",
+        "PCMCIA socket 1",
+};
+
+struct skt_dev_info {
+        int nskt;
+};
+
+int au1x00_pcmcia_socket_probe(struct device *dev, struct pcmcia_low_level *ops, int first, int nr)
+{
+        struct skt_dev_info *sinfo;
+        int ret, i;
+
+        sinfo = kmalloc(sizeof(struct skt_dev_info), GFP_KERNEL);
+        if (!sinfo) {
+                ret = -ENOMEM;
+                goto out;
+        }
+
+        memset(sinfo, 0, sizeof(struct skt_dev_info));
+        sinfo->nskt = nr;
+
+        /*
+         * Initialise the per-socket structure.
+         */
+        for (i = 0; i < nr; i++) {
+                struct au1000_pcmcia_socket *skt = PCMCIA_SOCKET(i);
+                memset(skt, 0, sizeof(*skt));
+
+                skt->socket.ops = &au1x00_pcmcia_operations;
+                skt->socket.owner = ops->owner;
+                skt->socket.dev.dev = dev;
+
+                init_timer(&skt->poll_timer);
+                skt->poll_timer.function = au1x00_pcmcia_poll_event;
+                skt->poll_timer.data = (unsigned long)skt;
+                skt->poll_timer.expires = jiffies + AU1000_PCMCIA_POLL_PERIOD;
+
+                skt->nr         = first + i;
+                skt->irq        = 255;
+                skt->dev        = dev;
+                skt->ops        = ops;
+
+                skt->res_skt.name       = skt_names[skt->nr];
+                skt->res_io.name        = "io";
+                skt->res_io.flags       = IORESOURCE_MEM | IORESOURCE_BUSY;
+                skt->res_mem.name       = "memory";
+                skt->res_mem.flags      = IORESOURCE_MEM;
+                skt->res_attr.name      = "attribute";
+                skt->res_attr.flags     = IORESOURCE_MEM;
+
+                /*
+                 * 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.
+                 */
+                if (i == 0) {
+                        skt->virt_io = (void *)
+                                (ioremap((phys_t)AU1X_SOCK0_IO, 0x1000) -
+                                (u32)mips_io_port_base);
+                        skt->phys_attr = AU1X_SOCK0_PSEUDO_PHYS_ATTR;
+                        skt->phys_mem = AU1X_SOCK0_PSEUDO_PHYS_MEM;
+                }
+#ifndef CONFIG_MIPS_XXS1500
+                else  {
+                        skt->virt_io = (void *)
+                                (ioremap((phys_t)AU1X_SOCK1_IO, 0x1000) -
+                                (u32)mips_io_port_base);
+                        skt->phys_attr = AU1X_SOCK1_PSEUDO_PHYS_ATTR;
+                        skt->phys_mem = AU1X_SOCK1_PSEUDO_PHYS_MEM;
+                }
+#endif
+                pcmcia_base_vaddrs[i] = (u32 *)skt->virt_io;
+                ret = ops->hw_init(skt);
+
+                skt->socket.features = SS_CAP_STATIC_MAP|SS_CAP_PCCARD;
+                skt->socket.irq_mask = 0;
+                skt->socket.map_size = MAP_SIZE;
+                skt->socket.pci_irq = skt->irq;
+                skt->socket.io_offset = (unsigned long)skt->virt_io;
+
+                skt->status = au1x00_pcmcia_skt_state(skt);
+
+                ret = pcmcia_register_socket(&skt->socket);
+                if (ret)
+                        goto out_err;
+
+                WARN_ON(skt->socket.sock != i);
+
+                add_timer(&skt->poll_timer);
+        }
+
+        dev_set_drvdata(dev, sinfo);
+        return 0;
+
+        do {
+                struct au1000_pcmcia_socket *skt = PCMCIA_SOCKET(i);
+
+                del_timer_sync(&skt->poll_timer);
+                pcmcia_unregister_socket(&skt->socket);
+out_err:
+                flush_scheduled_work();
+                ops->hw_shutdown(skt);
+
+                i--;
+        } while (i > 0);
+        kfree(sinfo);
+out:
+        return ret;
+}
+
+int au1x00_drv_pcmcia_remove(struct device *dev)
+{
+        struct skt_dev_info *sinfo = dev_get_drvdata(dev);
+        int i;
+
+        down(&pcmcia_sockets_lock);
+        dev_set_drvdata(dev, NULL);
+
+        for (i = 0; i < sinfo->nskt; i++) {
+                struct au1000_pcmcia_socket *skt = PCMCIA_SOCKET(i);
+
+                del_timer_sync(&skt->poll_timer);
+                pcmcia_unregister_socket(&skt->socket);
+                flush_scheduled_work();
+                skt->ops->hw_shutdown(skt);
+                au1x00_pcmcia_config_skt(skt, &dead_socket);
+                iounmap(skt->virt_io);
+                skt->virt_io = NULL;
+        }
+
+        kfree(sinfo);
+        up(&pcmcia_sockets_lock);
+        return 0;
+}
+
+
+/*
+ * PCMCIA "Driver" API
+ */
+
+static int au1x00_drv_pcmcia_probe(struct device *dev)
+{
+        int i, ret = -ENODEV;
+
+        down(&pcmcia_sockets_lock);
+        for (i=0; i < ARRAY_SIZE(au1x00_pcmcia_hw_init); i++) {
+                ret = au1x00_pcmcia_hw_init[i](dev);
+                if (ret == 0)
+                        break;
+        }
+        up(&pcmcia_sockets_lock);
+        return ret;
+}
+
+
+static int au1x00_drv_pcmcia_suspend(struct device *dev, u32 state, u32 level)
+{
+        int ret = 0;
+        if (level == SUSPEND_SAVE_STATE)
+                ret = pcmcia_socket_dev_suspend(dev, state);
+        return ret;
+}
+
+static int au1x00_drv_pcmcia_resume(struct device *dev, u32 level)
+{
+        int ret = 0;
+        if (level == RESUME_RESTORE_STATE)
+                ret = pcmcia_socket_dev_resume(dev);
+        return ret;
+}
+
+
+static struct device_driver au1x00_pcmcia_driver = {
+        .probe          = au1x00_drv_pcmcia_probe,
+        .remove         = au1x00_drv_pcmcia_remove,
+        .name           = "au1x00-pcmcia",
+        .bus            = &platform_bus_type,
+        .suspend        = au1x00_drv_pcmcia_suspend,
+        .resume         = au1x00_drv_pcmcia_resume
+};
+
+static struct platform_device au1x00_device = {
+        .name = "au1x00-pcmcia",
+        .id = 0,
+};
+
+/* au1x00_pcmcia_init()
+ *
+ * This routine performs low-level PCMCIA initialization and then
+ * registers this socket driver with Card Services.
+ *
+ * Returns: 0 on success, -ve error code on failure
+ */
+static int __init au1x00_pcmcia_init(void)
+{
+        int error = 0;
+        if ((error = driver_register(&au1x00_pcmcia_driver)))
+                return error;
+        platform_device_register(&au1x00_device);
+        return error;
+}
+
+/* au1x00_pcmcia_exit()
+ * Invokes the low-level kernel service to free IRQs associated with this
+ * socket controller and reset GPIO edge detection.
+ */
+static void __exit au1x00_pcmcia_exit(void)
+{
+        driver_unregister(&au1x00_pcmcia_driver);
+        platform_device_unregister(&au1x00_device);
+}
+
+module_init(au1x00_pcmcia_init);
+module_exit(au1x00_pcmcia_exit);