2005-04-16 22:20:36 +00:00
|
|
|
/*
|
|
|
|
*
|
|
|
|
* 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/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>
|
2008-05-01 11:34:53 +00:00
|
|
|
#include <linux/mutex.h>
|
2005-10-29 18:07:23 +00:00
|
|
|
#include <linux/platform_device.h>
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
#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;
|
|
|
|
|
2008-05-01 11:34:53 +00:00
|
|
|
static DEFINE_MUTEX(pcmcia_sockets_lock);
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
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_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;
|
|
|
|
}
|
|
|
|
|
2008-08-27 23:05:34 +00:00
|
|
|
map->start=(unsigned int)(u32)skt->virt_io;
|
2005-04-16 22:20:36 +00:00
|
|
|
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,
|
|
|
|
.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;
|
2006-10-20 21:44:15 +00:00
|
|
|
struct au1000_pcmcia_socket *skt;
|
2005-04-16 22:20:36 +00:00
|
|
|
int ret, i;
|
|
|
|
|
2005-12-11 20:18:26 +00:00
|
|
|
sinfo = kzalloc(sizeof(struct skt_dev_info), GFP_KERNEL);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (!sinfo) {
|
|
|
|
ret = -ENOMEM;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
sinfo->nskt = nr;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Initialise the per-socket structure.
|
|
|
|
*/
|
|
|
|
for (i = 0; i < nr; i++) {
|
2006-10-20 21:44:15 +00:00
|
|
|
skt = PCMCIA_SOCKET(i);
|
2005-04-16 22:20:36 +00:00
|
|
|
memset(skt, 0, sizeof(*skt));
|
|
|
|
|
2005-07-28 08:07:22 +00:00
|
|
|
skt->socket.resource_ops = &pccard_static_ops;
|
2005-04-16 22:20:36 +00:00
|
|
|
skt->socket.ops = &au1x00_pcmcia_operations;
|
|
|
|
skt->socket.owner = ops->owner;
|
2007-03-27 05:32:28 +00:00
|
|
|
skt->socket.dev.parent = dev;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
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);
|
2010-02-24 16:40:21 +00:00
|
|
|
skt->phys_attr = AU1X_SOCK0_PHYS_ATTR;
|
|
|
|
skt->phys_mem = AU1X_SOCK0_PHYS_MEM;
|
2005-04-16 22:20:36 +00:00
|
|
|
}
|
|
|
|
else {
|
|
|
|
skt->virt_io = (void *)
|
|
|
|
(ioremap((phys_t)AU1X_SOCK1_IO, 0x1000) -
|
|
|
|
(u32)mips_io_port_base);
|
2010-02-24 16:40:21 +00:00
|
|
|
skt->phys_attr = AU1X_SOCK1_PHYS_ATTR;
|
|
|
|
skt->phys_mem = AU1X_SOCK1_PHYS_MEM;
|
2005-04-16 22:20:36 +00:00
|
|
|
}
|
|
|
|
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;
|
|
|
|
|
2006-10-20 21:44:15 +00:00
|
|
|
|
|
|
|
out_err:
|
|
|
|
flush_scheduled_work();
|
|
|
|
ops->hw_shutdown(skt);
|
|
|
|
while (i-- > 0) {
|
|
|
|
skt = PCMCIA_SOCKET(i);
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
del_timer_sync(&skt->poll_timer);
|
|
|
|
pcmcia_unregister_socket(&skt->socket);
|
|
|
|
flush_scheduled_work();
|
2006-10-20 21:44:18 +00:00
|
|
|
if (i == 0) {
|
|
|
|
iounmap(skt->virt_io + (u32)mips_io_port_base);
|
|
|
|
skt->virt_io = NULL;
|
|
|
|
}
|
|
|
|
#ifndef CONFIG_MIPS_XXS1500
|
|
|
|
else {
|
|
|
|
iounmap(skt->virt_io + (u32)mips_io_port_base);
|
|
|
|
skt->virt_io = NULL;
|
|
|
|
}
|
|
|
|
#endif
|
2005-04-16 22:20:36 +00:00
|
|
|
ops->hw_shutdown(skt);
|
|
|
|
|
2006-10-20 21:44:15 +00:00
|
|
|
}
|
2005-04-16 22:20:36 +00:00
|
|
|
kfree(sinfo);
|
|
|
|
out:
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2009-02-06 15:40:12 +00:00
|
|
|
int au1x00_drv_pcmcia_remove(struct platform_device *dev)
|
2005-04-16 22:20:36 +00:00
|
|
|
{
|
2009-02-06 15:40:12 +00:00
|
|
|
struct skt_dev_info *sinfo = platform_get_drvdata(dev);
|
2005-04-16 22:20:36 +00:00
|
|
|
int i;
|
|
|
|
|
2008-05-01 11:34:53 +00:00
|
|
|
mutex_lock(&pcmcia_sockets_lock);
|
2009-02-06 15:40:12 +00:00
|
|
|
platform_set_drvdata(dev, NULL);
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
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);
|
2005-09-15 23:42:27 +00:00
|
|
|
iounmap(skt->virt_io + (u32)mips_io_port_base);
|
2005-04-16 22:20:36 +00:00
|
|
|
skt->virt_io = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kfree(sinfo);
|
2008-05-01 11:34:53 +00:00
|
|
|
mutex_unlock(&pcmcia_sockets_lock);
|
2005-04-16 22:20:36 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
* PCMCIA "Driver" API
|
|
|
|
*/
|
|
|
|
|
2009-02-06 15:40:12 +00:00
|
|
|
static int au1x00_drv_pcmcia_probe(struct platform_device *dev)
|
2005-04-16 22:20:36 +00:00
|
|
|
{
|
|
|
|
int i, ret = -ENODEV;
|
|
|
|
|
2008-05-01 11:34:53 +00:00
|
|
|
mutex_lock(&pcmcia_sockets_lock);
|
2005-04-16 22:20:36 +00:00
|
|
|
for (i=0; i < ARRAY_SIZE(au1x00_pcmcia_hw_init); i++) {
|
2009-02-06 15:40:12 +00:00
|
|
|
ret = au1x00_pcmcia_hw_init[i](&dev->dev);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (ret == 0)
|
|
|
|
break;
|
|
|
|
}
|
2008-05-01 11:34:53 +00:00
|
|
|
mutex_unlock(&pcmcia_sockets_lock);
|
2005-04-16 22:20:36 +00:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2009-02-06 15:40:12 +00:00
|
|
|
static struct platform_driver au1x00_pcmcia_driver = {
|
|
|
|
.driver = {
|
|
|
|
.name = "au1x00-pcmcia",
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
},
|
2005-04-16 22:20:36 +00:00
|
|
|
.probe = au1x00_drv_pcmcia_probe,
|
|
|
|
.remove = au1x00_drv_pcmcia_remove,
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
/* 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;
|
2009-02-06 15:40:12 +00:00
|
|
|
error = platform_driver_register(&au1x00_pcmcia_driver);
|
2005-04-16 22:20:36 +00:00
|
|
|
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)
|
|
|
|
{
|
2009-02-06 15:40:12 +00:00
|
|
|
platform_driver_unregister(&au1x00_pcmcia_driver);
|
2005-04-16 22:20:36 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
module_init(au1x00_pcmcia_init);
|
|
|
|
module_exit(au1x00_pcmcia_exit);
|