drivers/pcmcia/socket_sysfs.c

   1 /*
   2  * socket_sysfs.c -- most of socket-related sysfs output
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2 as
   6  * published by the Free Software Foundation.
   7  *
   8  * (C) 2003 - 2004              Dominik Brodowski
   9  */
  10
  11 #include <linux/module.h>
  12 #include <linux/moduleparam.h>
  13 #include <linux/init.h>
  14 #include <linux/kernel.h>
  15 #include <linux/string.h>
  16 #include <linux/major.h>
  17 #include <linux/errno.h>
  18 #include <linux/slab.h>
  19 #include <linux/mm.h>
  20 #include <linux/interrupt.h>
  21 #include <linux/timer.h>
  22 #include <linux/ioport.h>
  23 #include <linux/delay.h>
  24 #include <linux/pm.h>
  25 #include <linux/device.h>
  26 #include <linux/mutex.h>
  27 #include <asm/system.h>
  28 #include <asm/irq.h>
  29
  30 #define IN_CARD_SERVICES
  31 #include <pcmcia/cs_types.h>
  32 #include <pcmcia/ss.h>
  33 #include <pcmcia/cs.h>
  34 #include <pcmcia/cistpl.h>
  35 #include <pcmcia/cisreg.h>
  36 #include <pcmcia/ds.h>
  37 #include "cs_internal.h"
  38
  39 #define to_socket(_dev) container_of(_dev, struct pcmcia_socket, dev)
  40
  41 static ssize_t pccard_show_type(struct device *dev, struct device_attribute *attr,
  42                                 char *buf)
  43 {
  44         struct pcmcia_socket *s = to_socket(dev);
  45
  46         if (!(s->state & SOCKET_PRESENT))
  47                 return -ENODEV;
  48         if (s->state & SOCKET_CARDBUS)
  49                 return sprintf(buf, "32-bit\n");
  50         return sprintf(buf, "16-bit\n");
  51 }
  52 static DEVICE_ATTR(card_type, 0444, pccard_show_type, NULL);
  53
  54 static ssize_t pccard_show_voltage(struct device *dev, struct device_attribute *attr,
  55                                    char *buf)
  56 {
  57         struct pcmcia_socket *s = to_socket(dev);
  58
  59         if (!(s->state & SOCKET_PRESENT))
  60                 return -ENODEV;
  61         if (s->socket.Vcc)
  62                 return sprintf(buf, "%d.%dV\n", s->socket.Vcc / 10,
  63                                s->socket.Vcc % 10);
  64         return sprintf(buf, "X.XV\n");
  65 }
  66 static DEVICE_ATTR(card_voltage, 0444, pccard_show_voltage, NULL);
  67
  68 static ssize_t pccard_show_vpp(struct device *dev, struct device_attribute *attr,
  69                                char *buf)
  70 {
  71         struct pcmcia_socket *s = to_socket(dev);
  72         if (!(s->state & SOCKET_PRESENT))
  73                 return -ENODEV;
  74         return sprintf(buf, "%d.%dV\n", s->socket.Vpp / 10, s->socket.Vpp % 10);
  75 }
  76 static DEVICE_ATTR(card_vpp, 0444, pccard_show_vpp, NULL);
  77
  78 static ssize_t pccard_show_vcc(struct device *dev, struct device_attribute *attr,
  79                                char *buf)
  80 {
  81         struct pcmcia_socket *s = to_socket(dev);
  82         if (!(s->state & SOCKET_PRESENT))
  83                 return -ENODEV;
  84         return sprintf(buf, "%d.%dV\n", s->socket.Vcc / 10, s->socket.Vcc % 10);
  85 }
  86 static DEVICE_ATTR(card_vcc, 0444, pccard_show_vcc, NULL);
  87
  88
  89 static ssize_t pccard_store_insert(struct device *dev, struct device_attribute *attr,
  90                                    const char *buf, size_t count)
  91 {
  92         ssize_t ret;
  93         struct pcmcia_socket *s = to_socket(dev);
  94
  95         if (!count)
  96                 return -EINVAL;
  97
  98         ret = pcmcia_insert_card(s);
  99
 100         return ret ? ret : count;
 101 }
 102 static DEVICE_ATTR(card_insert, 0200, NULL, pccard_store_insert);
 103
 104
 105 static ssize_t pccard_show_card_pm_state(struct device *dev,
 106                                          struct device_attribute *attr,
 107                                          char *buf)
 108 {
 109         struct pcmcia_socket *s = to_socket(dev);
 110         return sprintf(buf, "%s\n", s->state & SOCKET_SUSPEND ? "off" : "on");
 111 }
 112
 113 static ssize_t pccard_store_card_pm_state(struct device *dev,
 114                                           struct device_attribute *attr,
 115                                           const char *buf, size_t count)
 116 {
 117         ssize_t ret = -EINVAL;
 118         struct pcmcia_socket *s = to_socket(dev);
 119
 120         if (!count)
 121                 return -EINVAL;
 122
 123         if (!(s->state & SOCKET_SUSPEND) && !strncmp(buf, "off", 3))
 124                 ret = pcmcia_suspend_card(s);
 125         else if ((s->state & SOCKET_SUSPEND) && !strncmp(buf, "on", 2))
 126                 ret = pcmcia_resume_card(s);
 127
 128         return ret ? -ENODEV : count;
 129 }
 130 static DEVICE_ATTR(card_pm_state, 0644, pccard_show_card_pm_state, pccard_store_card_pm_state);
 131
 132 static ssize_t pccard_store_eject(struct device *dev,
 133                                   struct device_attribute *attr,
 134                                   const char *buf, size_t count)
 135 {
 136         ssize_t ret;
 137         struct pcmcia_socket *s = to_socket(dev);
 138
 139         if (!count)
 140                 return -EINVAL;
 141
 142         ret = pcmcia_eject_card(s);
 143
 144         return ret ? ret : count;
 145 }
 146 static DEVICE_ATTR(card_eject, 0200, NULL, pccard_store_eject);
 147
 148
 149 static ssize_t pccard_show_irq_mask(struct device *dev,
 150                                     struct device_attribute *attr,
 151                                     char *buf)
 152 {
 153         struct pcmcia_socket *s = to_socket(dev);
 154         return sprintf(buf, "0x%04x\n", s->irq_mask);
 155 }
 156
 157 static ssize_t pccard_store_irq_mask(struct device *dev,
 158                                      struct device_attribute *attr,
 159                                      const char *buf, size_t count)
 160 {
 161         ssize_t ret;
 162         struct pcmcia_socket *s = to_socket(dev);
 163         u32 mask;
 164
 165         if (!count)
 166                 return -EINVAL;
 167
 168         ret = sscanf (buf, "0x%x\n", &mask);
 169
 170         if (ret == 1) {
 171                 s->irq_mask &= mask;
 172                 ret = 0;
 173         }
 174
 175         return ret ? ret : count;
 176 }
 177 static DEVICE_ATTR(card_irq_mask, 0600, pccard_show_irq_mask, pccard_store_irq_mask);
 178
 179
 180 static ssize_t pccard_show_resource(struct device *dev,
 181                                     struct device_attribute *attr, char *buf)
 182 {
 183         struct pcmcia_socket *s = to_socket(dev);
 184         return sprintf(buf, "%s\n", s->resource_setup_done ? "yes" : "no");
 185 }
 186
 187 static ssize_t pccard_store_resource(struct device *dev,
 188                                      struct device_attribute *attr,
 189                                      const char *buf, size_t count)
 190 {
 191         unsigned long flags;
 192         struct pcmcia_socket *s = to_socket(dev);
 193
 194         if (!count)
 195                 return -EINVAL;
 196
 197         spin_lock_irqsave(&s->lock, flags);
 198         if (!s->resource_setup_done)
 199                 s->resource_setup_done = 1;
 200         spin_unlock_irqrestore(&s->lock, flags);
 201
 202         mutex_lock(&s->skt_mutex);
 203         if ((s->callback) &&
 204             (s->state & SOCKET_PRESENT) &&
 205             !(s->state & SOCKET_CARDBUS)) {
 206                 if (try_module_get(s->callback->owner)) {
 207                         s->callback->requery(s, 0);
 208                         module_put(s->callback->owner);
 209                 }
 210         }
 211         mutex_unlock(&s->skt_mutex);
 212
 213         return count;
 214 }
 215 static DEVICE_ATTR(available_resources_setup_done, 0600, pccard_show_resource, pccard_store_resource);
 216
 217
 218 static ssize_t pccard_extract_cis(struct pcmcia_socket *s, char *buf, loff_t off, size_t count)
 219 {
 220         tuple_t tuple;
 221         int status, i;
 222         loff_t pointer = 0;
 223         ssize_t ret = 0;
 224         u_char *tuplebuffer;
 225         u_char *tempbuffer;
 226
 227         tuplebuffer = kmalloc(sizeof(u_char) * 256, GFP_KERNEL);
 228         if (!tuplebuffer)
 229                 return -ENOMEM;
 230
 231         tempbuffer = kmalloc(sizeof(u_char) * 258, GFP_KERNEL);
 232         if (!tempbuffer) {
 233                 ret = -ENOMEM;
 234                 goto free_tuple;
 235         }
 236
 237         memset(&tuple, 0, sizeof(tuple_t));
 238
 239         tuple.Attributes = TUPLE_RETURN_LINK | TUPLE_RETURN_COMMON;
 240         tuple.DesiredTuple = RETURN_FIRST_TUPLE;
 241         tuple.TupleOffset = 0;
 242
 243         status = pccard_get_first_tuple(s, BIND_FN_ALL, &tuple);
 244         while (!status) {
 245                 tuple.TupleData = tuplebuffer;
 246                 tuple.TupleDataMax = 255;
 247                 memset(tuplebuffer, 0, sizeof(u_char) * 255);
 248
 249                 status = pccard_get_tuple_data(s, &tuple);
 250                 if (status)
 251                         break;
 252
 253                 if (off < (pointer + 2 + tuple.TupleDataLen)) {
 254                         tempbuffer[0] = tuple.TupleCode & 0xff;
 255                         tempbuffer[1] = tuple.TupleLink & 0xff;
 256                         for (i = 0; i < tuple.TupleDataLen; i++)
 257                                 tempbuffer[i + 2] = tuplebuffer[i] & 0xff;
 258
 259                         for (i = 0; i < (2 + tuple.TupleDataLen); i++) {
 260                                 if (((i + pointer) >= off) &&
 261                                     (i + pointer) < (off + count)) {
 262                                         buf[ret] = tempbuffer[i];
 263                                         ret++;
 264                                 }
 265                         }
 266                 }
 267
 268                 pointer += 2 + tuple.TupleDataLen;
 269
 270                 if (pointer >= (off + count))
 271                         break;
 272
 273                 if (tuple.TupleCode == CISTPL_END)
 274                         break;
 275                 status = pccard_get_next_tuple(s, BIND_FN_ALL, &tuple);
 276         }
 277
 278         kfree(tempbuffer);
 279  free_tuple:
 280         kfree(tuplebuffer);
 281
 282         return (ret);
 283 }
 284
 285 static ssize_t pccard_show_cis(struct kobject *kobj,
 286                                struct bin_attribute *bin_attr,
 287                                char *buf, loff_t off, size_t count)
 288 {
 289         unsigned int size = 0x200;
 290
 291         if (off >= size)
 292                 count = 0;
 293         else {
 294                 struct pcmcia_socket *s;
 295                 unsigned int chains;
 296
 297                 if (off + count > size)
 298                         count = size - off;
 299
 300                 s = to_socket(container_of(kobj, struct device, kobj));
 301
 302                 if (!(s->state & SOCKET_PRESENT))
 303                         return -ENODEV;
 304                 if (pccard_validate_cis(s, BIND_FN_ALL, &chains))
 305                         return -EIO;
 306                 if (!chains)
 307                         return -ENODATA;
 308
 309                 count = pccard_extract_cis(s, buf, off, count);
 310         }
 311
 312         return (count);
 313 }
 314
 315 static ssize_t pccard_store_cis(struct kobject *kobj,
 316                                 struct bin_attribute *bin_attr,
 317                                 char *buf, loff_t off, size_t count)
 318 {
 319         struct pcmcia_socket *s = to_socket(container_of(kobj, struct device, kobj));
 320         cisdump_t *cis;
 321         int error;
 322
 323         if (off)
 324                 return -EINVAL;
 325
 326         if (count >= 0x200)
 327                 return -EINVAL;
 328
 329         if (!(s->state & SOCKET_PRESENT))
 330                 return -ENODEV;
 331
 332         cis = kzalloc(sizeof(cisdump_t), GFP_KERNEL);
 333         if (!cis)
 334                 return -ENOMEM;
 335
 336         cis->Length = count + 1;
 337         memcpy(cis->Data, buf, count);
 338
 339         error = pcmcia_replace_cis(s, cis);
 340         kfree(cis);
 341         if (error)
 342                 return -EIO;
 343
 344         mutex_lock(&s->skt_mutex);
 345         if ((s->callback) && (s->state & SOCKET_PRESENT) &&
 346             !(s->state & SOCKET_CARDBUS)) {
 347                 if (try_module_get(s->callback->owner)) {
 348                         s->callback->requery(s, 1);
 349                         module_put(s->callback->owner);
 350                 }
 351         }
 352         mutex_unlock(&s->skt_mutex);
 353
 354         return count;
 355 }
 356
 357
 358 static struct attribute *pccard_socket_attributes[] = {
 359         &dev_attr_card_type.attr,
 360         &dev_attr_card_voltage.attr,
 361         &dev_attr_card_vpp.attr,
 362         &dev_attr_card_vcc.attr,
 363         &dev_attr_card_insert.attr,
 364         &dev_attr_card_pm_state.attr,
 365         &dev_attr_card_eject.attr,
 366         &dev_attr_card_irq_mask.attr,
 367         &dev_attr_available_resources_setup_done.attr,
 368         NULL,
 369 };
 370
 371 static const struct attribute_group socket_attrs = {
 372         .attrs = pccard_socket_attributes,
 373 };
 374
 375 static struct bin_attribute pccard_cis_attr = {
 376         .attr = { .name = "cis", .mode = S_IRUGO | S_IWUSR },
 377         .size = 0x200,
 378         .read = pccard_show_cis,
 379         .write = pccard_store_cis,
 380 };
 381
 382 int pccard_sysfs_add_socket(struct device *dev)
 383 {
 384         int ret = 0;
 385
 386         ret = sysfs_create_group(&dev->kobj, &socket_attrs);
 387         if (!ret) {
 388                 ret = sysfs_create_bin_file(&dev->kobj, &pccard_cis_attr);
 389                 if (ret)
 390                         sysfs_remove_group(&dev->kobj, &socket_attrs);
 391         }
 392         return ret;
 393 }
 394
 395 void pccard_sysfs_remove_socket(struct device *dev)
 396 {
 397         sysfs_remove_bin_file(&dev->kobj, &pccard_cis_attr);
 398         sysfs_remove_group(&dev->kobj, &socket_attrs);
 399 }