/* * 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 * Simon Pickering * * Last update: 2005-05-12 */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include 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); tuple.DesiredTuple = CISTPL_CONFIG; tuple.Attributes = 0; tuple.TupleData = buf; tuple.TupleDataMax = sizeof(buf); tuple.TupleOffset = 0; CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple)); CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple)); CS_CHECK(ParseTuple, pcmcia_parse_tuple(link, &tuple, &parse)); link->conf.ConfigBase = parse.config.base; link->conf.Present = parse.config.rmask[0]; /* Look up the current Vcc */ CS_CHECK(GetConfigurationInfo, pcmcia_get_configuration_info(link, &conf)); 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<vcc.param[CISTPL_POWER_VNOM]/10000 != conf.Vcc) goto next_entry; } else if (dflt.vcc.present & (1<vpp1.present & (1<conf.Vpp = cfg->vpp1.param[CISTPL_POWER_VNOM]/10000; else if (dflt.vpp1.present & (1<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);