VServer 1.9.2 (patch-2.6.8.1-vs1.9.2.diff)
[linux-2.6.git] / drivers / sbus / char / openprom.c
1 /*
2  * Linux/SPARC PROM Configuration Driver
3  * Copyright (C) 1996 Thomas K. Dyas (tdyas@noc.rutgers.edu)
4  * Copyright (C) 1996 Eddie C. Dost  (ecd@skynet.be)
5  *
6  * This character device driver allows user programs to access the
7  * PROM device tree. It is compatible with the SunOS /dev/openprom
8  * driver and the NetBSD /dev/openprom driver. The SunOS eeprom
9  * utility works without any modifications.
10  *
11  * The driver uses a minor number under the misc device major. The
12  * file read/write mode determines the type of access to the PROM.
13  * Interrupts are disabled whenever the driver calls into the PROM for
14  * sanity's sake.
15  */
16
17 /* This program is free software; you can redistribute it and/or
18  * modify it under the terms of the GNU General Public License as
19  * published by the Free Software Foundation; either version 2 of the
20  * License, or (at your option) any later version.
21  *
22  * This program is distributed in the hope that it will be useful, but
23  * WITHOUT ANY WARRANTY; without even the implied warranty of
24  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
25  * General Public License for more details.
26  *
27  * You should have received a copy of the GNU General Public License
28  * along with this program; if not, write to the Free Software
29  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 
30  */
31
32 #define PROMLIB_INTERNAL
33
34 #include <linux/config.h>
35 #include <linux/module.h>
36 #include <linux/kernel.h>
37 #include <linux/sched.h>
38 #include <linux/errno.h>
39 #include <linux/slab.h>
40 #include <linux/string.h>
41 #include <linux/miscdevice.h>
42 #include <linux/init.h>
43 #include <linux/fs.h>
44 #include <asm/oplib.h>
45 #include <asm/system.h>
46 #include <asm/uaccess.h>
47 #include <asm/openpromio.h>
48 #ifdef CONFIG_PCI
49 #include <linux/pci.h>
50 #include <asm/pbm.h>
51 #endif
52
53 /* Private data kept by the driver for each descriptor. */
54 typedef struct openprom_private_data
55 {
56         int current_node;       /* Current node for SunOS ioctls. */
57         int lastnode;           /* Last valid node used by BSD ioctls. */
58 } DATA;
59
60 /* ID of the PROM node containing all of the EEPROM options. */
61 static int options_node = 0;
62
63 /*
64  * Copy an openpromio structure into kernel space from user space.
65  * This routine does error checking to make sure that all memory
66  * accesses are within bounds. A pointer to the allocated openpromio
67  * structure will be placed in "*opp_p". Return value is the length
68  * of the user supplied buffer.
69  */
70 static int copyin(struct openpromio __user *info, struct openpromio **opp_p)
71 {
72         unsigned int bufsize;
73
74         if (!info || !opp_p)
75                 return -EFAULT;
76
77         if (get_user(bufsize, &info->oprom_size))
78                 return -EFAULT;
79
80         if (bufsize == 0)
81                 return -EINVAL;
82
83         /* If the bufsize is too large, just limit it.
84          * Fix from Jason Rappleye.
85          */
86         if (bufsize > OPROMMAXPARAM)
87                 bufsize = OPROMMAXPARAM;
88
89         if (!(*opp_p = kmalloc(sizeof(int) + bufsize + 1, GFP_KERNEL)))
90                 return -ENOMEM;
91         memset(*opp_p, 0, sizeof(int) + bufsize + 1);
92
93         if (copy_from_user(&(*opp_p)->oprom_array,
94                            &info->oprom_array, bufsize)) {
95                 kfree(*opp_p);
96                 return -EFAULT;
97         }
98         return bufsize;
99 }
100
101 static int getstrings(struct openpromio __user *info, struct openpromio **opp_p)
102 {
103         int n, bufsize;
104         char c;
105
106         if (!info || !opp_p)
107                 return -EFAULT;
108
109         if (!(*opp_p = kmalloc(sizeof(int) + OPROMMAXPARAM + 1, GFP_KERNEL)))
110                 return -ENOMEM;
111
112         memset(*opp_p, 0, sizeof(int) + OPROMMAXPARAM + 1);
113         (*opp_p)->oprom_size = 0;
114
115         n = bufsize = 0;
116         while ((n < 2) && (bufsize < OPROMMAXPARAM)) {
117                 if (get_user(c, &info->oprom_array[bufsize])) {
118                         kfree(*opp_p);
119                         return -EFAULT;
120                 }
121                 if (c == '\0')
122                         n++;
123                 (*opp_p)->oprom_array[bufsize++] = c;
124         }
125         if (!n) {
126                 kfree(*opp_p);
127                 return -EINVAL;
128         }
129         return bufsize;
130 }
131
132 /*
133  * Copy an openpromio structure in kernel space back to user space.
134  */
135 static int copyout(void __user *info, struct openpromio *opp, int len)
136 {
137         if (copy_to_user(info, opp, len))
138                 return -EFAULT;
139         return 0;
140 }
141
142 /*
143  *      SunOS and Solaris /dev/openprom ioctl calls.
144  */
145 static int openprom_sunos_ioctl(struct inode * inode, struct file * file,
146                                 unsigned int cmd, unsigned long arg, int node)
147 {
148         DATA *data = (DATA *) file->private_data;
149         char buffer[OPROMMAXPARAM+1], *buf;
150         struct openpromio *opp;
151         int bufsize, len, error = 0;
152         static int cnt;
153         void __user *argp = (void __user *)arg;
154
155         if (cmd == OPROMSETOPT)
156                 bufsize = getstrings(argp, &opp);
157         else
158                 bufsize = copyin(argp, &opp);
159
160         if (bufsize < 0)
161                 return bufsize;
162
163         switch (cmd) {
164         case OPROMGETOPT:
165         case OPROMGETPROP:
166                 len = prom_getproplen(node, opp->oprom_array);
167
168                 if (len <= 0 || len > bufsize) {
169                         error = copyout(argp, opp, sizeof(int));
170                         break;
171                 }
172
173                 len = prom_getproperty(node, opp->oprom_array, buffer, bufsize);
174
175                 memcpy(opp->oprom_array, buffer, len);
176                 opp->oprom_array[len] = '\0';
177                 opp->oprom_size = len;
178
179                 error = copyout(argp, opp, sizeof(int) + bufsize);
180                 break;
181
182         case OPROMNXTOPT:
183         case OPROMNXTPROP:
184                 buf = prom_nextprop(node, opp->oprom_array, buffer);
185
186                 len = strlen(buf);
187                 if (len == 0 || len + 1 > bufsize) {
188                         error = copyout(argp, opp, sizeof(int));
189                         break;
190                 }
191
192                 memcpy(opp->oprom_array, buf, len);
193                 opp->oprom_array[len] = '\0';
194                 opp->oprom_size = ++len;
195
196                 error = copyout(argp, opp, sizeof(int) + bufsize);
197                 break;
198
199         case OPROMSETOPT:
200         case OPROMSETOPT2:
201                 buf = opp->oprom_array + strlen(opp->oprom_array) + 1;
202                 len = opp->oprom_array + bufsize - buf;
203
204                 error = prom_setprop(options_node, opp->oprom_array,
205                                      buf, len);
206
207                 if (error < 0)
208                         error = -EINVAL;
209                 break;
210
211         case OPROMNEXT:
212         case OPROMCHILD:
213         case OPROMSETCUR:
214                 if (bufsize < sizeof(int)) {
215                         error = -EINVAL;
216                         break;
217                 }
218
219                 node = *((int *) opp->oprom_array);
220
221                 switch (cmd) {
222                 case OPROMNEXT: node = __prom_getsibling(node); break;
223                 case OPROMCHILD: node = __prom_getchild(node); break;
224                 case OPROMSETCUR: break;
225                 }
226
227                 data->current_node = node;
228                 *((int *)opp->oprom_array) = node;
229                 opp->oprom_size = sizeof(int);
230
231                 error = copyout(argp, opp, bufsize + sizeof(int));
232                 break;
233
234         case OPROMPCI2NODE:
235                 error = -EINVAL;
236
237                 if (bufsize >= 2*sizeof(int)) {
238 #ifdef CONFIG_PCI
239                         struct pci_dev *pdev;
240                         struct pcidev_cookie *pcp;
241                         pdev = pci_find_slot (((int *) opp->oprom_array)[0],
242                                               ((int *) opp->oprom_array)[1]);
243
244                         pcp = pdev->sysdata;
245                         if (pcp != NULL && pcp->prom_node != -1 && pcp->prom_node) {
246                                 node = pcp->prom_node;
247                                 data->current_node = node;
248                                 *((int *)opp->oprom_array) = node;
249                                 opp->oprom_size = sizeof(int);
250                                 error = copyout(argp, opp, bufsize + sizeof(int));
251                         }
252 #endif
253                 }
254                 break;
255
256         case OPROMPATH2NODE:
257                 node = prom_finddevice(opp->oprom_array);
258                 data->current_node = node;
259                 *((int *)opp->oprom_array) = node;
260                 opp->oprom_size = sizeof(int);
261
262                 error = copyout(argp, opp, bufsize + sizeof(int));
263                 break;
264
265         case OPROMGETBOOTARGS:
266                 buf = saved_command_line;
267
268                 len = strlen(buf);
269
270                 if (len > bufsize) {
271                         error = -EINVAL;
272                         break;
273                 }
274
275                 strcpy(opp->oprom_array, buf);
276                 opp->oprom_size = len;
277
278                 error = copyout(argp, opp, bufsize + sizeof(int));
279                 break;
280
281         case OPROMU2P:
282         case OPROMGETCONS:
283         case OPROMGETFBNAME:
284                 if (cnt++ < 10)
285                         printk(KERN_INFO "openprom_sunos_ioctl: unimplemented ioctl\n");
286                 error = -EINVAL;
287                 break;
288         default:
289                 if (cnt++ < 10)
290                         printk(KERN_INFO "openprom_sunos_ioctl: cmd 0x%X, arg 0x%lX\n", cmd, arg);
291                 error = -EINVAL;
292                 break;
293         }
294
295         kfree(opp);
296         return error;
297 }
298
299
300 /* Return nonzero if a specific node is in the PROM device tree. */
301 static int intree(int root, int node)
302 {
303         for (; root != 0; root = prom_getsibling(root))
304                 if (root == node || intree(prom_getchild(root),node))
305                         return 1;
306         return 0;
307 }
308
309 /* Return nonzero if a specific node is "valid". */
310 static int goodnode(int n, DATA *data)
311 {
312         if (n == data->lastnode || n == prom_root_node || n == options_node)
313                 return 1;
314         if (n == 0 || n == -1 || !intree(prom_root_node,n))
315                 return 0;
316         data->lastnode = n;
317         return 1;
318 }
319
320 /* Copy in a whole string from userspace into kernelspace. */
321 static int copyin_string(char __user *user, size_t len, char **ptr)
322 {
323         char *tmp;
324
325         if ((ssize_t)len < 0 || (ssize_t)(len + 1) < 0)
326                 return -EINVAL;
327
328         tmp = kmalloc(len + 1, GFP_KERNEL);
329         if (!tmp)
330                 return -ENOMEM;
331
332         if(copy_from_user(tmp, user, len)) {
333                 kfree(tmp);
334                 return -EFAULT;
335         }
336
337         tmp[len] = '\0';
338
339         *ptr = tmp;
340
341         return 0;
342 }
343
344 /*
345  *      NetBSD /dev/openprom ioctl calls.
346  */
347 static int openprom_bsd_ioctl(struct inode * inode, struct file * file,
348                               unsigned int cmd, unsigned long arg)
349 {
350         DATA *data = (DATA *) file->private_data;
351         void __user *argp = (void __user *)arg;
352         struct opiocdesc op;
353         int error, node, len;
354         char *str, *tmp;
355         char buffer[64];
356         static int cnt;
357
358         switch (cmd) {
359         case OPIOCGET:
360                 if (copy_from_user(&op, argp, sizeof(op)))
361                         return -EFAULT;
362
363                 if (!goodnode(op.op_nodeid,data))
364                         return -EINVAL;
365
366                 error = copyin_string(op.op_name, op.op_namelen, &str);
367                 if (error)
368                         return error;
369
370                 len = prom_getproplen(op.op_nodeid,str);
371
372                 if (len > op.op_buflen) {
373                         kfree(str);
374                         return -ENOMEM;
375                 }
376
377                 op.op_buflen = len;
378
379                 if (len <= 0) {
380                         kfree(str);
381                         /* Verified by the above copy_from_user */
382                         if (__copy_to_user(argp, &op,
383                                        sizeof(op)))
384                                 return -EFAULT;
385                         return 0;
386                 }
387
388                 tmp = kmalloc(len + 1, GFP_KERNEL);
389                 if (!tmp) {
390                         kfree(str);
391                         return -ENOMEM;
392                 }
393
394                 prom_getproperty(op.op_nodeid, str, tmp, len);
395
396                 tmp[len] = '\0';
397
398                 if (__copy_to_user(argp, &op, sizeof(op)) != 0
399                     || copy_to_user(op.op_buf, tmp, len) != 0)
400                         error = -EFAULT;
401
402                 kfree(tmp);
403                 kfree(str);
404
405                 return error;
406
407         case OPIOCNEXTPROP:
408                 if (copy_from_user(&op, argp, sizeof(op)))
409                         return -EFAULT;
410
411                 if (!goodnode(op.op_nodeid,data))
412                         return -EINVAL;
413
414                 error = copyin_string(op.op_name, op.op_namelen, &str);
415                 if (error)
416                         return error;
417
418                 tmp = prom_nextprop(op.op_nodeid,str,buffer);
419
420                 if (tmp) {
421                         len = strlen(tmp);
422                         if (len > op.op_buflen)
423                                 len = op.op_buflen;
424                         else
425                                 op.op_buflen = len;
426                 } else {
427                         len = op.op_buflen = 0;
428                 }
429
430                 error = verify_area(VERIFY_WRITE, argp, sizeof(op));
431                 if (error) {
432                         kfree(str);
433                         return error;
434                 }
435
436                 error = verify_area(VERIFY_WRITE, op.op_buf, len);
437                 if (error) {
438                         kfree(str);
439                         return error;
440                 }
441
442                 error = __copy_to_user(argp, &op, sizeof(op));
443                 if (!error) error = __copy_to_user(op.op_buf, tmp, len);
444
445                 kfree(str);
446
447                 return error;
448
449         case OPIOCSET:
450                 if (copy_from_user(&op, argp, sizeof(op)))
451                         return -EFAULT;
452
453                 if (!goodnode(op.op_nodeid,data))
454                         return -EINVAL;
455
456                 error = copyin_string(op.op_name, op.op_namelen, &str);
457                 if (error)
458                         return error;
459
460                 error = copyin_string(op.op_buf, op.op_buflen, &tmp);
461                 if (error) {
462                         kfree(str);
463                         return error;
464                 }
465
466                 len = prom_setprop(op.op_nodeid,str,tmp,op.op_buflen+1);
467
468                 if (len != op.op_buflen)
469                         return -EINVAL;
470
471                 kfree(str);
472                 kfree(tmp);
473
474                 return 0;
475
476         case OPIOCGETOPTNODE:
477                 if (copy_to_user(argp, &options_node, sizeof(int)))
478                         return -EFAULT;
479                 return 0;
480
481         case OPIOCGETNEXT:
482         case OPIOCGETCHILD:
483                 if (copy_from_user(&node, argp, sizeof(int)))
484                         return -EFAULT;
485
486                 if (cmd == OPIOCGETNEXT)
487                         node = __prom_getsibling(node);
488                 else
489                         node = __prom_getchild(node);
490
491                 if (__copy_to_user(argp, &node, sizeof(int)))
492                         return -EFAULT;
493
494                 return 0;
495
496         default:
497                 if (cnt++ < 10)
498                         printk(KERN_INFO "openprom_bsd_ioctl: cmd 0x%X\n", cmd);
499                 return -EINVAL;
500
501         }
502 }
503
504
505 /*
506  *      Handoff control to the correct ioctl handler.
507  */
508 static int openprom_ioctl(struct inode * inode, struct file * file,
509                           unsigned int cmd, unsigned long arg)
510 {
511         DATA *data = (DATA *) file->private_data;
512         static int cnt;
513
514         switch (cmd) {
515         case OPROMGETOPT:
516         case OPROMNXTOPT:
517                 if ((file->f_mode & FMODE_READ) == 0)
518                         return -EPERM;
519                 return openprom_sunos_ioctl(inode, file, cmd, arg,
520                                             options_node);
521
522         case OPROMSETOPT:
523         case OPROMSETOPT2:
524                 if ((file->f_mode & FMODE_WRITE) == 0)
525                         return -EPERM;
526                 return openprom_sunos_ioctl(inode, file, cmd, arg,
527                                             options_node);
528
529         case OPROMNEXT:
530         case OPROMCHILD:
531         case OPROMGETPROP:
532         case OPROMNXTPROP:
533                 if ((file->f_mode & FMODE_READ) == 0)
534                         return -EPERM;
535                 return openprom_sunos_ioctl(inode, file, cmd, arg,
536                                             data->current_node);
537
538         case OPROMU2P:
539         case OPROMGETCONS:
540         case OPROMGETFBNAME:
541         case OPROMGETBOOTARGS:
542         case OPROMSETCUR:
543         case OPROMPCI2NODE:
544         case OPROMPATH2NODE:
545                 if ((file->f_mode & FMODE_READ) == 0)
546                         return -EPERM;
547                 return openprom_sunos_ioctl(inode, file, cmd, arg, 0);
548
549         case OPIOCGET:
550         case OPIOCNEXTPROP:
551         case OPIOCGETOPTNODE:
552         case OPIOCGETNEXT:
553         case OPIOCGETCHILD:
554                 if ((file->f_mode & FMODE_READ) == 0)
555                         return -EBADF;
556                 return openprom_bsd_ioctl(inode,file,cmd,arg);
557
558         case OPIOCSET:
559                 if ((file->f_mode & FMODE_WRITE) == 0)
560                         return -EBADF;
561                 return openprom_bsd_ioctl(inode,file,cmd,arg);
562
563         default:
564                 if (cnt++ < 10)
565                         printk("openprom_ioctl: cmd 0x%X, arg 0x%lX\n", cmd, arg);
566                 return -EINVAL;
567         }
568 }
569
570 static int openprom_open(struct inode * inode, struct file * file)
571 {
572         DATA *data;
573
574         data = (DATA *) kmalloc(sizeof(DATA), GFP_KERNEL);
575         if (!data)
576                 return -ENOMEM;
577
578         data->current_node = prom_root_node;
579         data->lastnode = prom_root_node;
580         file->private_data = (void *)data;
581
582         return 0;
583 }
584
585 static int openprom_release(struct inode * inode, struct file * file)
586 {
587         kfree(file->private_data);
588         return 0;
589 }
590
591 static struct file_operations openprom_fops = {
592         .owner =        THIS_MODULE,
593         .llseek =       no_llseek,
594         .ioctl =        openprom_ioctl,
595         .open =         openprom_open,
596         .release =      openprom_release,
597 };
598
599 static struct miscdevice openprom_dev = {
600         SUN_OPENPROM_MINOR, "openprom", &openprom_fops
601 };
602
603 static int __init openprom_init(void)
604 {
605         int error;
606
607         error = misc_register(&openprom_dev);
608         if (error) {
609                 printk(KERN_ERR "openprom: unable to get misc minor\n");
610                 return error;
611         }
612
613         options_node = prom_getchild(prom_root_node);
614         options_node = prom_searchsiblings(options_node,"options");
615
616         if (options_node == 0 || options_node == -1) {
617                 printk(KERN_ERR "openprom: unable to find options node\n");
618                 misc_deregister(&openprom_dev);
619                 return -EIO;
620         }
621
622         return 0;
623 }
624
625 static void __exit openprom_cleanup(void)
626 {
627         misc_deregister(&openprom_dev);
628 }
629
630 module_init(openprom_init);
631 module_exit(openprom_cleanup);
632 MODULE_LICENSE("GPL");