Merge master.kernel.org:/pub/scm/linux/kernel/git/davem/net-2.6
[linux-2.6] / 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/smp_lock.h>
43 #include <linux/init.h>
44 #include <linux/fs.h>
45 #include <asm/oplib.h>
46 #include <asm/system.h>
47 #include <asm/uaccess.h>
48 #include <asm/openpromio.h>
49 #ifdef CONFIG_PCI
50 #include <linux/pci.h>
51 #include <asm/pbm.h>
52 #endif
53
54 /* Private data kept by the driver for each descriptor. */
55 typedef struct openprom_private_data
56 {
57         int current_node;       /* Current node for SunOS ioctls. */
58         int lastnode;           /* Last valid node used by BSD ioctls. */
59 } DATA;
60
61 /* ID of the PROM node containing all of the EEPROM options. */
62 static int options_node = 0;
63
64 /*
65  * Copy an openpromio structure into kernel space from user space.
66  * This routine does error checking to make sure that all memory
67  * accesses are within bounds. A pointer to the allocated openpromio
68  * structure will be placed in "*opp_p". Return value is the length
69  * of the user supplied buffer.
70  */
71 static int copyin(struct openpromio __user *info, struct openpromio **opp_p)
72 {
73         unsigned int bufsize;
74
75         if (!info || !opp_p)
76                 return -EFAULT;
77
78         if (get_user(bufsize, &info->oprom_size))
79                 return -EFAULT;
80
81         if (bufsize == 0)
82                 return -EINVAL;
83
84         /* If the bufsize is too large, just limit it.
85          * Fix from Jason Rappleye.
86          */
87         if (bufsize > OPROMMAXPARAM)
88                 bufsize = OPROMMAXPARAM;
89
90         if (!(*opp_p = kmalloc(sizeof(int) + bufsize + 1, GFP_KERNEL)))
91                 return -ENOMEM;
92         memset(*opp_p, 0, sizeof(int) + bufsize + 1);
93
94         if (copy_from_user(&(*opp_p)->oprom_array,
95                            &info->oprom_array, bufsize)) {
96                 kfree(*opp_p);
97                 return -EFAULT;
98         }
99         return bufsize;
100 }
101
102 static int getstrings(struct openpromio __user *info, struct openpromio **opp_p)
103 {
104         int n, bufsize;
105         char c;
106
107         if (!info || !opp_p)
108                 return -EFAULT;
109
110         if (!(*opp_p = kmalloc(sizeof(int) + OPROMMAXPARAM + 1, GFP_KERNEL)))
111                 return -ENOMEM;
112
113         memset(*opp_p, 0, sizeof(int) + OPROMMAXPARAM + 1);
114         (*opp_p)->oprom_size = 0;
115
116         n = bufsize = 0;
117         while ((n < 2) && (bufsize < OPROMMAXPARAM)) {
118                 if (get_user(c, &info->oprom_array[bufsize])) {
119                         kfree(*opp_p);
120                         return -EFAULT;
121                 }
122                 if (c == '\0')
123                         n++;
124                 (*opp_p)->oprom_array[bufsize++] = c;
125         }
126         if (!n) {
127                 kfree(*opp_p);
128                 return -EINVAL;
129         }
130         return bufsize;
131 }
132
133 /*
134  * Copy an openpromio structure in kernel space back to user space.
135  */
136 static int copyout(void __user *info, struct openpromio *opp, int len)
137 {
138         if (copy_to_user(info, opp, len))
139                 return -EFAULT;
140         return 0;
141 }
142
143 /*
144  *      SunOS and Solaris /dev/openprom ioctl calls.
145  */
146 static int openprom_sunos_ioctl(struct inode * inode, struct file * file,
147                                 unsigned int cmd, unsigned long arg, int node)
148 {
149         DATA *data = (DATA *) file->private_data;
150         char buffer[OPROMMAXPARAM+1], *buf;
151         struct openpromio *opp;
152         int bufsize, len, error = 0;
153         static int cnt;
154         void __user *argp = (void __user *)arg;
155
156         if (cmd == OPROMSETOPT)
157                 bufsize = getstrings(argp, &opp);
158         else
159                 bufsize = copyin(argp, &opp);
160
161         if (bufsize < 0)
162                 return bufsize;
163
164         switch (cmd) {
165         case OPROMGETOPT:
166         case OPROMGETPROP:
167                 len = prom_getproplen(node, opp->oprom_array);
168
169                 if (len <= 0 || len > bufsize) {
170                         error = copyout(argp, opp, sizeof(int));
171                         break;
172                 }
173
174                 len = prom_getproperty(node, opp->oprom_array, buffer, bufsize);
175
176                 memcpy(opp->oprom_array, buffer, len);
177                 opp->oprom_array[len] = '\0';
178                 opp->oprom_size = len;
179
180                 error = copyout(argp, opp, sizeof(int) + bufsize);
181                 break;
182
183         case OPROMNXTOPT:
184         case OPROMNXTPROP:
185                 buf = prom_nextprop(node, opp->oprom_array, buffer);
186
187                 len = strlen(buf);
188                 if (len == 0 || len + 1 > bufsize) {
189                         error = copyout(argp, opp, sizeof(int));
190                         break;
191                 }
192
193                 memcpy(opp->oprom_array, buf, len);
194                 opp->oprom_array[len] = '\0';
195                 opp->oprom_size = ++len;
196
197                 error = copyout(argp, opp, sizeof(int) + bufsize);
198                 break;
199
200         case OPROMSETOPT:
201         case OPROMSETOPT2:
202                 buf = opp->oprom_array + strlen(opp->oprom_array) + 1;
203                 len = opp->oprom_array + bufsize - buf;
204
205                 error = prom_setprop(options_node, opp->oprom_array,
206                                      buf, len);
207
208                 if (error < 0)
209                         error = -EINVAL;
210                 break;
211
212         case OPROMNEXT:
213         case OPROMCHILD:
214         case OPROMSETCUR:
215                 if (bufsize < sizeof(int)) {
216                         error = -EINVAL;
217                         break;
218                 }
219
220                 node = *((int *) opp->oprom_array);
221
222                 switch (cmd) {
223                 case OPROMNEXT: node = __prom_getsibling(node); break;
224                 case OPROMCHILD: node = __prom_getchild(node); break;
225                 case OPROMSETCUR: break;
226                 }
227
228                 data->current_node = node;
229                 *((int *)opp->oprom_array) = node;
230                 opp->oprom_size = sizeof(int);
231
232                 error = copyout(argp, opp, bufsize + sizeof(int));
233                 break;
234
235         case OPROMPCI2NODE:
236                 error = -EINVAL;
237
238                 if (bufsize >= 2*sizeof(int)) {
239 #ifdef CONFIG_PCI
240                         struct pci_dev *pdev;
241                         struct pcidev_cookie *pcp;
242                         pdev = pci_find_slot (((int *) opp->oprom_array)[0],
243                                               ((int *) opp->oprom_array)[1]);
244
245                         pcp = pdev->sysdata;
246                         if (pcp != NULL && pcp->prom_node != -1 && pcp->prom_node) {
247                                 node = pcp->prom_node;
248                                 data->current_node = node;
249                                 *((int *)opp->oprom_array) = node;
250                                 opp->oprom_size = sizeof(int);
251                                 error = copyout(argp, opp, bufsize + sizeof(int));
252                         }
253 #endif
254                 }
255                 break;
256
257         case OPROMPATH2NODE:
258                 node = prom_finddevice(opp->oprom_array);
259                 data->current_node = node;
260                 *((int *)opp->oprom_array) = node;
261                 opp->oprom_size = sizeof(int);
262
263                 error = copyout(argp, opp, bufsize + sizeof(int));
264                 break;
265
266         case OPROMGETBOOTARGS:
267                 buf = saved_command_line;
268
269                 len = strlen(buf);
270
271                 if (len > bufsize) {
272                         error = -EINVAL;
273                         break;
274                 }
275
276                 strcpy(opp->oprom_array, buf);
277                 opp->oprom_size = len;
278
279                 error = copyout(argp, opp, bufsize + sizeof(int));
280                 break;
281
282         case OPROMU2P:
283         case OPROMGETCONS:
284         case OPROMGETFBNAME:
285                 if (cnt++ < 10)
286                         printk(KERN_INFO "openprom_sunos_ioctl: unimplemented ioctl\n");
287                 error = -EINVAL;
288                 break;
289         default:
290                 if (cnt++ < 10)
291                         printk(KERN_INFO "openprom_sunos_ioctl: cmd 0x%X, arg 0x%lX\n", cmd, arg);
292                 error = -EINVAL;
293                 break;
294         }
295
296         kfree(opp);
297         return error;
298 }
299
300
301 /* Return nonzero if a specific node is in the PROM device tree. */
302 static int intree(int root, int node)
303 {
304         for (; root != 0; root = prom_getsibling(root))
305                 if (root == node || intree(prom_getchild(root),node))
306                         return 1;
307         return 0;
308 }
309
310 /* Return nonzero if a specific node is "valid". */
311 static int goodnode(int n, DATA *data)
312 {
313         if (n == data->lastnode || n == prom_root_node || n == options_node)
314                 return 1;
315         if (n == 0 || n == -1 || !intree(prom_root_node,n))
316                 return 0;
317         data->lastnode = n;
318         return 1;
319 }
320
321 /* Copy in a whole string from userspace into kernelspace. */
322 static int copyin_string(char __user *user, size_t len, char **ptr)
323 {
324         char *tmp;
325
326         if ((ssize_t)len < 0 || (ssize_t)(len + 1) < 0)
327                 return -EINVAL;
328
329         tmp = kmalloc(len + 1, GFP_KERNEL);
330         if (!tmp)
331                 return -ENOMEM;
332
333         if(copy_from_user(tmp, user, len)) {
334                 kfree(tmp);
335                 return -EFAULT;
336         }
337
338         tmp[len] = '\0';
339
340         *ptr = tmp;
341
342         return 0;
343 }
344
345 /*
346  *      NetBSD /dev/openprom ioctl calls.
347  */
348 static int openprom_bsd_ioctl(struct inode * inode, struct file * file,
349                               unsigned int cmd, unsigned long arg)
350 {
351         DATA *data = (DATA *) file->private_data;
352         void __user *argp = (void __user *)arg;
353         struct opiocdesc op;
354         int error, node, len;
355         char *str, *tmp;
356         char buffer[64];
357         static int cnt;
358
359         switch (cmd) {
360         case OPIOCGET:
361                 if (copy_from_user(&op, argp, sizeof(op)))
362                         return -EFAULT;
363
364                 if (!goodnode(op.op_nodeid,data))
365                         return -EINVAL;
366
367                 error = copyin_string(op.op_name, op.op_namelen, &str);
368                 if (error)
369                         return error;
370
371                 len = prom_getproplen(op.op_nodeid,str);
372
373                 if (len > op.op_buflen) {
374                         kfree(str);
375                         return -ENOMEM;
376                 }
377
378                 op.op_buflen = len;
379
380                 if (len <= 0) {
381                         kfree(str);
382                         /* Verified by the above copy_from_user */
383                         if (__copy_to_user(argp, &op,
384                                        sizeof(op)))
385                                 return -EFAULT;
386                         return 0;
387                 }
388
389                 tmp = kmalloc(len + 1, GFP_KERNEL);
390                 if (!tmp) {
391                         kfree(str);
392                         return -ENOMEM;
393                 }
394
395                 cnt = prom_getproperty(op.op_nodeid, str, tmp, len);
396                 if (cnt <= 0) {
397                         error = -EINVAL;
398                 } else {
399                         tmp[len] = '\0';
400
401                         if (__copy_to_user(argp, &op, sizeof(op)) != 0 ||
402                             copy_to_user(op.op_buf, tmp, len) != 0)
403                                 error = -EFAULT;
404                 }
405
406                 kfree(tmp);
407                 kfree(str);
408
409                 return error;
410
411         case OPIOCNEXTPROP:
412                 if (copy_from_user(&op, argp, sizeof(op)))
413                         return -EFAULT;
414
415                 if (!goodnode(op.op_nodeid,data))
416                         return -EINVAL;
417
418                 error = copyin_string(op.op_name, op.op_namelen, &str);
419                 if (error)
420                         return error;
421
422                 tmp = prom_nextprop(op.op_nodeid,str,buffer);
423
424                 if (tmp) {
425                         len = strlen(tmp);
426                         if (len > op.op_buflen)
427                                 len = op.op_buflen;
428                         else
429                                 op.op_buflen = len;
430                 } else {
431                         len = op.op_buflen = 0;
432                 }
433
434                 if (!access_ok(VERIFY_WRITE, argp, sizeof(op))) {
435                         kfree(str);
436                         return -EFAULT;
437                 }
438
439                 if (!access_ok(VERIFY_WRITE, op.op_buf, len)) {
440                         kfree(str);
441                         return -EFAULT;
442                 }
443
444                 error = __copy_to_user(argp, &op, sizeof(op));
445                 if (!error) error = __copy_to_user(op.op_buf, tmp, len);
446
447                 kfree(str);
448
449                 return error;
450
451         case OPIOCSET:
452                 if (copy_from_user(&op, argp, sizeof(op)))
453                         return -EFAULT;
454
455                 if (!goodnode(op.op_nodeid,data))
456                         return -EINVAL;
457
458                 error = copyin_string(op.op_name, op.op_namelen, &str);
459                 if (error)
460                         return error;
461
462                 error = copyin_string(op.op_buf, op.op_buflen, &tmp);
463                 if (error) {
464                         kfree(str);
465                         return error;
466                 }
467
468                 len = prom_setprop(op.op_nodeid,str,tmp,op.op_buflen+1);
469
470                 if (len != op.op_buflen)
471                         return -EINVAL;
472
473                 kfree(str);
474                 kfree(tmp);
475
476                 return 0;
477
478         case OPIOCGETOPTNODE:
479                 if (copy_to_user(argp, &options_node, sizeof(int)))
480                         return -EFAULT;
481                 return 0;
482
483         case OPIOCGETNEXT:
484         case OPIOCGETCHILD:
485                 if (copy_from_user(&node, argp, sizeof(int)))
486                         return -EFAULT;
487
488                 if (cmd == OPIOCGETNEXT)
489                         node = __prom_getsibling(node);
490                 else
491                         node = __prom_getchild(node);
492
493                 if (__copy_to_user(argp, &node, sizeof(int)))
494                         return -EFAULT;
495
496                 return 0;
497
498         default:
499                 if (cnt++ < 10)
500                         printk(KERN_INFO "openprom_bsd_ioctl: cmd 0x%X\n", cmd);
501                 return -EINVAL;
502
503         }
504 }
505
506
507 /*
508  *      Handoff control to the correct ioctl handler.
509  */
510 static int openprom_ioctl(struct inode * inode, struct file * file,
511                           unsigned int cmd, unsigned long arg)
512 {
513         DATA *data = (DATA *) file->private_data;
514         static int cnt;
515
516         switch (cmd) {
517         case OPROMGETOPT:
518         case OPROMNXTOPT:
519                 if ((file->f_mode & FMODE_READ) == 0)
520                         return -EPERM;
521                 return openprom_sunos_ioctl(inode, file, cmd, arg,
522                                             options_node);
523
524         case OPROMSETOPT:
525         case OPROMSETOPT2:
526                 if ((file->f_mode & FMODE_WRITE) == 0)
527                         return -EPERM;
528                 return openprom_sunos_ioctl(inode, file, cmd, arg,
529                                             options_node);
530
531         case OPROMNEXT:
532         case OPROMCHILD:
533         case OPROMGETPROP:
534         case OPROMNXTPROP:
535                 if ((file->f_mode & FMODE_READ) == 0)
536                         return -EPERM;
537                 return openprom_sunos_ioctl(inode, file, cmd, arg,
538                                             data->current_node);
539
540         case OPROMU2P:
541         case OPROMGETCONS:
542         case OPROMGETFBNAME:
543         case OPROMGETBOOTARGS:
544         case OPROMSETCUR:
545         case OPROMPCI2NODE:
546         case OPROMPATH2NODE:
547                 if ((file->f_mode & FMODE_READ) == 0)
548                         return -EPERM;
549                 return openprom_sunos_ioctl(inode, file, cmd, arg, 0);
550
551         case OPIOCGET:
552         case OPIOCNEXTPROP:
553         case OPIOCGETOPTNODE:
554         case OPIOCGETNEXT:
555         case OPIOCGETCHILD:
556                 if ((file->f_mode & FMODE_READ) == 0)
557                         return -EBADF;
558                 return openprom_bsd_ioctl(inode,file,cmd,arg);
559
560         case OPIOCSET:
561                 if ((file->f_mode & FMODE_WRITE) == 0)
562                         return -EBADF;
563                 return openprom_bsd_ioctl(inode,file,cmd,arg);
564
565         default:
566                 if (cnt++ < 10)
567                         printk("openprom_ioctl: cmd 0x%X, arg 0x%lX\n", cmd, arg);
568                 return -EINVAL;
569         }
570 }
571
572 static long openprom_compat_ioctl(struct file *file, unsigned int cmd,
573                 unsigned long arg)
574 {
575         long rval = -ENOTTY;
576
577         /*
578          * SunOS/Solaris only, the NetBSD one's have embedded pointers in
579          * the arg which we'd need to clean up...
580          */
581         switch (cmd) {
582         case OPROMGETOPT:
583         case OPROMSETOPT:
584         case OPROMNXTOPT:
585         case OPROMSETOPT2:
586         case OPROMNEXT:
587         case OPROMCHILD:
588         case OPROMGETPROP:
589         case OPROMNXTPROP:
590         case OPROMU2P:
591         case OPROMGETCONS:
592         case OPROMGETFBNAME:
593         case OPROMGETBOOTARGS:
594         case OPROMSETCUR:
595         case OPROMPCI2NODE:
596         case OPROMPATH2NODE:
597                 lock_kernel();
598                 rval = openprom_ioctl(file->f_dentry->d_inode, file, cmd, arg);
599                 lock_kernel();
600                 break;
601         }
602
603         return rval;
604 }
605
606 static int openprom_open(struct inode * inode, struct file * file)
607 {
608         DATA *data;
609
610         data = (DATA *) kmalloc(sizeof(DATA), GFP_KERNEL);
611         if (!data)
612                 return -ENOMEM;
613
614         data->current_node = prom_root_node;
615         data->lastnode = prom_root_node;
616         file->private_data = (void *)data;
617
618         return 0;
619 }
620
621 static int openprom_release(struct inode * inode, struct file * file)
622 {
623         kfree(file->private_data);
624         return 0;
625 }
626
627 static struct file_operations openprom_fops = {
628         .owner =        THIS_MODULE,
629         .llseek =       no_llseek,
630         .ioctl =        openprom_ioctl,
631         .compat_ioctl = openprom_compat_ioctl,
632         .open =         openprom_open,
633         .release =      openprom_release,
634 };
635
636 static struct miscdevice openprom_dev = {
637         SUN_OPENPROM_MINOR, "openprom", &openprom_fops
638 };
639
640 static int __init openprom_init(void)
641 {
642         int error;
643
644         error = misc_register(&openprom_dev);
645         if (error) {
646                 printk(KERN_ERR "openprom: unable to get misc minor\n");
647                 return error;
648         }
649
650         options_node = prom_getchild(prom_root_node);
651         options_node = prom_searchsiblings(options_node,"options");
652
653         if (options_node == 0 || options_node == -1) {
654                 printk(KERN_ERR "openprom: unable to find options node\n");
655                 misc_deregister(&openprom_dev);
656                 return -EIO;
657         }
658
659         return 0;
660 }
661
662 static void __exit openprom_cleanup(void)
663 {
664         misc_deregister(&openprom_dev);
665 }
666
667 module_init(openprom_init);
668 module_exit(openprom_cleanup);
669 MODULE_LICENSE("GPL");