forked from Minki/linux
af2b3b503a
struct pcmcia_device *p_dev->conf.ConfigBase and .Present are set in almost
all PCMICA driver right at the beginning, using the same calls but slightly
different implementations. Unfiy this in the PCMCIA core.
Includes a small bugfix ("drivers/net/pcmcia/xirc2ps_cs.c: remove unused
label") from and Signed-off-by Adrian Bunk <bunk@stusta.de>
Signed-off-by: Dominik Brodowski <linux@dominikbrodowski.net>
329 lines
8.2 KiB
C
329 lines
8.2 KiB
C
/*
|
|
* PCMCIA driver for SL811HS (as found in REX-CFU1U)
|
|
* Filename: sl811_cs.c
|
|
* Author: Yukio Yamamoto
|
|
*
|
|
* Port to sl811-hcd and 2.6.x by
|
|
* Botond Botyanszki <boti@rocketmail.com>
|
|
* Simon Pickering
|
|
*
|
|
* Last update: 2005-05-12
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/ptrace.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/string.h>
|
|
#include <linux/timer.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/platform_device.h>
|
|
|
|
#include <pcmcia/cs_types.h>
|
|
#include <pcmcia/cs.h>
|
|
#include <pcmcia/cistpl.h>
|
|
#include <pcmcia/cisreg.h>
|
|
#include <pcmcia/ds.h>
|
|
|
|
#include <linux/usb/sl811.h>
|
|
|
|
MODULE_AUTHOR("Botond Botyanszki");
|
|
MODULE_DESCRIPTION("REX-CFU1U PCMCIA driver for 2.6");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|
|
/*====================================================================*/
|
|
/* MACROS */
|
|
/*====================================================================*/
|
|
|
|
#if defined(DEBUG) || defined(PCMCIA_DEBUG)
|
|
|
|
static int pc_debug = 0;
|
|
module_param(pc_debug, int, 0644);
|
|
|
|
#define DBG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG "sl811_cs: " args)
|
|
|
|
#else
|
|
#define DBG(n, args...) do{}while(0)
|
|
#endif /* no debugging */
|
|
|
|
#define INFO(args...) printk(KERN_INFO "sl811_cs: " args)
|
|
|
|
#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444)
|
|
|
|
#define CS_CHECK(fn, ret) \
|
|
do { \
|
|
last_fn = (fn); \
|
|
if ((last_ret = (ret)) != 0) \
|
|
goto cs_failed; \
|
|
} while (0)
|
|
|
|
/*====================================================================*/
|
|
/* VARIABLES */
|
|
/*====================================================================*/
|
|
|
|
static const char driver_name[DEV_NAME_LEN] = "sl811_cs";
|
|
|
|
typedef struct local_info_t {
|
|
struct pcmcia_device *p_dev;
|
|
dev_node_t node;
|
|
} local_info_t;
|
|
|
|
static void sl811_cs_release(struct pcmcia_device * link);
|
|
|
|
/*====================================================================*/
|
|
|
|
static void release_platform_dev(struct device * dev)
|
|
{
|
|
DBG(0, "sl811_cs platform_dev release\n");
|
|
dev->parent = NULL;
|
|
}
|
|
|
|
static struct sl811_platform_data platform_data = {
|
|
.potpg = 100,
|
|
.power = 50, /* == 100mA */
|
|
// .reset = ... FIXME: invoke CF reset on the card
|
|
};
|
|
|
|
static struct resource resources[] = {
|
|
[0] = {
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
[1] = {
|
|
// .name = "address",
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
[2] = {
|
|
// .name = "data",
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
};
|
|
|
|
extern struct platform_driver sl811h_driver;
|
|
|
|
static struct platform_device platform_dev = {
|
|
.id = -1,
|
|
.dev = {
|
|
.platform_data = &platform_data,
|
|
.release = release_platform_dev,
|
|
},
|
|
.resource = resources,
|
|
.num_resources = ARRAY_SIZE(resources),
|
|
};
|
|
|
|
static int sl811_hc_init(struct device *parent, ioaddr_t base_addr, int irq)
|
|
{
|
|
if (platform_dev.dev.parent)
|
|
return -EBUSY;
|
|
platform_dev.dev.parent = parent;
|
|
|
|
/* finish seting up the platform device */
|
|
resources[0].start = irq;
|
|
|
|
resources[1].start = base_addr;
|
|
resources[1].end = base_addr;
|
|
|
|
resources[2].start = base_addr + 1;
|
|
resources[2].end = base_addr + 1;
|
|
|
|
/* The driver core will probe for us. We know sl811-hcd has been
|
|
* initialized already because of the link order dependency created
|
|
* by referencing "sl811h_driver".
|
|
*/
|
|
platform_dev.name = sl811h_driver.driver.name;
|
|
return platform_device_register(&platform_dev);
|
|
}
|
|
|
|
/*====================================================================*/
|
|
|
|
static void sl811_cs_detach(struct pcmcia_device *link)
|
|
{
|
|
DBG(0, "sl811_cs_detach(0x%p)\n", link);
|
|
|
|
sl811_cs_release(link);
|
|
|
|
/* This points to the parent local_info_t struct */
|
|
kfree(link->priv);
|
|
}
|
|
|
|
static void sl811_cs_release(struct pcmcia_device * link)
|
|
{
|
|
DBG(0, "sl811_cs_release(0x%p)\n", link);
|
|
|
|
pcmcia_disable_device(link);
|
|
platform_device_unregister(&platform_dev);
|
|
}
|
|
|
|
static int sl811_cs_config(struct pcmcia_device *link)
|
|
{
|
|
struct device *parent = &handle_to_dev(link);
|
|
local_info_t *dev = link->priv;
|
|
tuple_t tuple;
|
|
cisparse_t parse;
|
|
int last_fn, last_ret;
|
|
u_char buf[64];
|
|
config_info_t conf;
|
|
cistpl_cftable_entry_t dflt = { 0 };
|
|
|
|
DBG(0, "sl811_cs_config(0x%p)\n", link);
|
|
|
|
/* Look up the current Vcc */
|
|
CS_CHECK(GetConfigurationInfo,
|
|
pcmcia_get_configuration_info(link, &conf));
|
|
|
|
tuple.Attributes = 0;
|
|
tuple.TupleData = buf;
|
|
tuple.TupleDataMax = sizeof(buf);
|
|
tuple.TupleOffset = 0;
|
|
tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
|
|
CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
|
|
while (1) {
|
|
cistpl_cftable_entry_t *cfg = &(parse.cftable_entry);
|
|
|
|
if (pcmcia_get_tuple_data(link, &tuple) != 0
|
|
|| pcmcia_parse_tuple(link, &tuple, &parse)
|
|
!= 0)
|
|
goto next_entry;
|
|
|
|
if (cfg->flags & CISTPL_CFTABLE_DEFAULT) {
|
|
dflt = *cfg;
|
|
}
|
|
|
|
if (cfg->index == 0)
|
|
goto next_entry;
|
|
|
|
link->conf.ConfigIndex = cfg->index;
|
|
|
|
/* Use power settings for Vcc and Vpp if present */
|
|
/* Note that the CIS values need to be rescaled */
|
|
if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) {
|
|
if (cfg->vcc.param[CISTPL_POWER_VNOM]/10000
|
|
!= conf.Vcc)
|
|
goto next_entry;
|
|
} else if (dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) {
|
|
if (dflt.vcc.param[CISTPL_POWER_VNOM]/10000
|
|
!= conf.Vcc)
|
|
goto next_entry;
|
|
}
|
|
|
|
if (cfg->vpp1.present & (1<<CISTPL_POWER_VNOM))
|
|
link->conf.Vpp =
|
|
cfg->vpp1.param[CISTPL_POWER_VNOM]/10000;
|
|
else if (dflt.vpp1.present & (1<<CISTPL_POWER_VNOM))
|
|
link->conf.Vpp =
|
|
dflt.vpp1.param[CISTPL_POWER_VNOM]/10000;
|
|
|
|
/* we need an interrupt */
|
|
if (cfg->irq.IRQInfo1 || dflt.irq.IRQInfo1)
|
|
link->conf.Attributes |= CONF_ENABLE_IRQ;
|
|
|
|
/* IO window settings */
|
|
link->io.NumPorts1 = link->io.NumPorts2 = 0;
|
|
if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) {
|
|
cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
|
|
|
|
link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
|
|
link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
|
|
link->io.BasePort1 = io->win[0].base;
|
|
link->io.NumPorts1 = io->win[0].len;
|
|
|
|
if (pcmcia_request_io(link, &link->io) != 0)
|
|
goto next_entry;
|
|
}
|
|
break;
|
|
|
|
next_entry:
|
|
pcmcia_disable_device(link);
|
|
last_ret = pcmcia_get_next_tuple(link, &tuple);
|
|
}
|
|
|
|
/* require an IRQ and two registers */
|
|
if (!link->io.NumPorts1 || link->io.NumPorts1 < 2)
|
|
goto cs_failed;
|
|
if (link->conf.Attributes & CONF_ENABLE_IRQ)
|
|
CS_CHECK(RequestIRQ,
|
|
pcmcia_request_irq(link, &link->irq));
|
|
else
|
|
goto cs_failed;
|
|
|
|
CS_CHECK(RequestConfiguration,
|
|
pcmcia_request_configuration(link, &link->conf));
|
|
|
|
sprintf(dev->node.dev_name, driver_name);
|
|
dev->node.major = dev->node.minor = 0;
|
|
link->dev_node = &dev->node;
|
|
|
|
printk(KERN_INFO "%s: index 0x%02x: ",
|
|
dev->node.dev_name, link->conf.ConfigIndex);
|
|
if (link->conf.Vpp)
|
|
printk(", Vpp %d.%d", link->conf.Vpp/10, link->conf.Vpp%10);
|
|
printk(", irq %d", link->irq.AssignedIRQ);
|
|
printk(", io 0x%04x-0x%04x", link->io.BasePort1,
|
|
link->io.BasePort1+link->io.NumPorts1-1);
|
|
printk("\n");
|
|
|
|
if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ)
|
|
< 0) {
|
|
cs_failed:
|
|
printk("sl811_cs_config failed\n");
|
|
cs_error(link, last_fn, last_ret);
|
|
sl811_cs_release(link);
|
|
return -ENODEV;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int sl811_cs_probe(struct pcmcia_device *link)
|
|
{
|
|
local_info_t *local;
|
|
|
|
local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
|
|
if (!local)
|
|
return -ENOMEM;
|
|
memset(local, 0, sizeof(local_info_t));
|
|
local->p_dev = link;
|
|
link->priv = local;
|
|
|
|
/* Initialize */
|
|
link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
|
|
link->irq.IRQInfo1 = IRQ_INFO2_VALID|IRQ_LEVEL_ID;
|
|
link->irq.Handler = NULL;
|
|
|
|
link->conf.Attributes = 0;
|
|
link->conf.IntType = INT_MEMORY_AND_IO;
|
|
|
|
return sl811_cs_config(link);
|
|
}
|
|
|
|
static struct pcmcia_device_id sl811_ids[] = {
|
|
PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001), /* RATOC USB HOST CF+ Card */
|
|
PCMCIA_DEVICE_NULL,
|
|
};
|
|
MODULE_DEVICE_TABLE(pcmcia, sl811_ids);
|
|
|
|
static struct pcmcia_driver sl811_cs_driver = {
|
|
.owner = THIS_MODULE,
|
|
.drv = {
|
|
.name = (char *)driver_name,
|
|
},
|
|
.probe = sl811_cs_probe,
|
|
.remove = sl811_cs_detach,
|
|
.id_table = sl811_ids,
|
|
};
|
|
|
|
/*====================================================================*/
|
|
|
|
static int __init init_sl811_cs(void)
|
|
{
|
|
return pcmcia_register_driver(&sl811_cs_driver);
|
|
}
|
|
module_init(init_sl811_cs);
|
|
|
|
static void __exit exit_sl811_cs(void)
|
|
{
|
|
pcmcia_unregister_driver(&sl811_cs_driver);
|
|
}
|
|
module_exit(exit_sl811_cs);
|