release/src-rt-6.x/linux/linux-2.6/drivers/pnp/interface.c

   1 /*
   2  * interface.c - contains everything related to the user interface
   3  *
   4  * Some code, especially possible resource dumping is based on isapnp_proc.c (c) Jaroslav Kysela <perex@suse.cz>
   5  * Copyright 2002 Adam Belay <ambx1@neo.rr.com>
   6  *
   7  */
   8
   9 #include <linux/pnp.h>
  10 #include <linux/string.h>
  11 #include <linux/errno.h>
  12 #include <linux/list.h>
  13 #include <linux/types.h>
  14 #include <linux/stat.h>
  15 #include <linux/ctype.h>
  16 #include <linux/slab.h>
  17 #include <asm/uaccess.h>
  18
  19 #include "base.h"
  20
  21 struct pnp_info_buffer {
  22         char *buffer;           /* pointer to begin of buffer */
  23         char *curr;             /* current position in buffer */
  24         unsigned long size;     /* current size */
  25         unsigned long len;      /* total length of buffer */
  26         int stop;               /* stop flag */
  27         int error;              /* error code */
  28 };
  29
  30 typedef struct pnp_info_buffer pnp_info_buffer_t;
  31
  32 static int pnp_printf(pnp_info_buffer_t * buffer, char *fmt,...)
  33 {
  34         va_list args;
  35         int res;
  36
  37         if (buffer->stop || buffer->error)
  38                 return 0;
  39         va_start(args, fmt);
  40         res = vsnprintf(buffer->curr, buffer->len - buffer->size, fmt, args);
  41         va_end(args);
  42         if (buffer->size + res >= buffer->len) {
  43                 buffer->stop = 1;
  44                 return 0;
  45         }
  46         buffer->curr += res;
  47         buffer->size += res;
  48         return res;
  49 }
  50
  51 static void pnp_print_port(pnp_info_buffer_t *buffer, char *space, struct pnp_port *port)
  52 {
  53         pnp_printf(buffer, "%sport 0x%x-0x%x, align 0x%x, size 0x%x, %i-bit address decoding\n",
  54                         space, port->min, port->max, port->align ? (port->align-1) : 0, port->size,
  55                         port->flags & PNP_PORT_FLAG_16BITADDR ? 16 : 10);
  56 }
  57
  58 static void pnp_print_irq(pnp_info_buffer_t *buffer, char *space, struct pnp_irq *irq)
  59 {
  60         int first = 1, i;
  61
  62         pnp_printf(buffer, "%sirq ", space);
  63         for (i = 0; i < PNP_IRQ_NR; i++)
  64                 if (test_bit(i, irq->map)) {
  65                         if (!first) {
  66                                 pnp_printf(buffer, ",");
  67                         } else {
  68                                 first = 0;
  69                         }
  70                         if (i == 2 || i == 9)
  71                                 pnp_printf(buffer, "2/9");
  72                         else
  73                                 pnp_printf(buffer, "%i", i);
  74                 }
  75         if (bitmap_empty(irq->map, PNP_IRQ_NR))
  76                 pnp_printf(buffer, "<none>");
  77         if (irq->flags & IORESOURCE_IRQ_HIGHEDGE)
  78                 pnp_printf(buffer, " High-Edge");
  79         if (irq->flags & IORESOURCE_IRQ_LOWEDGE)
  80                 pnp_printf(buffer, " Low-Edge");
  81         if (irq->flags & IORESOURCE_IRQ_HIGHLEVEL)
  82                 pnp_printf(buffer, " High-Level");
  83         if (irq->flags & IORESOURCE_IRQ_LOWLEVEL)
  84                 pnp_printf(buffer, " Low-Level");
  85         pnp_printf(buffer, "\n");
  86 }
  87
  88 static void pnp_print_dma(pnp_info_buffer_t *buffer, char *space, struct pnp_dma *dma)
  89 {
  90         int first = 1, i;
  91         char *s;
  92
  93         pnp_printf(buffer, "%sdma ", space);
  94         for (i = 0; i < 8; i++)
  95                 if (dma->map & (1<<i)) {
  96                         if (!first) {
  97                                 pnp_printf(buffer, ",");
  98                         } else {
  99                                 first = 0;
 100                         }
 101                         pnp_printf(buffer, "%i", i);
 102                 }
 103         if (!dma->map)
 104                 pnp_printf(buffer, "<none>");
 105         switch (dma->flags & IORESOURCE_DMA_TYPE_MASK) {
 106         case IORESOURCE_DMA_8BIT:
 107                 s = "8-bit";
 108                 break;
 109         case IORESOURCE_DMA_8AND16BIT:
 110                 s = "8-bit&16-bit";
 111                 break;
 112         default:
 113                 s = "16-bit";
 114         }
 115         pnp_printf(buffer, " %s", s);
 116         if (dma->flags & IORESOURCE_DMA_MASTER)
 117                 pnp_printf(buffer, " master");
 118         if (dma->flags & IORESOURCE_DMA_BYTE)
 119                 pnp_printf(buffer, " byte-count");
 120         if (dma->flags & IORESOURCE_DMA_WORD)
 121                 pnp_printf(buffer, " word-count");
 122         switch (dma->flags & IORESOURCE_DMA_SPEED_MASK) {
 123         case IORESOURCE_DMA_TYPEA:
 124                 s = "type-A";
 125                 break;
 126         case IORESOURCE_DMA_TYPEB:
 127                 s = "type-B";
 128                 break;
 129         case IORESOURCE_DMA_TYPEF:
 130                 s = "type-F";
 131                 break;
 132         default:
 133                 s = "compatible";
 134                 break;
 135         }
 136         pnp_printf(buffer, " %s\n", s);
 137 }
 138
 139 static void pnp_print_mem(pnp_info_buffer_t *buffer, char *space, struct pnp_mem *mem)
 140 {
 141         char *s;
 142
 143         pnp_printf(buffer, "%sMemory 0x%x-0x%x, align 0x%x, size 0x%x",
 144                         space, mem->min, mem->max, mem->align, mem->size);
 145         if (mem->flags & IORESOURCE_MEM_WRITEABLE)
 146                 pnp_printf(buffer, ", writeable");
 147         if (mem->flags & IORESOURCE_MEM_CACHEABLE)
 148                 pnp_printf(buffer, ", cacheable");
 149         if (mem->flags & IORESOURCE_MEM_RANGELENGTH)
 150                 pnp_printf(buffer, ", range-length");
 151         if (mem->flags & IORESOURCE_MEM_SHADOWABLE)
 152                 pnp_printf(buffer, ", shadowable");
 153         if (mem->flags & IORESOURCE_MEM_EXPANSIONROM)
 154                 pnp_printf(buffer, ", expansion ROM");
 155         switch (mem->flags & IORESOURCE_MEM_TYPE_MASK) {
 156         case IORESOURCE_MEM_8BIT:
 157                 s = "8-bit";
 158                 break;
 159         case IORESOURCE_MEM_8AND16BIT:
 160                 s = "8-bit&16-bit";
 161                 break;
 162         case IORESOURCE_MEM_32BIT:
 163                 s = "32-bit";
 164                 break;
 165         default:
 166                 s = "16-bit";
 167         }
 168         pnp_printf(buffer, ", %s\n", s);
 169 }
 170
 171 static void pnp_print_option(pnp_info_buffer_t *buffer, char *space,
 172                              struct pnp_option *option, int dep)
 173 {
 174         char *s;
 175         struct pnp_port *port;
 176         struct pnp_irq *irq;
 177         struct pnp_dma *dma;
 178         struct pnp_mem *mem;
 179
 180         if (dep) {
 181                 switch (option->priority) {
 182                         case PNP_RES_PRIORITY_PREFERRED:
 183                         s = "preferred";
 184                         break;
 185                         case PNP_RES_PRIORITY_ACCEPTABLE:
 186                         s = "acceptable";
 187                         break;
 188                         case PNP_RES_PRIORITY_FUNCTIONAL:
 189                         s = "functional";
 190                         break;
 191                         default:
 192                         s = "invalid";
 193                 }
 194                 pnp_printf(buffer, "Dependent: %02i - Priority %s\n",dep, s);
 195         }
 196
 197         for (port = option->port; port; port = port->next)
 198                 pnp_print_port(buffer, space, port);
 199         for (irq = option->irq; irq; irq = irq->next)
 200                 pnp_print_irq(buffer, space, irq);
 201         for (dma = option->dma; dma; dma = dma->next)
 202                 pnp_print_dma(buffer, space, dma);
 203         for (mem = option->mem; mem; mem = mem->next)
 204                 pnp_print_mem(buffer, space, mem);
 205 }
 206
 207
 208 static ssize_t pnp_show_options(struct device *dmdev, struct device_attribute *attr, char *buf)
 209 {
 210         struct pnp_dev *dev = to_pnp_dev(dmdev);
 211         struct pnp_option * independent = dev->independent;
 212         struct pnp_option * dependent = dev->dependent;
 213         int ret, dep = 1;
 214
 215         pnp_info_buffer_t *buffer = (pnp_info_buffer_t *)
 216                                  pnp_alloc(sizeof(pnp_info_buffer_t));
 217         if (!buffer)
 218                 return -ENOMEM;
 219
 220         buffer->len = PAGE_SIZE;
 221         buffer->buffer = buf;
 222         buffer->curr = buffer->buffer;
 223         if (independent)
 224                 pnp_print_option(buffer, "", independent, 0);
 225
 226         while (dependent){
 227                 pnp_print_option(buffer, "   ", dependent, dep);
 228                 dependent = dependent->next;
 229                 dep++;
 230         }
 231         ret = (buffer->curr - buf);
 232         kfree(buffer);
 233         return ret;
 234 }
 235
 236 static DEVICE_ATTR(options,S_IRUGO,pnp_show_options,NULL);
 237
 238
 239 static ssize_t pnp_show_current_resources(struct device *dmdev, struct device_attribute *attr, char *buf)
 240 {
 241         struct pnp_dev *dev = to_pnp_dev(dmdev);
 242         int i, ret;
 243         pnp_info_buffer_t *buffer;
 244
 245         if (!dev)
 246                 return -EINVAL;
 247
 248         buffer = (pnp_info_buffer_t *) pnp_alloc(sizeof(pnp_info_buffer_t));
 249         if (!buffer)
 250                 return -ENOMEM;
 251         buffer->len = PAGE_SIZE;
 252         buffer->buffer = buf;
 253         buffer->curr = buffer->buffer;
 254
 255         pnp_printf(buffer,"state = ");
 256         if (dev->active)
 257                 pnp_printf(buffer,"active\n");
 258         else
 259                 pnp_printf(buffer,"disabled\n");
 260
 261         for (i = 0; i < PNP_MAX_PORT; i++) {
 262                 if (pnp_port_valid(dev, i)) {
 263                         pnp_printf(buffer,"io");
 264                         if (pnp_port_flags(dev, i) & IORESOURCE_DISABLED)
 265                                 pnp_printf(buffer," disabled\n");
 266                         else
 267                                 pnp_printf(buffer," 0x%llx-0x%llx\n",
 268                                         (unsigned long long)pnp_port_start(dev, i),
 269                                         (unsigned long long)pnp_port_end(dev, i));
 270                 }
 271         }
 272         for (i = 0; i < PNP_MAX_MEM; i++) {
 273                 if (pnp_mem_valid(dev, i)) {
 274                         pnp_printf(buffer,"mem");
 275                         if (pnp_mem_flags(dev, i) & IORESOURCE_DISABLED)
 276                                 pnp_printf(buffer," disabled\n");
 277                         else
 278                                 pnp_printf(buffer," 0x%llx-0x%llx\n",
 279                                         (unsigned long long)pnp_mem_start(dev, i),
 280                                         (unsigned long long)pnp_mem_end(dev, i));
 281                 }
 282         }
 283         for (i = 0; i < PNP_MAX_IRQ; i++) {
 284                 if (pnp_irq_valid(dev, i)) {
 285                         pnp_printf(buffer,"irq");
 286                         if (pnp_irq_flags(dev, i) & IORESOURCE_DISABLED)
 287                                 pnp_printf(buffer," disabled\n");
 288                         else
 289                                 pnp_printf(buffer," %lld\n",
 290                                         (unsigned long long)pnp_irq(dev, i));
 291                 }
 292         }
 293         for (i = 0; i < PNP_MAX_DMA; i++) {
 294                 if (pnp_dma_valid(dev, i)) {
 295                         pnp_printf(buffer,"dma");
 296                         if (pnp_dma_flags(dev, i) & IORESOURCE_DISABLED)
 297                                 pnp_printf(buffer," disabled\n");
 298                         else
 299                                 pnp_printf(buffer," %lld\n",
 300                                         (unsigned long long)pnp_dma(dev, i));
 301                 }
 302         }
 303         ret = (buffer->curr - buf);
 304         kfree(buffer);
 305         return ret;
 306 }
 307
 308 extern struct semaphore pnp_res_mutex;
 309
 310 static ssize_t
 311 pnp_set_current_resources(struct device * dmdev, struct device_attribute *attr, const char * ubuf, size_t count)
 312 {
 313         struct pnp_dev *dev = to_pnp_dev(dmdev);
 314         char    *buf = (void *)ubuf;
 315         int     retval = 0;
 316
 317         if (dev->status & PNP_ATTACHED) {
 318                 retval = -EBUSY;
 319                 pnp_info("Device %s cannot be configured because it is in use.", dev->dev.bus_id);
 320                 goto done;
 321         }
 322
 323         while (isspace(*buf))
 324                 ++buf;
 325         if (!strnicmp(buf,"disable",7)) {
 326                 retval = pnp_disable_dev(dev);
 327                 goto done;
 328         }
 329         if (!strnicmp(buf,"activate",8)) {
 330                 retval = pnp_activate_dev(dev);
 331                 goto done;
 332         }
 333         if (!strnicmp(buf,"fill",4)) {
 334                 if (dev->active)
 335                         goto done;
 336                 retval = pnp_auto_config_dev(dev);
 337                 goto done;
 338         }
 339         if (!strnicmp(buf,"auto",4)) {
 340                 if (dev->active)
 341                         goto done;
 342                 pnp_init_resource_table(&dev->res);
 343                 retval = pnp_auto_config_dev(dev);
 344                 goto done;
 345         }
 346         if (!strnicmp(buf,"clear",5)) {
 347                 if (dev->active)
 348                         goto done;
 349                 pnp_init_resource_table(&dev->res);
 350                 goto done;
 351         }
 352         if (!strnicmp(buf,"get",3)) {
 353                 down(&pnp_res_mutex);
 354                 if (pnp_can_read(dev))
 355                         dev->protocol->get(dev, &dev->res);
 356                 up(&pnp_res_mutex);
 357                 goto done;
 358         }
 359         if (!strnicmp(buf,"set",3)) {
 360                 int nport = 0, nmem = 0, nirq = 0, ndma = 0;
 361                 if (dev->active)
 362                         goto done;
 363                 buf += 3;
 364                 pnp_init_resource_table(&dev->res);
 365                 down(&pnp_res_mutex);
 366                 while (1) {
 367                         while (isspace(*buf))
 368                                 ++buf;
 369                         if (!strnicmp(buf,"io",2)) {
 370                                 buf += 2;
 371                                 while (isspace(*buf))
 372                                         ++buf;
 373                                 dev->res.port_resource[nport].start = simple_strtoul(buf,&buf,0);
 374                                 while (isspace(*buf))
 375                                         ++buf;
 376                                 if(*buf == '-') {
 377                                         buf += 1;
 378                                         while (isspace(*buf))
 379                                                 ++buf;
 380                                         dev->res.port_resource[nport].end = simple_strtoul(buf,&buf,0);
 381                                 } else
 382                                         dev->res.port_resource[nport].end = dev->res.port_resource[nport].start;
 383                                 dev->res.port_resource[nport].flags = IORESOURCE_IO;
 384                                 nport++;
 385                                 if (nport >= PNP_MAX_PORT)
 386                                         break;
 387                                 continue;
 388                         }
 389                         if (!strnicmp(buf,"mem",3)) {
 390                                 buf += 3;
 391                                 while (isspace(*buf))
 392                                         ++buf;
 393                                 dev->res.mem_resource[nmem].start = simple_strtoul(buf,&buf,0);
 394                                 while (isspace(*buf))
 395                                         ++buf;
 396                                 if(*buf == '-') {
 397                                         buf += 1;
 398                                         while (isspace(*buf))
 399                                                 ++buf;
 400                                         dev->res.mem_resource[nmem].end = simple_strtoul(buf,&buf,0);
 401                                 } else
 402                                         dev->res.mem_resource[nmem].end = dev->res.mem_resource[nmem].start;
 403                                 dev->res.mem_resource[nmem].flags = IORESOURCE_MEM;
 404                                 nmem++;
 405                                 if (nmem >= PNP_MAX_MEM)
 406                                         break;
 407                                 continue;
 408                         }
 409                         if (!strnicmp(buf,"irq",3)) {
 410                                 buf += 3;
 411                                 while (isspace(*buf))
 412                                         ++buf;
 413                                 dev->res.irq_resource[nirq].start =
 414                                 dev->res.irq_resource[nirq].end = simple_strtoul(buf,&buf,0);
 415                                 dev->res.irq_resource[nirq].flags = IORESOURCE_IRQ;
 416                                 nirq++;
 417                                 if (nirq >= PNP_MAX_IRQ)
 418                                         break;
 419                                 continue;
 420                         }
 421                         if (!strnicmp(buf,"dma",3)) {
 422                                 buf += 3;
 423                                 while (isspace(*buf))
 424                                         ++buf;
 425                                 dev->res.dma_resource[ndma].start =
 426                                 dev->res.dma_resource[ndma].end = simple_strtoul(buf,&buf,0);
 427                                 dev->res.dma_resource[ndma].flags = IORESOURCE_DMA;
 428                                 ndma++;
 429                                 if (ndma >= PNP_MAX_DMA)
 430                                         break;
 431                                 continue;
 432                         }
 433                         break;
 434                 }
 435                 up(&pnp_res_mutex);
 436                 goto done;
 437         }
 438  done:
 439         if (retval < 0)
 440                 return retval;
 441         return count;
 442 }
 443
 444 static DEVICE_ATTR(resources,S_IRUGO | S_IWUSR,
 445                    pnp_show_current_resources,pnp_set_current_resources);
 446
 447 static ssize_t pnp_show_current_ids(struct device *dmdev, struct device_attribute *attr, char *buf)
 448 {
 449         char *str = buf;
 450         struct pnp_dev *dev = to_pnp_dev(dmdev);
 451         struct pnp_id * pos = dev->id;
 452
 453         while (pos) {
 454                 str += sprintf(str,"%s\n", pos->id);
 455                 pos = pos->next;
 456         }
 457         return (str - buf);
 458 }
 459
 460 static DEVICE_ATTR(id,S_IRUGO,pnp_show_current_ids,NULL);
 461
 462 int pnp_interface_attach_device(struct pnp_dev *dev)
 463 {
 464         int rc = device_create_file(&dev->dev,&dev_attr_options);
 465         if (rc) goto err;
 466         rc = device_create_file(&dev->dev,&dev_attr_resources);
 467         if (rc) goto err_opt;
 468         rc = device_create_file(&dev->dev,&dev_attr_id);
 469         if (rc) goto err_res;
 470
 471         return 0;
 472
 473 err_res:
 474         device_remove_file(&dev->dev,&dev_attr_resources);
 475 err_opt:
 476         device_remove_file(&dev->dev,&dev_attr_options);
 477 err:
 478         return rc;
 479 }