/* A SL811 CLIENT DRIVER for linux 2.4.x Filename: sl811_cs.c Version: 0.0.2 Author: Yukio Yamamoto Port to sl811-hcd and 2.6.x by Botond Botyanszki Simon Pickering Last update: 2005-05-05 */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include MODULE_AUTHOR("Botond Botyanszki"); MODULE_DESCRIPTION("REX-CFU1 PCMCIA driver for 2.6"); MODULE_LICENSE("GPL"); /*====================================================================*/ /* MACROS */ /*====================================================================*/ #if defined(DEBUG) || defined(CONFIG_USB_DEBUG) #define DBG(n, args...) printk(KERN_DEBUG "sl811_cs: " args) #else #define DBG(n, args...) do{}while(0) #endif #define INFO(args...) printk(KERN_INFO "sl811_cs: " args) /*static char *version = "sl811_cs.c 0.04 2005/04/27 00:00:00 (OpenZaurus Team)";*/ #define INT_MODULE_PARM(n, v) static int n = v; MODULE_PARM(n, "i") #define CS_CHECK(fn, ret) \ do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0) /*====================================================================*/ /* VARIABLES */ /*====================================================================*/ static dev_info_t dev_info = "sl811_cs"; static dev_link_t *dev_list = NULL; static ioaddr_t base_addr = 0x00000000; static int irq = -1; static int irq_list[4] = { -1 }; MODULE_PARM(irq_list, "1-4i"); INT_MODULE_PARM(free_ports, 0); INT_MODULE_PARM(irq_mask, 0xdeb8); /*====================================================================*/ /* PROTO TYPES */ /*====================================================================*/ static dev_link_t* sl811_cs_attach(void); static void sl811_cs_detach(dev_link_t *); static void sl811_cs_config(dev_link_t *link); static void sl811_cs_release(dev_link_t *arg); static int sl811_cs_event(event_t event, int priority, event_callback_args_t *args); /*====================================================================*/ /* PROTO TYPES */ /*====================================================================*/ typedef struct local_info_t { dev_link_t link; dev_node_t node; } local_info_t; static struct pcmcia_driver sl811_driver = { .owner = THIS_MODULE, .drv = { .name = "sl811_cs", }, .attach = sl811_cs_attach, .detach = sl811_cs_detach, }; extern struct device_driver sl811h_driver; static struct sl811_platform_data platform_data; static struct res { struct resource irq_res; struct resource addr_res; struct resource data_res; } resources; static struct platform_device platform_dev = { .name = "sl811_cs", .id = 0, .num_resources = 0, .dev.dma_mask = 0, .dev.platform_data = &platform_data, .dev.bus_id = "sl811-hcd", .dev.driver = &sl811h_driver }; /*====================================================================*/ /* EXTERNAL FUNCTIONS */ /*====================================================================*/ int sl811h_probe(void *dev); /*====================================================================*/ /*====================================================================*/ static void release_platform_dev(struct device * dev) { DBG(0, "sl811_cs platform_dev release\n"); } /*====================================================================*/ static dev_link_t *sl811_cs_attach(void) { local_info_t *local; dev_link_t *link; client_reg_t client_reg; int ret, i; local = kmalloc(sizeof(local_info_t), GFP_KERNEL); if (!local) return NULL; 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; if (irq_list[0] == -1) link->irq.IRQInfo2 = irq_mask; else for (i = 0; i < 4; i++) link->irq.IRQInfo2 |= 1 << irq_list[i]; link->irq.Handler = NULL; link->conf.Attributes = 0; link->conf.Vcc = 33; link->conf.IntType = INT_MEMORY_AND_IO; /* Register with Card Services */ link->next = dev_list; dev_list = link; client_reg.dev_info = &dev_info; client_reg.Attributes = INFO_IO_CLIENT | INFO_CARD_SHARE; client_reg.EventMask = CS_EVENT_CARD_INSERTION | CS_EVENT_CARD_REMOVAL | CS_EVENT_RESET_PHYSICAL | CS_EVENT_CARD_RESET | CS_EVENT_PM_SUSPEND | CS_EVENT_PM_RESUME; client_reg.event_handler = &sl811_cs_event; client_reg.Version = 0x0210; client_reg.event_callback_args.client_data = link; ret = pcmcia_register_client(&link->handle, &client_reg); if (ret != CS_SUCCESS) { cs_error(link->handle, RegisterClient, ret); sl811_cs_detach(link); return NULL; } return link; } /* sl811_cs_attach */ /*====================================================================*/ static void sl811_cs_detach(dev_link_t *link) { dev_link_t **linkp; DBG(0, "sl811_cs_detach(0x%p)\n", link); /* Locate device structure */ for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next) if (*linkp == link) break; if (*linkp == NULL) return; #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) if (link->state & DEV_CONFIG) { #ifdef PCMCIA_DEBUG printk(KERN_DEBUG "sl811_cs: detach postponed, '%s' " "still locked\n", link->dev->dev_name); #endif link->state |= DEV_STALE_LINK; return; } #endif /* Break the link with Card Services */ if (link->handle) pcmcia_deregister_client(link->handle); /* Unlink device structure, and free it */ *linkp = link->next; /* This points to the parent local_info_t struct */ kfree(link->priv); } /* sl811_cs_detach */ /*====================================================================*/ static int sl811_hc_init(void) { /* set up the device structure */ resources.irq_res.flags = IORESOURCE_IRQ; resources.irq_res.start = irq; resources.addr_res.flags = IORESOURCE_MEM; resources.addr_res.start = base_addr; resources.addr_res.end = base_addr + 1; resources.data_res.flags = IORESOURCE_MEM; resources.data_res.start = base_addr + 1; resources.data_res.end = base_addr + 4; platform_dev.dev.release = release_platform_dev; platform_device_register(&platform_dev); /* FIXME: we register the platform device with 0 resources otherwise the unregister call won't work*/ platform_dev.num_resources = 3; platform_dev.resource = (struct resource *) &resources; /* try to initialize the host controller */ if (sl811h_probe(&platform_dev.dev) != 0) { DBG(0, "sl811h_probe() didn't return 0\n"); return 0; } return 1; } /*====================================================================*/ static void sl811_cs_config(dev_link_t *link) { client_handle_t handle = link->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; /* Does this card need audio output? */ if (cfg->flags & CISTPL_CFTABLE_AUDIO) { link->conf.Attributes |= CONF_ENABLE_SPKR; link->conf.Status = CCSR_AUDIO_ENA; } /* 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) { goto next_entry; } } else if (dflt.vcc.present & (1<vpp1.present & (1<conf.Vpp1 = link->conf.Vpp2 = cfg->vpp1.param[CISTPL_POWER_VNOM]/10000; else if (dflt.vpp1.present & (1<conf.Vpp1 = link->conf.Vpp2 = dflt.vpp1.param[CISTPL_POWER_VNOM]/10000; /* Do we need to allocate 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); } if (link->conf.Attributes & CONF_ENABLE_IRQ) CS_CHECK(RequestIRQ, pcmcia_request_irq(link->handle, &link->irq)); CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link->handle, &link->conf)); if (free_ports) { if (link->io.BasePort1) release_region(link->io.BasePort1, link->io.NumPorts1); } sprintf(dev->node.dev_name, "cf_usb0"); 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); if (link->conf.Attributes & CONF_ENABLE_IRQ) { printk(", irq %d", link->irq.AssignedIRQ); irq = link->irq.AssignedIRQ; } if (link->io.NumPorts1) { printk(", io 0x%04x-0x%04x", link->io.BasePort1, link->io.BasePort1+link->io.NumPorts1-1); base_addr = link->io.BasePort1; } printk("\n"); link->state &= ~DEV_CONFIG_PENDING; /* Release resources claimed by PCMCIA for the sl811h driver */ release_region(link->io.BasePort1, link->io.NumPorts1); if (sl811_hc_init() == 0) goto cs_failed; return; 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; } /* sl811_cs_config */ /*====================================================================*/ static void sl811_cs_release(dev_link_t * link) { DBG(0, "sl811_cs_release(0x%p)\n", link); if (link->open) { DBG(1, "sl811_cs: release postponed, '%s' still open\n", link->dev->dev_name); link->state |= DEV_STALE_CONFIG; return; } /* request IO, because PCMCIA thinks it has claimed it */ request_region(link->io.BasePort1, link->io.NumPorts1, "sl811_cs"); /* Unlink the device chain */ link->dev = NULL; 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; if (link->state & DEV_STALE_LINK) sl811_cs_detach(link); /* FIXME: if the unregister call frees up the resources, it oopses so we pretend to have 0 resources */ platform_dev.num_resources = 0; platform_dev.resource = NULL; platform_device_unregister(&platform_dev); } /* sl811_cs_release */ /*====================================================================*/ static int sl811_cs_event(event_t event, int priority, event_callback_args_t *args) { dev_link_t *link = args->client_data; DBG(1, "sl811_cs_event(0x%06x)\n", event); switch (event) { case CS_EVENT_CARD_REMOVAL: link->state &= ~DEV_PRESENT; if (link->state & DEV_CONFIG) { sl811_cs_release(link); } break; case CS_EVENT_CARD_INSERTION: link->state |= DEV_PRESENT | DEV_CONFIG_PENDING; sl811_cs_config(link); break; case CS_EVENT_PM_SUSPEND: link->state |= DEV_SUSPEND; /* Fall through... */ case CS_EVENT_RESET_PHYSICAL: if (link->state & DEV_CONFIG) pcmcia_release_configuration(link->handle); break; case CS_EVENT_PM_RESUME: link->state &= ~DEV_SUSPEND; /* Fall through... */ case CS_EVENT_CARD_RESET: if (link->state & DEV_CONFIG) pcmcia_request_configuration(link->handle, &link->conf); INFO("FIXME: card reset\n"); break; } return 0; } /* sl811_cs_event */ /*====================================================================*/ static int __init init_sl811_cs(void) { #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) servinfo_t serv; DBG(0, "%s\n", version); CardServices(GetCardServicesInfo, &serv); if (serv.Revision != CS_RELEASE_CODE) { printk(KERN_NOTICE "sl811_cs: Card Services release " "does not match!\n"); return -EINVAL; } register_pccard_driver(&dev_info, &sl811_cs_attach, &sl811_cs_detach); return 0; #else return pcmcia_register_driver(&sl811_driver); #endif } /*====================================================================*/ static void __exit exit_sl811_cs(void) { #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) DBG(0, "sl811_cs: unloading\n"); unregister_pccard_driver(&dev_info); while (dev_list != NULL) { del_timer(&dev_list->release); if (dev_list->state & DEV_CONFIG) sl811_cs_release(dev_list); sl811_cs_detach(dev_list); } #else pcmcia_unregister_driver(&sl811_driver); #endif } /*====================================================================*/ module_init(init_sl811_cs); module_exit(exit_sl811_cs);