[CIFS] Check return code on failed alloc
[linux-2.6/mini2440.git] / drivers / pnp / interface.c
blobac9fcd499f3f0cb9912dee2e1400e6f1f519aad3
1 /*
2 * interface.c - contains everything related to the user interface
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>
7 */
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>
19 #include "base.h"
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 */
30 typedef struct pnp_info_buffer pnp_info_buffer_t;
32 static int pnp_printf(pnp_info_buffer_t * buffer, char *fmt,...)
34 va_list args;
35 int res;
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;
46 buffer->curr += res;
47 buffer->size += res;
48 return res;
51 static void pnp_print_port(pnp_info_buffer_t *buffer, char *space, struct pnp_port *port)
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);
58 static void pnp_print_irq(pnp_info_buffer_t *buffer, char *space, struct pnp_irq *irq)
60 int first = 1, i;
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;
70 if (i == 2 || i == 9)
71 pnp_printf(buffer, "2/9");
72 else
73 pnp_printf(buffer, "%i", i);
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");
88 static void pnp_print_dma(pnp_info_buffer_t *buffer, char *space, struct pnp_dma *dma)
90 int first = 1, i;
91 char *s;
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;
101 pnp_printf(buffer, "%i", i);
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";
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;
136 pnp_printf(buffer, " %s\n", s);
139 static void pnp_print_mem(pnp_info_buffer_t *buffer, char *space, struct pnp_mem *mem)
141 char *s;
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";
168 pnp_printf(buffer, ", %s\n", s);
171 static void pnp_print_option(pnp_info_buffer_t *buffer, char *space,
172 struct pnp_option *option, int dep)
174 char *s;
175 struct pnp_port *port;
176 struct pnp_irq *irq;
177 struct pnp_dma *dma;
178 struct pnp_mem *mem;
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";
194 pnp_printf(buffer, "Dependent: %02i - Priority %s\n",dep, s);
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);
208 static ssize_t pnp_show_options(struct device *dmdev, struct device_attribute *attr, char *buf)
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;
215 pnp_info_buffer_t *buffer = (pnp_info_buffer_t *)
216 pnp_alloc(sizeof(pnp_info_buffer_t));
217 if (!buffer)
218 return -ENOMEM;
220 buffer->len = PAGE_SIZE;
221 buffer->buffer = buf;
222 buffer->curr = buffer->buffer;
223 if (independent)
224 pnp_print_option(buffer, "", independent, 0);
226 while (dependent){
227 pnp_print_option(buffer, " ", dependent, dep);
228 dependent = dependent->next;
229 dep++;
231 ret = (buffer->curr - buf);
232 kfree(buffer);
233 return ret;
236 static DEVICE_ATTR(options,S_IRUGO,pnp_show_options,NULL);
239 static ssize_t pnp_show_current_resources(struct device *dmdev, struct device_attribute *attr, char *buf)
241 struct pnp_dev *dev = to_pnp_dev(dmdev);
242 int i, ret;
243 pnp_info_buffer_t *buffer;
245 if (!dev)
246 return -EINVAL;
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;
255 pnp_printf(buffer,"state = ");
256 if (dev->active)
257 pnp_printf(buffer,"active\n");
258 else
259 pnp_printf(buffer,"disabled\n");
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));
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));
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));
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));
303 ret = (buffer->curr - buf);
304 kfree(buffer);
305 return ret;
308 extern struct semaphore pnp_res_mutex;
310 static ssize_t
311 pnp_set_current_resources(struct device * dmdev, struct device_attribute *attr, const char * ubuf, size_t count)
313 struct pnp_dev *dev = to_pnp_dev(dmdev);
314 char *buf = (void *)ubuf;
315 int retval = 0;
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;
323 while (isspace(*buf))
324 ++buf;
325 if (!strnicmp(buf,"disable",7)) {
326 retval = pnp_disable_dev(dev);
327 goto done;
329 if (!strnicmp(buf,"activate",8)) {
330 retval = pnp_activate_dev(dev);
331 goto done;
333 if (!strnicmp(buf,"fill",4)) {
334 if (dev->active)
335 goto done;
336 retval = pnp_auto_config_dev(dev);
337 goto done;
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;
346 if (!strnicmp(buf,"clear",5)) {
347 if (dev->active)
348 goto done;
349 pnp_init_resource_table(&dev->res);
350 goto done;
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;
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;
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;
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;
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;
433 break;
435 up(&pnp_res_mutex);
436 goto done;
438 done:
439 if (retval < 0)
440 return retval;
441 return count;
444 static DEVICE_ATTR(resources,S_IRUGO | S_IWUSR,
445 pnp_show_current_resources,pnp_set_current_resources);
447 static ssize_t pnp_show_current_ids(struct device *dmdev, struct device_attribute *attr, char *buf)
449 char *str = buf;
450 struct pnp_dev *dev = to_pnp_dev(dmdev);
451 struct pnp_id * pos = dev->id;
453 while (pos) {
454 str += sprintf(str,"%s\n", pos->id);
455 pos = pos->next;
457 return (str - buf);
460 static DEVICE_ATTR(id,S_IRUGO,pnp_show_current_ids,NULL);
462 int pnp_interface_attach_device(struct pnp_dev *dev)
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;
471 return 0;
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;