SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/usb/host/sl811_cs.c

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