diff options
Diffstat (limited to 'packages/cfu1/files/sl811_cs.c')
| -rw-r--r-- | packages/cfu1/files/sl811_cs.c | 529 |
1 files changed, 0 insertions, 529 deletions
diff --git a/packages/cfu1/files/sl811_cs.c b/packages/cfu1/files/sl811_cs.c deleted file mode 100644 index 8b6d4ae2f6..0000000000 --- a/packages/cfu1/files/sl811_cs.c +++ /dev/null @@ -1,529 +0,0 @@ -/* - 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 <boti()rocketmail.com> - Simon Pickering - - Last update: 2005-05-05 -*/ - -#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/version.h> -#include <asm/io.h> -#include <asm/system.h> - -#include <pcmcia/version.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("Yukio Yamamoto"); -MODULE_DESCRIPTION("REX-CFU1 PCMCIA driver"); -MODULE_LICENSE("GPL"); - - -/*====================================================================*/ -/* MACROS */ -/*====================================================================*/ - -/* FIXME */ -//#ifdef 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); -int sl811h_remove(struct device *dev); - -/*====================================================================*/ - - -/*====================================================================*/ -static void release_platform_dev(struct device * dev) { - DBG(0, "sl811_cs platform_dev release\n"); -} - -/*====================================================================*/ -static void sl811_cs_error(client_handle_t handle, int func, int ret) -{ - error_info_t err = { func, ret }; - pcmcia_report_error(handle, &err); -} - -/*====================================================================*/ -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) { - sl811_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: resources already claimed by pcmcia, so we cannot register - the device with the irq and io ports */ - 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<<CISTPL_POWER_VNOM)) { - if (conf.Vcc != cfg->vcc.param[CISTPL_POWER_VNOM]/10000) { - goto next_entry; - } - } else if (dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) { - if (conf.Vcc != dflt.vcc.param[CISTPL_POWER_VNOM]/10000) { - 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; - - /* 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); - } - - /* IRQ is requested by the sl811-hcd driver */ - pcmcia_release_irq(link->handle, &link->irq); - - 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; - - if (sl811_hc_init() == 0) goto cs_failed; - - return; - - cs_failed: - printk("DEBUG: sl811_cs_config failed\n"); - sl811_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; - } - - /* 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); - - sl811h_remove(&platform_dev.dev); - - /* FIXME: resources already claimed by pcmcia, so we cannot register - the device with the irq and io ports */ - 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); - - /* Reset routine will be added in the next version */ - DBG("FIXME: card reset\n"); - /* hc_found_hci(irq, base_addr, base_addr+1); */ - - 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); - |