sl811_cs.c revision d39bd56452b509f8d6054883b8a0129950ba50cc
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 115d39bd56452b509f8d6054883b8a0129950ba50ccDominik Brodowskistatic int sl811_hc_init(struct device *parent, resource_size_t base_addr, 116d39bd56452b509f8d6054883b8a0129950ba50ccDominik Brodowski int irq) 117c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 118c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (platform_dev.dev.parent) 119c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell return -EBUSY; 120c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell platform_dev.dev.parent = parent; 121c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 122c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* finish seting up the platform device */ 123c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[0].start = irq; 124c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 125c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[1].start = base_addr; 126c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[1].end = base_addr; 127c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 128c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[2].start = base_addr + 1; 129c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell resources[2].end = base_addr + 1; 130c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 131c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* The driver core will probe for us. We know sl811-hcd has been 132c9a50cc9318772e62d56f2a9172bdfda72bdacbeDavid Brownell * initialized already because of the link order dependency created 133c9a50cc9318772e62d56f2a9172bdfda72bdacbeDavid Brownell * by referencing "sl811h_driver". 134c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell */ 135a0c53f1dca10acc93462339cbd0bf24b10d60a13David Brownell platform_dev.name = sl811h_driver.driver.name; 136c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell return platform_device_register(&platform_dev); 137c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 138c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 139c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/ 140c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 141fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void sl811_cs_detach(struct pcmcia_device *link) 142c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 143c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell DBG(0, "sl811_cs_detach(0x%p)\n", link); 144c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 145e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski sl811_cs_release(link); 146c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 147c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* This points to the parent local_info_t struct */ 148c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell kfree(link->priv); 149c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 150c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 151fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void sl811_cs_release(struct pcmcia_device * link) 152c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 153c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell DBG(0, "sl811_cs_release(0x%p)\n", link); 154c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 155fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_disable_device(link); 156c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell platform_device_unregister(&platform_dev); 157c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 158c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 15984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowskistatic int sl811_cs_config_check(struct pcmcia_device *p_dev, 16084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski cistpl_cftable_entry_t *cfg, 1618e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski cistpl_cftable_entry_t *dflt, 162ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski unsigned int vcc, 16384e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski void *priv_data) 16484e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski{ 16584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski if (cfg->index == 0) 16684e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski return -ENODEV; 16784e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski 16884e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski /* Use power settings for Vcc and Vpp if present */ 16984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski /* Note that the CIS values need to be rescaled */ 17084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) { 171ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski if (cfg->vcc.param[CISTPL_POWER_VNOM]/10000 != vcc) 17284e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski return -ENODEV; 1738e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski } else if (dflt->vcc.present & (1<<CISTPL_POWER_VNOM)) { 174ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski if (dflt->vcc.param[CISTPL_POWER_VNOM]/10000 != vcc) 17584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski return -ENODEV; 17684e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski } 17784e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski 17884e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski if (cfg->vpp1.present & (1<<CISTPL_POWER_VNOM)) 17984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski p_dev->conf.Vpp = 18084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski cfg->vpp1.param[CISTPL_POWER_VNOM]/10000; 1818e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski else if (dflt->vpp1.present & (1<<CISTPL_POWER_VNOM)) 18284e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski p_dev->conf.Vpp = 1838e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski dflt->vpp1.param[CISTPL_POWER_VNOM]/10000; 18484e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski 18584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski /* we need an interrupt */ 1868e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski if (cfg->irq.IRQInfo1 || dflt->irq.IRQInfo1) 18784e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski p_dev->conf.Attributes |= CONF_ENABLE_IRQ; 18884e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski 18984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski /* IO window settings */ 19084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski p_dev->io.NumPorts1 = p_dev->io.NumPorts2 = 0; 1918e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski if ((cfg->io.nwin > 0) || (dflt->io.nwin > 0)) { 1928e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt->io; 19384e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski 19484e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8; 19584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski p_dev->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK; 19684e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski p_dev->io.BasePort1 = io->win[0].base; 19784e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski p_dev->io.NumPorts1 = io->win[0].len; 19884e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski 19984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski return pcmcia_request_io(p_dev, &p_dev->io); 20084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski } 20184e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski pcmcia_disable_device(p_dev); 20284e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski return -ENODEV; 20384e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski} 20484e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski 20584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski 20615b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int sl811_cs_config(struct pcmcia_device *link) 207c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 208fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski struct device *parent = &handle_to_dev(link); 209c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell local_info_t *dev = link->priv; 210c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell int last_fn, last_ret; 211c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 212c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell DBG(0, "sl811_cs_config(0x%p)\n", link); 213c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 214ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski if (pcmcia_loop_config(link, sl811_cs_config_check, NULL)) 215ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski goto failed; 216c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 217c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* require an IRQ and two registers */ 218c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (!link->io.NumPorts1 || link->io.NumPorts1 < 2) 219ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski goto failed; 220c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (link->conf.Attributes & CONF_ENABLE_IRQ) 221c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell CS_CHECK(RequestIRQ, 222fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_request_irq(link, &link->irq)); 223c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell else 224ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski goto failed; 225c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 226c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell CS_CHECK(RequestConfiguration, 227fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_request_configuration(link, &link->conf)); 228c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 229c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell sprintf(dev->node.dev_name, driver_name); 230c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell dev->node.major = dev->node.minor = 0; 231fd238232cd0ff4840ae6946bb338502154096d88Dominik Brodowski link->dev_node = &dev->node; 232c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 23370294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski printk(KERN_INFO "%s: index 0x%02x: ", 23470294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski dev->node.dev_name, link->conf.ConfigIndex); 23570294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski if (link->conf.Vpp) 23670294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski printk(", Vpp %d.%d", link->conf.Vpp/10, link->conf.Vpp%10); 237c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell printk(", irq %d", link->irq.AssignedIRQ); 238c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell printk(", io 0x%04x-0x%04x", link->io.BasePort1, 239c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->io.BasePort1+link->io.NumPorts1-1); 240c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell printk("\n"); 241c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 242c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ) 243c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell < 0) { 244c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellcs_failed: 245fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski cs_error(link, last_fn, last_ret); 246ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowskifailed: 247ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski printk(KERN_WARNING "sl811_cs_config failed\n"); 248c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell sl811_cs_release(link); 24915b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 250c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell } 25115b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return 0; 252c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 253c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 25415b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int sl811_cs_probe(struct pcmcia_device *link) 255c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 256c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell local_info_t *local; 257c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 258dd00cc486ab1c17049a535413d1751ef3482141cYoann Padioleau local = kzalloc(sizeof(local_info_t), GFP_KERNEL); 259c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell if (!local) 260f8cfa618dccbdc6dab5297f75779566a388a98fdDominik Brodowski return -ENOMEM; 261fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski local->p_dev = link; 262c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->priv = local; 263c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 264c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell /* Initialize */ 265c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->irq.Attributes = IRQ_TYPE_EXCLUSIVE; 266c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->irq.IRQInfo1 = IRQ_INFO2_VALID|IRQ_LEVEL_ID; 267c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->irq.Handler = NULL; 268c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 269c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->conf.Attributes = 0; 270c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell link->conf.IntType = INT_MEMORY_AND_IO; 271c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 27215b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return sl811_cs_config(link); 273c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 274c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 27522f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownellstatic struct pcmcia_device_id sl811_ids[] = { 27622f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001), /* RATOC USB HOST CF+ Card */ 27722f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell PCMCIA_DEVICE_NULL, 27822f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell}; 27922f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid BrownellMODULE_DEVICE_TABLE(pcmcia, sl811_ids); 28022f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell 281c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic struct pcmcia_driver sl811_cs_driver = { 282c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .owner = THIS_MODULE, 283c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .drv = { 284c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell .name = (char *)driver_name, 285c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell }, 28615b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski .probe = sl811_cs_probe, 287cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski .remove = sl811_cs_detach, 28822f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell .id_table = sl811_ids, 289c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}; 290c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 291c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/ 292c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 293c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic int __init init_sl811_cs(void) 294c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 295c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell return pcmcia_register_driver(&sl811_cs_driver); 296c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 297c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellmodule_init(init_sl811_cs); 298c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell 299c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic void __exit exit_sl811_cs(void) 300c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{ 301c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell pcmcia_unregister_driver(&sl811_cs_driver); 302c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} 303c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellmodule_exit(exit_sl811_cs); 304