[PATCH] unhide ICH6 SMBus - take 2
[linux-2.6] / kernel / params.c
1 /* Helpers for initial module or kernel cmdline parsing
2    Copyright (C) 2001 Rusty Russell.
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 as published by
6     the Free Software Foundation; either version 2 of the License, or
7     (at your option) any later version.
8
9     This program is distributed in the hope that it will be useful,
10     but WITHOUT ANY WARRANTY; without even the implied warranty of
11     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12     GNU General Public License for more details.
13
14     You should have received a copy of the GNU General Public License
15     along with this program; if not, write to the Free Software
16     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
17 */
18 #include <linux/config.h>
19 #include <linux/moduleparam.h>
20 #include <linux/kernel.h>
21 #include <linux/string.h>
22 #include <linux/errno.h>
23 #include <linux/module.h>
24 #include <linux/device.h>
25 #include <linux/err.h>
26
27 #if 0
28 #define DEBUGP printk
29 #else
30 #define DEBUGP(fmt, a...)
31 #endif
32
33 static inline int dash2underscore(char c)
34 {
35         if (c == '-')
36                 return '_';
37         return c;
38 }
39
40 static inline int parameq(const char *input, const char *paramname)
41 {
42         unsigned int i;
43         for (i = 0; dash2underscore(input[i]) == paramname[i]; i++)
44                 if (input[i] == '\0')
45                         return 1;
46         return 0;
47 }
48
49 static int parse_one(char *param,
50                      char *val,
51                      struct kernel_param *params, 
52                      unsigned num_params,
53                      int (*handle_unknown)(char *param, char *val))
54 {
55         unsigned int i;
56
57         /* Find parameter */
58         for (i = 0; i < num_params; i++) {
59                 if (parameq(param, params[i].name)) {
60                         DEBUGP("They are equal!  Calling %p\n",
61                                params[i].set);
62                         return params[i].set(val, &params[i]);
63                 }
64         }
65
66         if (handle_unknown) {
67                 DEBUGP("Unknown argument: calling %p\n", handle_unknown);
68                 return handle_unknown(param, val);
69         }
70
71         DEBUGP("Unknown argument `%s'\n", param);
72         return -ENOENT;
73 }
74
75 /* You can use " around spaces, but can't escape ". */
76 /* Hyphens and underscores equivalent in parameter names. */
77 static char *next_arg(char *args, char **param, char **val)
78 {
79         unsigned int i, equals = 0;
80         int in_quote = 0, quoted = 0;
81         char *next;
82
83         if (*args == '"') {
84                 args++;
85                 in_quote = 1;
86                 quoted = 1;
87         }
88
89         for (i = 0; args[i]; i++) {
90                 if (args[i] == ' ' && !in_quote)
91                         break;
92                 if (equals == 0) {
93                         if (args[i] == '=')
94                                 equals = i;
95                 }
96                 if (args[i] == '"')
97                         in_quote = !in_quote;
98         }
99
100         *param = args;
101         if (!equals)
102                 *val = NULL;
103         else {
104                 args[equals] = '\0';
105                 *val = args + equals + 1;
106
107                 /* Don't include quotes in value. */
108                 if (**val == '"') {
109                         (*val)++;
110                         if (args[i-1] == '"')
111                                 args[i-1] = '\0';
112                 }
113                 if (quoted && args[i-1] == '"')
114                         args[i-1] = '\0';
115         }
116
117         if (args[i]) {
118                 args[i] = '\0';
119                 next = args + i + 1;
120         } else
121                 next = args + i;
122
123         /* Chew up trailing spaces. */
124         while (*next == ' ')
125                 next++;
126         return next;
127 }
128
129 /* Args looks like "foo=bar,bar2 baz=fuz wiz". */
130 int parse_args(const char *name,
131                char *args,
132                struct kernel_param *params,
133                unsigned num,
134                int (*unknown)(char *param, char *val))
135 {
136         char *param, *val;
137
138         DEBUGP("Parsing ARGS: %s\n", args);
139
140         /* Chew leading spaces */
141         while (*args == ' ')
142                 args++;
143
144         while (*args) {
145                 int ret;
146
147                 args = next_arg(args, &param, &val);
148                 ret = parse_one(param, val, params, num, unknown);
149                 switch (ret) {
150                 case -ENOENT:
151                         printk(KERN_ERR "%s: Unknown parameter `%s'\n",
152                                name, param);
153                         return ret;
154                 case -ENOSPC:
155                         printk(KERN_ERR
156                                "%s: `%s' too large for parameter `%s'\n",
157                                name, val ?: "", param);
158                         return ret;
159                 case 0:
160                         break;
161                 default:
162                         printk(KERN_ERR
163                                "%s: `%s' invalid for parameter `%s'\n",
164                                name, val ?: "", param);
165                         return ret;
166                 }
167         }
168
169         /* All parsed OK. */
170         return 0;
171 }
172
173 /* Lazy bastard, eh? */
174 #define STANDARD_PARAM_DEF(name, type, format, tmptype, strtolfn)       \
175         int param_set_##name(const char *val, struct kernel_param *kp)  \
176         {                                                               \
177                 char *endp;                                             \
178                 tmptype l;                                              \
179                                                                         \
180                 if (!val) return -EINVAL;                               \
181                 l = strtolfn(val, &endp, 0);                            \
182                 if (endp == val || ((type)l != l))                      \
183                         return -EINVAL;                                 \
184                 *((type *)kp->arg) = l;                                 \
185                 return 0;                                               \
186         }                                                               \
187         int param_get_##name(char *buffer, struct kernel_param *kp)     \
188         {                                                               \
189                 return sprintf(buffer, format, *((type *)kp->arg));     \
190         }
191
192 STANDARD_PARAM_DEF(byte, unsigned char, "%c", unsigned long, simple_strtoul);
193 STANDARD_PARAM_DEF(short, short, "%hi", long, simple_strtol);
194 STANDARD_PARAM_DEF(ushort, unsigned short, "%hu", unsigned long, simple_strtoul);
195 STANDARD_PARAM_DEF(int, int, "%i", long, simple_strtol);
196 STANDARD_PARAM_DEF(uint, unsigned int, "%u", unsigned long, simple_strtoul);
197 STANDARD_PARAM_DEF(long, long, "%li", long, simple_strtol);
198 STANDARD_PARAM_DEF(ulong, unsigned long, "%lu", unsigned long, simple_strtoul);
199
200 int param_set_charp(const char *val, struct kernel_param *kp)
201 {
202         if (!val) {
203                 printk(KERN_ERR "%s: string parameter expected\n",
204                        kp->name);
205                 return -EINVAL;
206         }
207
208         if (strlen(val) > 1024) {
209                 printk(KERN_ERR "%s: string parameter too long\n",
210                        kp->name);
211                 return -ENOSPC;
212         }
213
214         *(char **)kp->arg = (char *)val;
215         return 0;
216 }
217
218 int param_get_charp(char *buffer, struct kernel_param *kp)
219 {
220         return sprintf(buffer, "%s", *((char **)kp->arg));
221 }
222
223 int param_set_bool(const char *val, struct kernel_param *kp)
224 {
225         /* No equals means "set"... */
226         if (!val) val = "1";
227
228         /* One of =[yYnN01] */
229         switch (val[0]) {
230         case 'y': case 'Y': case '1':
231                 *(int *)kp->arg = 1;
232                 return 0;
233         case 'n': case 'N': case '0':
234                 *(int *)kp->arg = 0;
235                 return 0;
236         }
237         return -EINVAL;
238 }
239
240 int param_get_bool(char *buffer, struct kernel_param *kp)
241 {
242         /* Y and N chosen as being relatively non-coder friendly */
243         return sprintf(buffer, "%c", (*(int *)kp->arg) ? 'Y' : 'N');
244 }
245
246 int param_set_invbool(const char *val, struct kernel_param *kp)
247 {
248         int boolval, ret;
249         struct kernel_param dummy = { .arg = &boolval };
250
251         ret = param_set_bool(val, &dummy);
252         if (ret == 0)
253                 *(int *)kp->arg = !boolval;
254         return ret;
255 }
256
257 int param_get_invbool(char *buffer, struct kernel_param *kp)
258 {
259         int val;
260         struct kernel_param dummy = { .arg = &val };
261
262         val = !*(int *)kp->arg;
263         return param_get_bool(buffer, &dummy);
264 }
265
266 /* We cheat here and temporarily mangle the string. */
267 int param_array(const char *name,
268                 const char *val,
269                 unsigned int min, unsigned int max,
270                 void *elem, int elemsize,
271                 int (*set)(const char *, struct kernel_param *kp),
272                 int *num)
273 {
274         int ret;
275         struct kernel_param kp;
276         char save;
277
278         /* Get the name right for errors. */
279         kp.name = name;
280         kp.arg = elem;
281
282         /* No equals sign? */
283         if (!val) {
284                 printk(KERN_ERR "%s: expects arguments\n", name);
285                 return -EINVAL;
286         }
287
288         *num = 0;
289         /* We expect a comma-separated list of values. */
290         do {
291                 int len;
292
293                 if (*num == max) {
294                         printk(KERN_ERR "%s: can only take %i arguments\n",
295                                name, max);
296                         return -EINVAL;
297                 }
298                 len = strcspn(val, ",");
299
300                 /* nul-terminate and parse */
301                 save = val[len];
302                 ((char *)val)[len] = '\0';
303                 ret = set(val, &kp);
304
305                 if (ret != 0)
306                         return ret;
307                 kp.arg += elemsize;
308                 val += len+1;
309                 (*num)++;
310         } while (save == ',');
311
312         if (*num < min) {
313                 printk(KERN_ERR "%s: needs at least %i arguments\n",
314                        name, min);
315                 return -EINVAL;
316         }
317         return 0;
318 }
319
320 int param_array_set(const char *val, struct kernel_param *kp)
321 {
322         struct kparam_array *arr = kp->arg;
323         unsigned int temp_num;
324
325         return param_array(kp->name, val, 1, arr->max, arr->elem,
326                            arr->elemsize, arr->set, arr->num ?: &temp_num);
327 }
328
329 int param_array_get(char *buffer, struct kernel_param *kp)
330 {
331         int i, off, ret;
332         struct kparam_array *arr = kp->arg;
333         struct kernel_param p;
334
335         p = *kp;
336         for (i = off = 0; i < (arr->num ? *arr->num : arr->max); i++) {
337                 if (i)
338                         buffer[off++] = ',';
339                 p.arg = arr->elem + arr->elemsize * i;
340                 ret = arr->get(buffer + off, &p);
341                 if (ret < 0)
342                         return ret;
343                 off += ret;
344         }
345         buffer[off] = '\0';
346         return off;
347 }
348
349 int param_set_copystring(const char *val, struct kernel_param *kp)
350 {
351         struct kparam_string *kps = kp->arg;
352
353         if (strlen(val)+1 > kps->maxlen) {
354                 printk(KERN_ERR "%s: string doesn't fit in %u chars.\n",
355                        kp->name, kps->maxlen-1);
356                 return -ENOSPC;
357         }
358         strcpy(kps->string, val);
359         return 0;
360 }
361
362 int param_get_string(char *buffer, struct kernel_param *kp)
363 {
364         struct kparam_string *kps = kp->arg;
365         return strlcpy(buffer, kps->string, kps->maxlen);
366 }
367
368 /* sysfs output in /sys/modules/XYZ/parameters/ */
369
370 extern struct kernel_param __start___param[], __stop___param[];
371
372 #define MAX_KBUILD_MODNAME KOBJ_NAME_LEN
373
374 struct param_attribute
375 {
376         struct module_attribute mattr;
377         struct kernel_param *param;
378 };
379
380 struct module_param_attrs
381 {
382         struct attribute_group grp;
383         struct param_attribute attrs[0];
384 };
385
386 #define to_param_attr(n) container_of(n, struct param_attribute, mattr);
387
388 static ssize_t param_attr_show(struct module_attribute *mattr,
389                                struct module *mod, char *buf)
390 {
391         int count;
392         struct param_attribute *attribute = to_param_attr(mattr);
393
394         if (!attribute->param->get)
395                 return -EPERM;
396
397         count = attribute->param->get(buf, attribute->param);
398         if (count > 0) {
399                 strcat(buf, "\n");
400                 ++count;
401         }
402         return count;
403 }
404
405 /* sysfs always hands a nul-terminated string in buf.  We rely on that. */
406 static ssize_t param_attr_store(struct module_attribute *mattr,
407                                 struct module *owner,
408                                 const char *buf, size_t len)
409 {
410         int err;
411         struct param_attribute *attribute = to_param_attr(mattr);
412
413         if (!attribute->param->set)
414                 return -EPERM;
415
416         err = attribute->param->set(buf, attribute->param);
417         if (!err)
418                 return len;
419         return err;
420 }
421
422 #ifdef CONFIG_MODULES
423 #define __modinit
424 #else
425 #define __modinit __init
426 #endif
427
428 /*
429  * param_sysfs_setup - setup sysfs support for one module or KBUILD_MODNAME
430  * @mk: struct module_kobject (contains parent kobject)
431  * @kparam: array of struct kernel_param, the actual parameter definitions
432  * @num_params: number of entries in array
433  * @name_skip: offset where the parameter name start in kparam[].name. Needed for built-in "modules"
434  *
435  * Create a kobject for a (per-module) group of parameters, and create files
436  * in sysfs. A pointer to the param_kobject is returned on success,
437  * NULL if there's no parameter to export, or other ERR_PTR(err).
438  */
439 static __modinit struct module_param_attrs *
440 param_sysfs_setup(struct module_kobject *mk,
441                   struct kernel_param *kparam,
442                   unsigned int num_params,
443                   unsigned int name_skip)
444 {
445         struct module_param_attrs *mp;
446         unsigned int valid_attrs = 0;
447         unsigned int i, size[2];
448         struct param_attribute *pattr;
449         struct attribute **gattr;
450         int err;
451
452         for (i=0; i<num_params; i++) {
453                 if (kparam[i].perm)
454                         valid_attrs++;
455         }
456
457         if (!valid_attrs)
458                 return NULL;
459
460         size[0] = ALIGN(sizeof(*mp) +
461                         valid_attrs * sizeof(mp->attrs[0]),
462                         sizeof(mp->grp.attrs[0]));
463         size[1] = (valid_attrs + 1) * sizeof(mp->grp.attrs[0]);
464
465         mp = kmalloc(size[0] + size[1], GFP_KERNEL);
466         if (!mp)
467                 return ERR_PTR(-ENOMEM);
468
469         mp->grp.name = "parameters";
470         mp->grp.attrs = (void *)mp + size[0];
471
472         pattr = &mp->attrs[0];
473         gattr = &mp->grp.attrs[0];
474         for (i = 0; i < num_params; i++) {
475                 struct kernel_param *kp = &kparam[i];
476                 if (kp->perm) {
477                         pattr->param = kp;
478                         pattr->mattr.show = param_attr_show;
479                         pattr->mattr.store = param_attr_store;
480                         pattr->mattr.attr.name = (char *)&kp->name[name_skip];
481                         pattr->mattr.attr.owner = mk->mod;
482                         pattr->mattr.attr.mode = kp->perm;
483                         *(gattr++) = &(pattr++)->mattr.attr;
484                 }
485         }
486         *gattr = NULL;
487
488         if ((err = sysfs_create_group(&mk->kobj, &mp->grp))) {
489                 kfree(mp);
490                 return ERR_PTR(err);
491         }
492         return mp;
493 }
494
495
496 #ifdef CONFIG_MODULES
497
498 /*
499  * module_param_sysfs_setup - setup sysfs support for one module
500  * @mod: module
501  * @kparam: module parameters (array)
502  * @num_params: number of module parameters
503  *
504  * Adds sysfs entries for module parameters, and creates a link from
505  * /sys/module/[mod->name]/parameters to /sys/parameters/[mod->name]/
506  */
507 int module_param_sysfs_setup(struct module *mod,
508                              struct kernel_param *kparam,
509                              unsigned int num_params)
510 {
511         struct module_param_attrs *mp;
512
513         mp = param_sysfs_setup(&mod->mkobj, kparam, num_params, 0);
514         if (IS_ERR(mp))
515                 return PTR_ERR(mp);
516
517         mod->param_attrs = mp;
518         return 0;
519 }
520
521 /*
522  * module_param_sysfs_remove - remove sysfs support for one module
523  * @mod: module
524  *
525  * Remove sysfs entries for module parameters and the corresponding
526  * kobject.
527  */
528 void module_param_sysfs_remove(struct module *mod)
529 {
530         if (mod->param_attrs) {
531                 sysfs_remove_group(&mod->mkobj.kobj,
532                                    &mod->param_attrs->grp);
533                 /* We are positive that no one is using any param
534                  * attrs at this point.  Deallocate immediately. */
535                 kfree(mod->param_attrs);
536                 mod->param_attrs = NULL;
537         }
538 }
539 #endif
540
541 /*
542  * kernel_param_sysfs_setup - wrapper for built-in params support
543  */
544 static void __init kernel_param_sysfs_setup(const char *name,
545                                             struct kernel_param *kparam,
546                                             unsigned int num_params,
547                                             unsigned int name_skip)
548 {
549         struct module_kobject *mk;
550
551         mk = kzalloc(sizeof(struct module_kobject), GFP_KERNEL);
552         BUG_ON(!mk);
553
554         mk->mod = THIS_MODULE;
555         kobj_set_kset_s(mk, module_subsys);
556         kobject_set_name(&mk->kobj, name);
557         kobject_register(&mk->kobj);
558
559         /* no need to keep the kobject if no parameter is exported */
560         if (!param_sysfs_setup(mk, kparam, num_params, name_skip)) {
561                 kobject_unregister(&mk->kobj);
562                 kfree(mk);
563         }
564 }
565
566 /*
567  * param_sysfs_builtin - add contents in /sys/parameters for built-in modules
568  *
569  * Add module_parameters to sysfs for "modules" built into the kernel.
570  *
571  * The "module" name (KBUILD_MODNAME) is stored before a dot, the
572  * "parameter" name is stored behind a dot in kernel_param->name. So,
573  * extract the "module" name for all built-in kernel_param-eters,
574  * and for all who have the same, call kernel_param_sysfs_setup.
575  */
576 static void __init param_sysfs_builtin(void)
577 {
578         struct kernel_param *kp, *kp_begin = NULL;
579         unsigned int i, name_len, count = 0;
580         char modname[MAX_KBUILD_MODNAME + 1] = "";
581
582         for (i=0; i < __stop___param - __start___param; i++) {
583                 char *dot;
584
585                 kp = &__start___param[i];
586
587                 /* We do not handle args without periods. */
588                 dot = memchr(kp->name, '.', MAX_KBUILD_MODNAME);
589                 if (!dot) {
590                         DEBUGP("couldn't find period in %s\n", kp->name);
591                         continue;
592                 }
593                 name_len = dot - kp->name;
594
595                 /* new kbuild_modname? */
596                 if (strlen(modname) != name_len
597                     || strncmp(modname, kp->name, name_len) != 0) {
598                         /* add a new kobject for previous kernel_params. */
599                         if (count)
600                                 kernel_param_sysfs_setup(modname,
601                                                          kp_begin,
602                                                          count,
603                                                          strlen(modname)+1);
604
605                         strncpy(modname, kp->name, name_len);
606                         modname[name_len] = '\0';
607                         count = 0;
608                         kp_begin = kp;
609                 }
610                 count++;
611         }
612
613         /* last kernel_params need to be registered as well */
614         if (count)
615                 kernel_param_sysfs_setup(modname, kp_begin, count,
616                                          strlen(modname)+1);
617 }
618
619
620 /* module-related sysfs stuff */
621 #ifdef CONFIG_MODULES
622
623 #define to_module_attr(n) container_of(n, struct module_attribute, attr);
624 #define to_module_kobject(n) container_of(n, struct module_kobject, kobj);
625
626 static ssize_t module_attr_show(struct kobject *kobj,
627                                 struct attribute *attr,
628                                 char *buf)
629 {
630         struct module_attribute *attribute;
631         struct module_kobject *mk;
632         int ret;
633
634         attribute = to_module_attr(attr);
635         mk = to_module_kobject(kobj);
636
637         if (!attribute->show)
638                 return -EIO;
639
640         if (!try_module_get(mk->mod))
641                 return -ENODEV;
642
643         ret = attribute->show(attribute, mk->mod, buf);
644
645         module_put(mk->mod);
646
647         return ret;
648 }
649
650 static ssize_t module_attr_store(struct kobject *kobj,
651                                 struct attribute *attr,
652                                 const char *buf, size_t len)
653 {
654         struct module_attribute *attribute;
655         struct module_kobject *mk;
656         int ret;
657
658         attribute = to_module_attr(attr);
659         mk = to_module_kobject(kobj);
660
661         if (!attribute->store)
662                 return -EIO;
663
664         if (!try_module_get(mk->mod))
665                 return -ENODEV;
666
667         ret = attribute->store(attribute, mk->mod, buf, len);
668
669         module_put(mk->mod);
670
671         return ret;
672 }
673
674 static struct sysfs_ops module_sysfs_ops = {
675         .show = module_attr_show,
676         .store = module_attr_store,
677 };
678
679 #else
680 static struct sysfs_ops module_sysfs_ops = {
681         .show = NULL,
682         .store = NULL,
683 };
684 #endif
685
686 static struct kobj_type module_ktype = {
687         .sysfs_ops =    &module_sysfs_ops,
688 };
689
690 decl_subsys(module, &module_ktype, NULL);
691
692 /*
693  * param_sysfs_init - wrapper for built-in params support
694  */
695 static int __init param_sysfs_init(void)
696 {
697         subsystem_register(&module_subsys);
698
699         param_sysfs_builtin();
700
701         return 0;
702 }
703 __initcall(param_sysfs_init);
704
705 EXPORT_SYMBOL(param_set_byte);
706 EXPORT_SYMBOL(param_get_byte);
707 EXPORT_SYMBOL(param_set_short);
708 EXPORT_SYMBOL(param_get_short);
709 EXPORT_SYMBOL(param_set_ushort);
710 EXPORT_SYMBOL(param_get_ushort);
711 EXPORT_SYMBOL(param_set_int);
712 EXPORT_SYMBOL(param_get_int);
713 EXPORT_SYMBOL(param_set_uint);
714 EXPORT_SYMBOL(param_get_uint);
715 EXPORT_SYMBOL(param_set_long);
716 EXPORT_SYMBOL(param_get_long);
717 EXPORT_SYMBOL(param_set_ulong);
718 EXPORT_SYMBOL(param_get_ulong);
719 EXPORT_SYMBOL(param_set_charp);
720 EXPORT_SYMBOL(param_get_charp);
721 EXPORT_SYMBOL(param_set_bool);
722 EXPORT_SYMBOL(param_get_bool);
723 EXPORT_SYMBOL(param_set_invbool);
724 EXPORT_SYMBOL(param_get_invbool);
725 EXPORT_SYMBOL(param_array_set);
726 EXPORT_SYMBOL(param_array_get);
727 EXPORT_SYMBOL(param_set_copystring);
728 EXPORT_SYMBOL(param_get_string);