sl811_cs.c revision dd00cc486ab1c17049a535413d1751ef3482141c
1c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/* 2c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * PCMCIA driver for SL811HS (as found in REX-CFU1U) 3c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * Filename: sl811_cs.c 4c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * Author: Yukio Yamamoto 5c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * 6c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * Port to sl811-hcd and 2.6.x by 7c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * Botond Botyanszki <boti@rocketmail.com> 8c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * Simon Pickering 9c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * 10c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * Last update: 2005-05-12 11c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell */ 12c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 13c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/kernel.h> 14c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/module.h> 15c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/init.h> 16c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/ptrace.h> 17c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/slab.h> 18c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/string.h> 19c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/timer.h> 20c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/ioport.h> 21d052d1beff706920e82c5d55006b08e256b5df09Russell King#include <linux/platform_device.h> 22c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 23c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/cs_types.h> 24c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/cs.h> 25c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/cistpl.h> 26c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/cisreg.h> 27c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/ds.h> 28c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 29325a4af60dc945bf2da9cbcdbabb276e312b297cDavid Brownell#include <linux/usb/sl811.h> 30c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 31c6de2b64eb575a3f9326969ec5fcdc6032b38e42David BrownellMODULE_AUTHOR("Botond Botyanszki"); 32c6de2b64eb575a3f9326969ec5fcdc6032b38e42David BrownellMODULE_DESCRIPTION("REX-CFU1U PCMCIA driver for 2.6"); 33c6de2b64eb575a3f9326969ec5fcdc6032b38e42David BrownellMODULE_LICENSE("GPL"); 34c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 35c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 36c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/ 37c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/* MACROS */ 38c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/ 39c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 40c9a50cc9318772e62d56f2a9172bdfda72bdacbeDavid Brownell#if defined(DEBUG) || defined(PCMCIA_DEBUG) 41c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 42c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic int pc_debug = 0; 43c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellmodule_param(pc_debug, int, 0644); 44c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 45c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define DBG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG "sl811_cs: " args) 46c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 47c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#else 48c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define DBG(n, args...) do{}while(0) 49c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#endif /* no debugging */ 50c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 51c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define INFO(args...) printk(KERN_INFO "sl811_cs: " args) 52c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 53c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444) 54c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 55c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define CS_CHECK(fn, ret) \ 56c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell do { \ 57c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell last_fn = (fn); \ 58c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if ((last_ret = (ret)) != 0) \ 59c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell goto cs_failed; \ 60c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell } while (0) 61c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 62c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/ 63c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/* VARIABLES */ 64c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/ 65c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 66c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic const char driver_name[DEV_NAME_LEN] = "sl811_cs"; 67c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 68c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownelltypedef struct local_info_t { 69fd238232cd0ff4840ae6946bb338502154096d88Dominik Brodowski struct pcmcia_device *p_dev; 70c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell dev_node_t node; 71c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} local_info_t; 72c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 73fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void sl811_cs_release(struct pcmcia_device * link); 74cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski 75c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/ 76c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 77c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic void release_platform_dev(struct device * dev) 78c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 79c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell DBG(0, "sl811_cs platform_dev release\n"); 80c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell dev->parent = NULL; 81c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 82c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 83c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic struct sl811_platform_data platform_data = { 84c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .potpg = 100, 85c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .power = 50, /* == 100mA */ 86c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell // .reset = ... FIXME: invoke CF reset on the card 87c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}; 88c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 89c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic struct resource resources[] = { 90c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell [0] = { 91c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .flags = IORESOURCE_IRQ, 92c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell }, 93c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell [1] = { 94c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell // .name = "address", 95c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .flags = IORESOURCE_IO, 96c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell }, 97c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell [2] = { 98c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell // .name = "data", 99c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .flags = IORESOURCE_IO, 100c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell }, 101c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}; 102c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 103a0c53f1dca10acc93462339cbd0bf24b10d60a13David Brownellextern struct platform_driver sl811h_driver; 104c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 105c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic struct platform_device platform_dev = { 106c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .id = -1, 107c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .dev = { 108c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .platform_data = &platform_data, 109c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .release = release_platform_dev, 110c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell }, 111c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .resource = resources, 112c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .num_resources = ARRAY_SIZE(resources), 113c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}; 114c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 115c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic int sl811_hc_init(struct device *parent, ioaddr_t base_addr, int irq) 116c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 117c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (platform_dev.dev.parent) 118c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell return -EBUSY; 119c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell platform_dev.dev.parent = parent; 120c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 121c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* finish seting up the platform device */ 122c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[0].start = irq; 123c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 124c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[1].start = base_addr; 125c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[1].end = base_addr; 126c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 127c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[2].start = base_addr + 1; 128c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[2].end = base_addr + 1; 129c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 130c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* The driver core will probe for us. We know sl811-hcd has been 131c9a50cc9318772e62d56f2a9172bdfda72bdacbeDavid Brownell * initialized already because of the link order dependency created 132c9a50cc9318772e62d56f2a9172bdfda72bdacbeDavid Brownell * by referencing "sl811h_driver". 133c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell */ 134a0c53f1dca10acc93462339cbd0bf24b10d60a13David Brownell platform_dev.name = sl811h_driver.driver.name; 135c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell return platform_device_register(&platform_dev); 136c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 137c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 138c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/ 139c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 140fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void sl811_cs_detach(struct pcmcia_device *link) 141c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 142c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell DBG(0, "sl811_cs_detach(0x%p)\n", link); 143c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 144e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski sl811_cs_release(link); 145c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 146c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* This points to the parent local_info_t struct */ 147c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell kfree(link->priv); 148c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 149c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 150fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void sl811_cs_release(struct pcmcia_device * link) 151c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 152c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell DBG(0, "sl811_cs_release(0x%p)\n", link); 153c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 154fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_disable_device(link); 155c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell platform_device_unregister(&platform_dev); 156c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 157c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 15815b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int sl811_cs_config(struct pcmcia_device *link) 159c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 160fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski struct device *parent = &handle_to_dev(link); 161c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell local_info_t *dev = link->priv; 162c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell tuple_t tuple; 163c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell cisparse_t parse; 164c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell int last_fn, last_ret; 165c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell u_char buf[64]; 166c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell config_info_t conf; 167c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell cistpl_cftable_entry_t dflt = { 0 }; 168c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 169c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell DBG(0, "sl811_cs_config(0x%p)\n", link); 170c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 171c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* Look up the current Vcc */ 172c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell CS_CHECK(GetConfigurationInfo, 173fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_get_configuration_info(link, &conf)); 174c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 175af2b3b503ad1b071b66e1531caae252b4b95c847Dominik Brodowski tuple.Attributes = 0; 176af2b3b503ad1b071b66e1531caae252b4b95c847Dominik Brodowski tuple.TupleData = buf; 177af2b3b503ad1b071b66e1531caae252b4b95c847Dominik Brodowski tuple.TupleDataMax = sizeof(buf); 178af2b3b503ad1b071b66e1531caae252b4b95c847Dominik Brodowski tuple.TupleOffset = 0; 179c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY; 180fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple)); 181c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell while (1) { 182c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell cistpl_cftable_entry_t *cfg = &(parse.cftable_entry); 183c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 184fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski if (pcmcia_get_tuple_data(link, &tuple) != 0 185fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski || pcmcia_parse_tuple(link, &tuple, &parse) 186c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell != 0) 187c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell goto next_entry; 188c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 189c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (cfg->flags & CISTPL_CFTABLE_DEFAULT) { 190c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell dflt = *cfg; 191c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell } 192c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 193c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (cfg->index == 0) 194c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell goto next_entry; 195c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 196c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->conf.ConfigIndex = cfg->index; 197c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 198c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* Use power settings for Vcc and Vpp if present */ 199c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* Note that the CIS values need to be rescaled */ 200c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) { 201c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (cfg->vcc.param[CISTPL_POWER_VNOM]/10000 202c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell != conf.Vcc) 203c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell goto next_entry; 204c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell } else if (dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) { 205c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (dflt.vcc.param[CISTPL_POWER_VNOM]/10000 206c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell != conf.Vcc) 207c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell goto next_entry; 208c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell } 209c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 210c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (cfg->vpp1.present & (1<<CISTPL_POWER_VNOM)) 21170294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski link->conf.Vpp = 212c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell cfg->vpp1.param[CISTPL_POWER_VNOM]/10000; 213c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell else if (dflt.vpp1.present & (1<<CISTPL_POWER_VNOM)) 21470294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski link->conf.Vpp = 215c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell dflt.vpp1.param[CISTPL_POWER_VNOM]/10000; 216c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 217c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* we need an interrupt */ 218c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (cfg->irq.IRQInfo1 || dflt.irq.IRQInfo1) 219c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->conf.Attributes |= CONF_ENABLE_IRQ; 220c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 221c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* IO window settings */ 222c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->io.NumPorts1 = link->io.NumPorts2 = 0; 223c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) { 224c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io; 225c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 226c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->io.Attributes1 = IO_DATA_PATH_WIDTH_8; 227c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK; 228c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->io.BasePort1 = io->win[0].base; 229c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->io.NumPorts1 = io->win[0].len; 230c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 231fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski if (pcmcia_request_io(link, &link->io) != 0) 232c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell goto next_entry; 233c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell } 234c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell break; 235c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 236c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellnext_entry: 237fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_disable_device(link); 238fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski last_ret = pcmcia_get_next_tuple(link, &tuple); 239c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell } 240c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 241c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* require an IRQ and two registers */ 242c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (!link->io.NumPorts1 || link->io.NumPorts1 < 2) 243c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell goto cs_failed; 244c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (link->conf.Attributes & CONF_ENABLE_IRQ) 245c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell CS_CHECK(RequestIRQ, 246fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_request_irq(link, &link->irq)); 247c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell else 248c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell goto cs_failed; 249c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 250c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell CS_CHECK(RequestConfiguration, 251fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_request_configuration(link, &link->conf)); 252c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 253c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell sprintf(dev->node.dev_name, driver_name); 254c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell dev->node.major = dev->node.minor = 0; 255fd238232cd0ff4840ae6946bb338502154096d88Dominik Brodowski link->dev_node = &dev->node; 256c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 25770294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski printk(KERN_INFO "%s: index 0x%02x: ", 25870294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski dev->node.dev_name, link->conf.ConfigIndex); 25970294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski if (link->conf.Vpp) 26070294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski printk(", Vpp %d.%d", link->conf.Vpp/10, link->conf.Vpp%10); 261c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell printk(", irq %d", link->irq.AssignedIRQ); 262c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell printk(", io 0x%04x-0x%04x", link->io.BasePort1, 263c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->io.BasePort1+link->io.NumPorts1-1); 264c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell printk("\n"); 265c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 266c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ) 267c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell < 0) { 268c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellcs_failed: 269c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell printk("sl811_cs_config failed\n"); 270fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski cs_error(link, last_fn, last_ret); 271c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell sl811_cs_release(link); 27215b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 273c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell } 27415b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return 0; 275c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 276c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 27715b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int sl811_cs_probe(struct pcmcia_device *link) 278c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 279c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell local_info_t *local; 280c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 281dd00cc486ab1c17049a535413d1751ef3482141cYoann Padioleau local = kzalloc(sizeof(local_info_t), GFP_KERNEL); 282c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (!local) 283f8cfa618dccbdc6dab5297f75779566a388a98fdDominik Brodowski return -ENOMEM; 284fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski local->p_dev = link; 285c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->priv = local; 286c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 287c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* Initialize */ 288c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->irq.Attributes = IRQ_TYPE_EXCLUSIVE; 289c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->irq.IRQInfo1 = IRQ_INFO2_VALID|IRQ_LEVEL_ID; 290c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->irq.Handler = NULL; 291c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 292c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->conf.Attributes = 0; 293c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->conf.IntType = INT_MEMORY_AND_IO; 294c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 29515b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return sl811_cs_config(link); 296c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 297c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 29822f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownellstatic struct pcmcia_device_id sl811_ids[] = { 29922f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001), /* RATOC USB HOST CF+ Card */ 30022f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell PCMCIA_DEVICE_NULL, 30122f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell}; 30222f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid BrownellMODULE_DEVICE_TABLE(pcmcia, sl811_ids); 30322f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell 304c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic struct pcmcia_driver sl811_cs_driver = { 305c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .owner = THIS_MODULE, 306c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .drv = { 307c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .name = (char *)driver_name, 308c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell }, 30915b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski .probe = sl811_cs_probe, 310cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski .remove = sl811_cs_detach, 31122f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell .id_table = sl811_ids, 312c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}; 313c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 314c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/ 315c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 316c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic int __init init_sl811_cs(void) 317c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 318c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell return pcmcia_register_driver(&sl811_cs_driver); 319c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 320c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellmodule_init(init_sl811_cs); 321c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 322c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic void __exit exit_sl811_cs(void) 323c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 324c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell pcmcia_unregister_driver(&sl811_cs_driver); 325c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 326c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellmodule_exit(exit_sl811_cs); 327