| /* |
| * 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 { |
| dev_link_t link; |
| dev_node_t node; |
| } local_info_t; |
| |
| static void sl811_cs_release(dev_link_t * 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 *p_dev) |
| { |
| dev_link_t *link = dev_to_instance(p_dev); |
| |
| DBG(0, "sl811_cs_detach(0x%p)\n", link); |
| |
| link->state &= ~DEV_PRESENT; |
| if (link->state & DEV_CONFIG) |
| sl811_cs_release(link); |
| |
| /* This points to the parent local_info_t struct */ |
| kfree(link->priv); |
| } |
| |
| static void sl811_cs_release(dev_link_t * link) |
| { |
| |
| DBG(0, "sl811_cs_release(0x%p)\n", link); |
| |
| /* Unlink the device chain */ |
| link->dev = NULL; |
| |
| platform_device_unregister(&platform_dev); |
| pcmcia_release_configuration(link->handle); |
| if (link->io.NumPorts1) |
| pcmcia_release_io(link->handle, &link->io); |
| if (link->irq.AssignedIRQ) |
| pcmcia_release_irq(link->handle, &link->irq); |
| link->state &= ~DEV_CONFIG; |
| } |
| |
| static void sl811_cs_config(dev_link_t *link) |
| { |
| client_handle_t handle = link->handle; |
| struct device *parent = &handle_to_dev(handle); |
| 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); |
| |
| tuple.DesiredTuple = CISTPL_CONFIG; |
| tuple.Attributes = 0; |
| tuple.TupleData = buf; |
| tuple.TupleDataMax = sizeof(buf); |
| tuple.TupleOffset = 0; |
| CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple)); |
| CS_CHECK(GetTupleData, pcmcia_get_tuple_data(handle, &tuple)); |
| CS_CHECK(ParseTuple, pcmcia_parse_tuple(handle, &tuple, &parse)); |
| link->conf.ConfigBase = parse.config.base; |
| link->conf.Present = parse.config.rmask[0]; |
| |
| /* Configure card */ |
| link->state |= DEV_CONFIG; |
| |
| /* Look up the current Vcc */ |
| CS_CHECK(GetConfigurationInfo, |
| pcmcia_get_configuration_info(handle, &conf)); |
| link->conf.Vcc = conf.Vcc; |
| |
| tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY; |
| CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple)); |
| while (1) { |
| cistpl_cftable_entry_t *cfg = &(parse.cftable_entry); |
| |
| if (pcmcia_get_tuple_data(handle, &tuple) != 0 |
| || pcmcia_parse_tuple(handle, &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.Vpp1 = link->conf.Vpp2 = |
| cfg->vpp1.param[CISTPL_POWER_VNOM]/10000; |
| else if (dflt.vpp1.present & (1<<CISTPL_POWER_VNOM)) |
| link->conf.Vpp1 = link->conf.Vpp2 = |
| 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->handle, &link->io) != 0) |
| goto next_entry; |
| } |
| break; |
| |
| next_entry: |
| if (link->io.NumPorts1) |
| pcmcia_release_io(link->handle, &link->io); |
| last_ret = pcmcia_get_next_tuple(handle, &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->handle, &link->irq)); |
| else |
| goto cs_failed; |
| |
| CS_CHECK(RequestConfiguration, |
| pcmcia_request_configuration(link->handle, &link->conf)); |
| |
| sprintf(dev->node.dev_name, driver_name); |
| dev->node.major = dev->node.minor = 0; |
| link->dev = &dev->node; |
| |
| printk(KERN_INFO "%s: index 0x%02x: Vcc %d.%d", |
| dev->node.dev_name, link->conf.ConfigIndex, |
| link->conf.Vcc/10, link->conf.Vcc%10); |
| if (link->conf.Vpp1) |
| printk(", Vpp %d.%d", link->conf.Vpp1/10, link->conf.Vpp1%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"); |
| |
| link->state &= ~DEV_CONFIG_PENDING; |
| |
| if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ) |
| < 0) { |
| cs_failed: |
| printk("sl811_cs_config failed\n"); |
| cs_error(link->handle, last_fn, last_ret); |
| sl811_cs_release(link); |
| link->state &= ~DEV_CONFIG_PENDING; |
| } |
| } |
| |
| static int sl811_suspend(struct pcmcia_device *dev) |
| { |
| dev_link_t *link = dev_to_instance(dev); |
| |
| link->state |= DEV_SUSPEND; |
| if (link->state & DEV_CONFIG) |
| pcmcia_release_configuration(link->handle); |
| |
| return 0; |
| } |
| |
| static int sl811_resume(struct pcmcia_device *dev) |
| { |
| dev_link_t *link = dev_to_instance(dev); |
| |
| link->state &= ~DEV_SUSPEND; |
| if (link->state & DEV_CONFIG) |
| pcmcia_request_configuration(link->handle, &link->conf); |
| |
| return 0; |
| } |
| |
| static int sl811_cs_attach(struct pcmcia_device *p_dev) |
| { |
| local_info_t *local; |
| dev_link_t *link; |
| |
| local = kmalloc(sizeof(local_info_t), GFP_KERNEL); |
| if (!local) |
| return -ENOMEM; |
| memset(local, 0, sizeof(local_info_t)); |
| link = &local->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.Vcc = 33; |
| link->conf.IntType = INT_MEMORY_AND_IO; |
| |
| link->handle = p_dev; |
| p_dev->instance = link; |
| |
| link->state |= DEV_PRESENT | DEV_CONFIG_PENDING; |
| sl811_cs_config(link); |
| |
| return 0; |
| } |
| |
| 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_attach, |
| .remove = sl811_cs_detach, |
| .id_table = sl811_ids, |
| .suspend = sl811_suspend, |
| .resume = sl811_resume, |
| }; |
| |
| /*====================================================================*/ |
| |
| 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); |