drivers/telephony/ixj_pcmcia.c

   1 #include "ixj-ver.h"
   2
   3 #include <linux/module.h>
   4
   5 #include <linux/init.h>
   6 #include <linux/sched.h>
   7 #include <linux/kernel.h>       /* printk() */
   8 #include <linux/fs.h>           /* everything... */
   9 #include <linux/errno.h>        /* error codes */
  10 #include <linux/slab.h>
  11
  12 #include <pcmcia/version.h>
  13 #include <pcmcia/cs_types.h>
  14 #include <pcmcia/cs.h>
  15 #include <pcmcia/cistpl.h>
  16 #include <pcmcia/ds.h>
  17
  18 #include "ixj.h"
  19
  20 /*
  21  *      PCMCIA service support for Quicknet cards
  22  */
  23
  24 #ifdef PCMCIA_DEBUG
  25 static int pc_debug = PCMCIA_DEBUG;
  26 MODULE_PARM(pc_debug, "i");
  27 #define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
  28 #else
  29 #define DEBUG(n, args...)
  30 #endif
  31
  32 typedef struct ixj_info_t {
  33         int ndev;
  34         dev_node_t node;
  35         struct ixj *port;
  36 } ixj_info_t;
  37
  38 static dev_link_t *ixj_attach(void);
  39 static void ixj_detach(dev_link_t *);
  40 static void ixj_config(dev_link_t * link);
  41 static void ixj_cs_release(u_long arg);
  42 static int ixj_event(event_t event, int priority, event_callback_args_t * args);
  43 static dev_info_t dev_info = "ixj_cs";
  44 static dev_link_t *dev_list = NULL;
  45
  46 static void cs_error(client_handle_t handle, int func, int ret)
  47 {
  48         error_info_t err =
  49         {
  50                 func, ret
  51         };
  52         CardServices(ReportError, handle, &err);
  53 }
  54
  55 static dev_link_t *ixj_attach(void)
  56 {
  57         client_reg_t client_reg;
  58         dev_link_t *link;
  59         int ret;
  60         DEBUG(0, "ixj_attach()\n");
  61         /* Create new ixj device */
  62         link = kmalloc(sizeof(struct dev_link_t), GFP_KERNEL);
  63         if (!link)
  64                 return NULL;
  65         memset(link, 0, sizeof(struct dev_link_t));
  66         link->release.function = &ixj_cs_release;
  67         link->release.data = (u_long) link;
  68         link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
  69         link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
  70         link->io.IOAddrLines = 3;
  71         link->conf.Vcc = 50;
  72         link->conf.IntType = INT_MEMORY_AND_IO;
  73         link->priv = kmalloc(sizeof(struct ixj_info_t), GFP_KERNEL);
  74         if (!link->priv)
  75                 return NULL;
  76         memset(link->priv, 0, sizeof(struct ixj_info_t));
  77         /* Register with Card Services */
  78         link->next = dev_list;
  79         dev_list = link;
  80         client_reg.dev_info = &dev_info;
  81         client_reg.Attributes = INFO_IO_CLIENT | INFO_CARD_SHARE;
  82         client_reg.EventMask =
  83             CS_EVENT_CARD_INSERTION | CS_EVENT_CARD_REMOVAL |
  84             CS_EVENT_RESET_PHYSICAL | CS_EVENT_CARD_RESET |
  85             CS_EVENT_PM_SUSPEND | CS_EVENT_PM_RESUME;
  86         client_reg.event_handler = &ixj_event;
  87         client_reg.Version = 0x0210;
  88         client_reg.event_callback_args.client_data = link;
  89         ret = CardServices(RegisterClient, &link->handle, &client_reg);
  90         if (ret != CS_SUCCESS) {
  91                 cs_error(link->handle, RegisterClient, ret);
  92                 ixj_detach(link);
  93                 return NULL;
  94         }
  95         return link;
  96 }
  97
  98 static void ixj_detach(dev_link_t * link)
  99 {
 100         dev_link_t **linkp;
 101         long flags;
 102         int ret;
 103         DEBUG(0, "ixj_detach(0x%p)\n", link);
 104         for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
 105                 if (*linkp == link)
 106                         break;
 107         if (*linkp == NULL)
 108                 return;
 109         save_flags(flags);
 110         cli();
 111         if (link->state & DEV_RELEASE_PENDING) {
 112                 del_timer(&link->release);
 113                 link->state &= ~DEV_RELEASE_PENDING;
 114         }
 115         restore_flags(flags);
 116         if (link->state & DEV_CONFIG)
 117                 ixj_cs_release((u_long) link);
 118         if (link->handle) {
 119                 ret = CardServices(DeregisterClient, link->handle);
 120                 if (ret != CS_SUCCESS)
 121                         cs_error(link->handle, DeregisterClient, ret);
 122         }
 123         /* Unlink device structure, free bits */
 124         *linkp = link->next;
 125         kfree(link->priv);
 126         kfree(link);
 127 }
 128
 129 #define CS_CHECK(fn, args...) \
 130 while ((last_ret=CardServices(last_fn=(fn), args))!=0) goto cs_failed
 131
 132 #define CFG_CHECK(fn, args...) \
 133 if (CardServices(fn, args) != 0) goto next_entry
 134
 135 static void ixj_get_serial(dev_link_t * link, IXJ * j)
 136 {
 137         client_handle_t handle;
 138         tuple_t tuple;
 139         u_short buf[128];
 140         char *str;
 141         int last_ret, last_fn, i, place;
 142         handle = link->handle;
 143         DEBUG(0, "ixj_get_serial(0x%p)\n", link);
 144         tuple.TupleData = (cisdata_t *) buf;
 145         tuple.TupleOffset = 0;
 146         tuple.TupleDataMax = 80;
 147         tuple.Attributes = 0;
 148         tuple.DesiredTuple = CISTPL_VERS_1;
 149         CS_CHECK(GetFirstTuple, handle, &tuple);
 150         CS_CHECK(GetTupleData, handle, &tuple);
 151         str = (char *) buf;
 152         printk("PCMCIA Version %d.%d\n", str[0], str[1]);
 153         str += 2;
 154         printk("%s", str);
 155         str = str + strlen(str) + 1;
 156         printk(" %s", str);
 157         str = str + strlen(str) + 1;
 158         place = 1;
 159         for (i = strlen(str) - 1; i >= 0; i--) {
 160                 switch (str[i]) {
 161                 case '0':
 162                 case '1':
 163                 case '2':
 164                 case '3':
 165                 case '4':
 166                 case '5':
 167                 case '6':
 168                 case '7':
 169                 case '8':
 170                 case '9':
 171                         j->serial += (str[i] - 48) * place;
 172                         break;
 173                 case 'A':
 174                 case 'B':
 175                 case 'C':
 176                 case 'D':
 177                 case 'E':
 178                 case 'F':
 179                         j->serial += (str[i] - 55) * place;
 180                         break;
 181                 case 'a':
 182                 case 'b':
 183                 case 'c':
 184                 case 'd':
 185                 case 'e':
 186                 case 'f':
 187                         j->serial += (str[i] - 87) * place;
 188                         break;
 189                 }
 190                 place = place * 0x10;
 191         }
 192         str = str + strlen(str) + 1;
 193         printk(" version %s\n", str);
 194       cs_failed:
 195         return;
 196 }
 197
 198 static void ixj_config(dev_link_t * link)
 199 {
 200         IXJ *j;
 201         client_handle_t handle;
 202         ixj_info_t *info;
 203         tuple_t tuple;
 204         u_short buf[128];
 205         cisparse_t parse;
 206         config_info_t conf;
 207         cistpl_cftable_entry_t *cfg = &parse.cftable_entry;
 208         cistpl_cftable_entry_t dflt =
 209         {
 210                 0
 211         };
 212         int last_ret, last_fn;
 213         handle = link->handle;
 214         info = link->priv;
 215         DEBUG(0, "ixj_config(0x%p)\n", link);
 216         tuple.TupleData = (cisdata_t *) buf;
 217         tuple.TupleOffset = 0;
 218         tuple.TupleDataMax = 255;
 219         tuple.Attributes = 0;
 220         tuple.DesiredTuple = CISTPL_CONFIG;
 221         CS_CHECK(GetFirstTuple, handle, &tuple);
 222         CS_CHECK(GetTupleData, handle, &tuple);
 223         CS_CHECK(ParseTuple, handle, &tuple, &parse);
 224         link->conf.ConfigBase = parse.config.base;
 225         link->conf.Present = parse.config.rmask[0];
 226         link->state |= DEV_CONFIG;
 227         CS_CHECK(GetConfigurationInfo, handle, &conf);
 228         tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
 229         tuple.Attributes = 0;
 230         CS_CHECK(GetFirstTuple, handle, &tuple);
 231         while (1) {
 232                 CFG_CHECK(GetTupleData, handle, &tuple);
 233                 CFG_CHECK(ParseTuple, handle, &tuple, &parse);
 234                 if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) {
 235                         cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
 236                         link->conf.ConfigIndex = cfg->index;
 237                         link->io.BasePort1 = io->win[0].base;
 238                         link->io.NumPorts1 = io->win[0].len;
 239                         if (io->nwin == 2) {
 240                                 link->io.BasePort2 = io->win[1].base;
 241                                 link->io.NumPorts2 = io->win[1].len;
 242                         }
 243                         CFG_CHECK(RequestIO, link->handle, &link->io);
 244                         /* If we've got this far, we're done */
 245                         break;
 246                 }
 247               next_entry:
 248                 if (cfg->flags & CISTPL_CFTABLE_DEFAULT)
 249                         dflt = *cfg;
 250                 CS_CHECK(GetNextTuple, handle, &tuple);
 251         }
 252
 253         CS_CHECK(RequestConfiguration, handle, &link->conf);
 254
 255         /*
 256          *      Register the card with the core.
 257          */
 258         j=ixj_pcmcia_probe(link->io.BasePort1,link->io.BasePort1 + 0x10);
 259
 260         info->ndev = 1;
 261         info->node.major = PHONE_MAJOR;
 262         link->dev = &info->node;
 263         ixj_get_serial(link, j);
 264         link->state &= ~DEV_CONFIG_PENDING;
 265         return;
 266       cs_failed:
 267         cs_error(link->handle, last_fn, last_ret);
 268         ixj_cs_release((u_long) link);
 269 }
 270
 271 static void ixj_cs_release(u_long arg)
 272 {
 273         dev_link_t *link = (dev_link_t *) arg;
 274         ixj_info_t *info = link->priv;
 275         DEBUG(0, "ixj_cs_release(0x%p)\n", link);
 276         info->ndev = 0;
 277         link->dev = NULL;
 278         CardServices(ReleaseConfiguration, link->handle);
 279         CardServices(ReleaseIO, link->handle, &link->io);
 280         link->state &= ~DEV_CONFIG;
 281 }
 282
 283 static int ixj_event(event_t event, int priority, event_callback_args_t * args)
 284 {
 285         dev_link_t *link = args->client_data;
 286         DEBUG(1, "ixj_event(0x%06x)\n", event);
 287         switch (event) {
 288         case CS_EVENT_CARD_REMOVAL:
 289                 link->state &= ~DEV_PRESENT;
 290                 if (link->state & DEV_CONFIG) {
 291                         link->release.expires = jiffies + (HZ / 20);
 292                         link->state |= DEV_RELEASE_PENDING;
 293                         add_timer(&link->release);
 294                 }
 295                 break;
 296         case CS_EVENT_CARD_INSERTION:
 297                 link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
 298                 ixj_config(link);
 299                 break;
 300         case CS_EVENT_PM_SUSPEND:
 301                 link->state |= DEV_SUSPEND;
 302                 /* Fall through... */
 303         case CS_EVENT_RESET_PHYSICAL:
 304                 if (link->state & DEV_CONFIG)
 305                         CardServices(ReleaseConfiguration, link->handle);
 306                 break;
 307         case CS_EVENT_PM_RESUME:
 308                 link->state &= ~DEV_SUSPEND;
 309                 /* Fall through... */
 310         case CS_EVENT_CARD_RESET:
 311                 if (DEV_OK(link))
 312                         CardServices(RequestConfiguration, link->handle, &link->conf);
 313                 break;
 314         }
 315         return 0;
 316 }
 317
 318 int __init ixj_register_pcmcia(void)
 319 {
 320         servinfo_t serv;
 321         DEBUG(0, "%s\n", version);
 322         CardServices(GetCardServicesInfo, &serv);
 323         if (serv.Revision != CS_RELEASE_CODE) {
 324                 printk(KERN_NOTICE "ixj_cs: Card Services release does not match!\n");
 325                 return -EINVAL;
 326         }
 327         register_pcmcia_driver(&dev_info, &ixj_attach, &ixj_detach);
 328         return 0;
 329 }
 330
 331 static void ixj_pcmcia_unload(void)
 332 {
 333         DEBUG(0, "ixj_cs: unloading\n");
 334         unregister_pcmcia_driver(&dev_info);
 335         while (dev_list != NULL)
 336                 ixj_detach(dev_list);
 337 }
 338
 339 module_init(ixj_register_pcmcia);
 340 module_exit(ixj_pcmcia_unload);
 341
 342 MODULE_LICENSE("GPL");
 343