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/moduleparam.h>
  19 #include <linux/kernel.h>
  20 #include <linux/string.h>
  21 #include <linux/errno.h>
  22 #include <linux/module.h>
  23 #include <linux/device.h>
  24 #include <linux/err.h>
  25 #include <linux/slab.h>
  26 #include <linux/ctype.h>
  27
  28 #if 0
  29 #define DEBUGP printk
  30 #else
  31 #define DEBUGP(fmt, a...)
  32 #endif
  33
  34 /* Protects all parameters, and incidentally kmalloced_param list. */
  35 static DEFINE_MUTEX(param_lock);
  36
  37 /* This just allows us to keep track of which parameters are kmalloced. */
  38 struct kmalloced_param {
  39         struct list_head list;
  40         char val[];
  41 };
  42 static LIST_HEAD(kmalloced_params);
  43
  44 static void *kmalloc_parameter(unsigned int size)
  45 {
  46         struct kmalloced_param *p;
  47
  48         p = kmalloc(sizeof(*p) + size, GFP_KERNEL);
  49         if (!p)
  50                 return NULL;
  51
  52         list_add(&p->list, &kmalloced_params);
  53         return p->val;
  54 }
  55
  56 /* Does nothing if parameter wasn't kmalloced above. */
  57 static void maybe_kfree_parameter(void *param)
  58 {
  59         struct kmalloced_param *p;
  60
  61         list_for_each_entry(p, &kmalloced_params, list) {
  62                 if (p->val == param) {
  63                         list_del(&p->list);
  64                         kfree(p);
  65                         break;
  66                 }
  67         }
  68 }
  69
  70 static inline char dash2underscore(char c)
  71 {
  72         if (c == '-')
  73                 return '_';
  74         return c;
  75 }
  76
  77 static inline int parameq(const char *input, const char *paramname)
  78 {
  79         unsigned int i;
  80         for (i = 0; dash2underscore(input[i]) == paramname[i]; i++)
  81                 if (input[i] == '\0')
  82                         return 1;
  83         return 0;
  84 }
  85
  86 static int parse_one(char *param,
  87                      char *val,
  88                      const struct kernel_param *params,
  89                      unsigned num_params,
  90                      int (*handle_arg)(char *param, char *val, int known))
  91 {
  92         unsigned int i;
  93         int err;
  94
  95         /* Find parameter */
  96         for (i = 0; i < num_params; i++) {
  97                 if (parameq(param, params[i].name)) {
  98                         /* Noone handled NULL, so do it here. */
  99                         if (!val && params[i].ops->set != param_set_bool)
 100                                 return -EINVAL;
 101                         if (handle_arg) {
 102                                 int ret;
 103                                 DEBUGP("Valid argument: calling %p\n",
 104                                        handle_arg);
 105                                 ret = handle_arg(param, val, 1);
 106                                 if (ret)
 107                                         return ret;
 108                         }
 109                         DEBUGP("They are equal!  Calling %p\n",
 110                                params[i].ops->set);
 111                         mutex_lock(&param_lock);
 112                         err = params[i].ops->set(val, &params[i]);
 113                         mutex_unlock(&param_lock);
 114                         return err;
 115                 }
 116         }
 117
 118         if (handle_arg) {
 119                 DEBUGP("Unknown argument: calling %p\n", handle_arg);
 120                 return handle_arg(param, val, 0);
 121         }
 122
 123         DEBUGP("Unknown argument `%s'\n", param);
 124         return -ENOENT;
 125 }
 126
 127 /* You can use " around spaces, but can't escape ". */
 128 /* Hyphens and underscores equivalent in parameter names. */
 129 static char *next_arg(char *args, char **param, char **val)
 130 {
 131         unsigned int i, equals = 0;
 132         int in_quote = 0, quoted = 0;
 133         char *next;
 134
 135         if (*args == '"') {
 136                 args++;
 137                 in_quote = 1;
 138                 quoted = 1;
 139         }
 140
 141         for (i = 0; args[i]; i++) {
 142                 if (isspace(args[i]) && !in_quote)
 143                         break;
 144                 if (equals == 0) {
 145                         if (args[i] == '=')
 146                                 equals = i;
 147                 }
 148                 if (args[i] == '"')
 149                         in_quote = !in_quote;
 150         }
 151
 152         *param = args;
 153         if (!equals)
 154                 *val = NULL;
 155         else {
 156                 args[equals] = '\0';
 157                 *val = args + equals + 1;
 158
 159                 /* Don't include quotes in value. */
 160                 if (**val == '"') {
 161                         (*val)++;
 162                         if (args[i-1] == '"')
 163                                 args[i-1] = '\0';
 164                 }
 165                 if (quoted && args[i-1] == '"')
 166                         args[i-1] = '\0';
 167         }
 168
 169         if (args[i]) {
 170                 args[i] = '\0';
 171                 next = args + i + 1;
 172         } else
 173                 next = args + i;
 174
 175         /* Chew up trailing spaces. */
 176         return skip_spaces(next);
 177 }
 178
 179 /* Args looks like "foo=bar,bar2 baz=fuz wiz". */
 180 int parse_args(const char *name,
 181                char *args,
 182                const struct kernel_param *params,
 183                unsigned num,
 184                int (*handle_arg)(char *param, char *val, int arg))
 185 {
 186         char *param, *val;
 187
 188         DEBUGP("Parsing ARGS: %s\n", args);
 189
 190         /* Chew leading spaces */
 191         args = skip_spaces(args);
 192
 193         while (*args) {
 194                 int ret;
 195                 int irq_was_disabled;
 196
 197                 args = next_arg(args, &param, &val);
 198                 irq_was_disabled = irqs_disabled();
 199                 ret = parse_one(param, val, params, num, handle_arg);
 200                 if (irq_was_disabled && !irqs_disabled()) {
 201                         printk(KERN_WARNING "parse_args(): option '%s' enabled "
 202                                         "irq's!\n", param);
 203                 }
 204                 switch (ret) {
 205                 case -ENOENT:
 206                         printk(KERN_ERR "%s: Unknown parameter `%s'\n",
 207                                name, param);
 208                         return ret;
 209                 case -ENOSPC:
 210                         printk(KERN_ERR
 211                                "%s: `%s' too large for parameter `%s'\n",
 212                                name, val ?: "", param);
 213                         return ret;
 214                 case 0:
 215                         break;
 216                 default:
 217                         printk(KERN_ERR
 218                                "%s: `%s' invalid for parameter `%s'\n",
 219                                name, val ?: "", param);
 220                         return ret;
 221                 }
 222         }
 223
 224         /* All parsed OK. */
 225         return 0;
 226 }
 227
 228 /* Lazy bastard, eh? */
 229 #define STANDARD_PARAM_DEF(name, type, format, tmptype, strtolfn)       \
 230         int param_set_##name(const char *val, const struct kernel_param *kp) \
 231         {                                                               \
 232                 tmptype l;                                              \
 233                 int ret;                                                \
 234                                                                         \
 235                 ret = strtolfn(val, 0, &l);                             \
 236                 if (ret == -EINVAL || ((type)l != l))                   \
 237                         return -EINVAL;                                 \
 238                 *((type *)kp->arg) = l;                                 \
 239                 return 0;                                               \
 240         }                                                               \
 241         int param_get_##name(char *buffer, const struct kernel_param *kp) \
 242         {                                                               \
 243                 return sprintf(buffer, format, *((type *)kp->arg));     \
 244         }                                                               \
 245         struct kernel_param_ops param_ops_##name = {                    \
 246                 .set = param_set_##name,                                \
 247                 .get = param_get_##name,                                \
 248         };                                                              \
 249         EXPORT_SYMBOL(param_set_##name);                                \
 250         EXPORT_SYMBOL(param_get_##name);                                \
 251         EXPORT_SYMBOL(param_ops_##name)
 252
 253
 254 STANDARD_PARAM_DEF(byte, unsigned char, "%c", unsigned long, strict_strtoul);
 255 STANDARD_PARAM_DEF(short, short, "%hi", long, strict_strtol);
 256 STANDARD_PARAM_DEF(ushort, unsigned short, "%hu", unsigned long, strict_strtoul);
 257 STANDARD_PARAM_DEF(int, int, "%i", long, strict_strtol);
 258 STANDARD_PARAM_DEF(uint, unsigned int, "%u", unsigned long, strict_strtoul);
 259 STANDARD_PARAM_DEF(long, long, "%li", long, strict_strtol);
 260 STANDARD_PARAM_DEF(ulong, unsigned long, "%lu", unsigned long, strict_strtoul);
 261
 262 int param_set_charp(const char *val, const struct kernel_param *kp)
 263 {
 264         if (strlen(val) > 1024) {
 265                 printk(KERN_ERR "%s: string parameter too long\n",
 266                        kp->name);
 267                 return -ENOSPC;
 268         }
 269
 270         maybe_kfree_parameter(*(char **)kp->arg);
 271
 272         /* This is a hack.  We can't kmalloc in early boot, and we
 273          * don't need to; this mangled commandline is preserved. */
 274         if (slab_is_available()) {
 275                 *(char **)kp->arg = kmalloc_parameter(strlen(val)+1);
 276                 if (!*(char **)kp->arg)
 277                         return -ENOMEM;
 278                 strcpy(*(char **)kp->arg, val);
 279         } else
 280                 *(const char **)kp->arg = val;
 281
 282         return 0;
 283 }
 284 EXPORT_SYMBOL(param_set_charp);
 285
 286 int param_get_charp(char *buffer, const struct kernel_param *kp)
 287 {
 288         return sprintf(buffer, "%s", *((char **)kp->arg));
 289 }
 290 EXPORT_SYMBOL(param_get_charp);
 291
 292 static void param_free_charp(void *arg)
 293 {
 294         maybe_kfree_parameter(*((char **)arg));
 295 }
 296
 297 struct kernel_param_ops param_ops_charp = {
 298         .set = param_set_charp,
 299         .get = param_get_charp,
 300         .free = param_free_charp,
 301 };
 302 EXPORT_SYMBOL(param_ops_charp);
 303
 304 /* Actually could be a bool or an int, for historical reasons. */
 305 int param_set_bool(const char *val, const struct kernel_param *kp)
 306 {
 307         bool v;
 308
 309         /* No equals means "set"... */
 310         if (!val) val = "1";
 311
 312         /* One of =[yYnN01] */
 313         switch (val[0]) {
 314         case 'y': case 'Y': case '1':
 315                 v = true;
 316                 break;
 317         case 'n': case 'N': case '0':
 318                 v = false;
 319                 break;
 320         default:
 321                 return -EINVAL;
 322         }
 323
 324         if (kp->flags & KPARAM_ISBOOL)
 325                 *(bool *)kp->arg = v;
 326         else
 327                 *(int *)kp->arg = v;
 328         return 0;
 329 }
 330 EXPORT_SYMBOL(param_set_bool);
 331
 332 int param_get_bool(char *buffer, const struct kernel_param *kp)
 333 {
 334         bool val;
 335         if (kp->flags & KPARAM_ISBOOL)
 336                 val = *(bool *)kp->arg;
 337         else
 338                 val = *(int *)kp->arg;
 339
 340         /* Y and N chosen as being relatively non-coder friendly */
 341         return sprintf(buffer, "%c", val ? 'Y' : 'N');
 342 }
 343 EXPORT_SYMBOL(param_get_bool);
 344
 345 struct kernel_param_ops param_ops_bool = {
 346         .set = param_set_bool,
 347         .get = param_get_bool,
 348 };
 349 EXPORT_SYMBOL(param_ops_bool);
 350
 351 /* This one must be bool. */
 352 int param_set_invbool(const char *val, const struct kernel_param *kp)
 353 {
 354         int ret;
 355         bool boolval;
 356         struct kernel_param dummy;
 357
 358         dummy.arg = &boolval;
 359         dummy.flags = KPARAM_ISBOOL;
 360         ret = param_set_bool(val, &dummy);
 361         if (ret == 0)
 362                 *(bool *)kp->arg = !boolval;
 363         return ret;
 364 }
 365 EXPORT_SYMBOL(param_set_invbool);
 366
 367 int param_get_invbool(char *buffer, const struct kernel_param *kp)
 368 {
 369         return sprintf(buffer, "%c", (*(bool *)kp->arg) ? 'N' : 'Y');
 370 }
 371 EXPORT_SYMBOL(param_get_invbool);
 372
 373 struct kernel_param_ops param_ops_invbool = {
 374         .set = param_set_invbool,
 375         .get = param_get_invbool,
 376 };
 377 EXPORT_SYMBOL(param_ops_invbool);
 378
 379 /* We break the rule and mangle the string. */
 380 static int param_array(const char *name,
 381                        const char *val,
 382                        unsigned int min, unsigned int max,
 383                        void *elem, int elemsize,
 384                        int (*set)(const char *, const struct kernel_param *kp),
 385                        u16 flags,
 386                        unsigned int *num)
 387 {
 388         int ret;
 389         struct kernel_param kp;
 390         char save;
 391
 392         /* Get the name right for errors. */
 393         kp.name = name;
 394         kp.arg = elem;
 395         kp.flags = flags;
 396
 397         *num = 0;
 398         /* We expect a comma-separated list of values. */
 399         do {
 400                 int len;
 401
 402                 if (*num == max) {
 403                         printk(KERN_ERR "%s: can only take %i arguments\n",
 404                                name, max);
 405                         return -EINVAL;
 406                 }
 407                 len = strcspn(val, ",");
 408
 409                 /* nul-terminate and parse */
 410                 save = val[len];
 411                 ((char *)val)[len] = '\0';
 412                 BUG_ON(!mutex_is_locked(&param_lock));
 413                 ret = set(val, &kp);
 414
 415                 if (ret != 0)
 416                         return ret;
 417                 kp.arg += elemsize;
 418                 val += len+1;
 419                 (*num)++;
 420         } while (save == ',');
 421
 422         if (*num < min) {
 423                 printk(KERN_ERR "%s: needs at least %i arguments\n",
 424                        name, min);
 425                 return -EINVAL;
 426         }
 427         return 0;
 428 }
 429
 430 static int param_array_set(const char *val, const struct kernel_param *kp)
 431 {
 432         const struct kparam_array *arr = kp->arr;
 433         unsigned int temp_num;
 434
 435         return param_array(kp->name, val, 1, arr->max, arr->elem,
 436                            arr->elemsize, arr->ops->set, kp->flags,
 437                            arr->num ?: &temp_num);
 438 }
 439
 440 static int param_array_get(char *buffer, const struct kernel_param *kp)
 441 {
 442         int i, off, ret;
 443         const struct kparam_array *arr = kp->arr;
 444         struct kernel_param p;
 445
 446         p = *kp;
 447         for (i = off = 0; i < (arr->num ? *arr->num : arr->max); i++) {
 448                 if (i)
 449                         buffer[off++] = ',';
 450                 p.arg = arr->elem + arr->elemsize * i;
 451                 BUG_ON(!mutex_is_locked(&param_lock));
 452                 ret = arr->ops->get(buffer + off, &p);
 453                 if (ret < 0)
 454                         return ret;
 455                 off += ret;
 456         }
 457         buffer[off] = '\0';
 458         return off;
 459 }
 460
 461 static void param_array_free(void *arg)
 462 {
 463         unsigned int i;
 464         const struct kparam_array *arr = arg;
 465
 466         if (arr->ops->free)
 467                 for (i = 0; i < (arr->num ? *arr->num : arr->max); i++)
 468                         arr->ops->free(arr->elem + arr->elemsize * i);
 469 }
 470
 471 struct kernel_param_ops param_array_ops = {
 472         .set = param_array_set,
 473         .get = param_array_get,
 474         .free = param_array_free,
 475 };
 476 EXPORT_SYMBOL(param_array_ops);
 477
 478 int param_set_copystring(const char *val, const struct kernel_param *kp)
 479 {
 480         const struct kparam_string *kps = kp->str;
 481
 482         if (strlen(val)+1 > kps->maxlen) {
 483                 printk(KERN_ERR "%s: string doesn't fit in %u chars.\n",
 484                        kp->name, kps->maxlen-1);
 485                 return -ENOSPC;
 486         }
 487         strcpy(kps->string, val);
 488         return 0;
 489 }
 490 EXPORT_SYMBOL(param_set_copystring);
 491
 492 int param_get_string(char *buffer, const struct kernel_param *kp)
 493 {
 494         const struct kparam_string *kps = kp->str;
 495         return strlcpy(buffer, kps->string, kps->maxlen);
 496 }
 497 EXPORT_SYMBOL(param_get_string);
 498
 499 struct kernel_param_ops param_ops_string = {
 500         .set = param_set_copystring,
 501         .get = param_get_string,
 502 };
 503 EXPORT_SYMBOL(param_ops_string);
 504
 505 /* sysfs output in /sys/modules/XYZ/parameters/ */
 506 #define to_module_attr(n) container_of(n, struct module_attribute, attr)
 507 #define to_module_kobject(n) container_of(n, struct module_kobject, kobj)
 508
 509 extern struct kernel_param __start___param[], __stop___param[];
 510
 511 struct param_attribute
 512 {
 513         struct module_attribute mattr;
 514         const struct kernel_param *param;
 515 };
 516
 517 struct module_param_attrs
 518 {
 519         unsigned int num;
 520         struct attribute_group grp;
 521         struct param_attribute attrs[0];
 522 };
 523
 524 #ifdef CONFIG_SYSFS
 525 #define to_param_attr(n) container_of(n, struct param_attribute, mattr)
 526
 527 static ssize_t param_attr_show(struct module_attribute *mattr,
 528                                struct module *mod, char *buf)
 529 {
 530         int count;
 531         struct param_attribute *attribute = to_param_attr(mattr);
 532
 533         if (!attribute->param->ops->get)
 534                 return -EPERM;
 535
 536         mutex_lock(&param_lock);
 537         count = attribute->param->ops->get(buf, attribute->param);
 538         mutex_unlock(&param_lock);
 539         if (count > 0) {
 540                 strcat(buf, "\n");
 541                 ++count;
 542         }
 543         return count;
 544 }
 545
 546 /* sysfs always hands a nul-terminated string in buf.  We rely on that. */
 547 static ssize_t param_attr_store(struct module_attribute *mattr,
 548                                 struct module *owner,
 549                                 const char *buf, size_t len)
 550 {
 551         int err;
 552         struct param_attribute *attribute = to_param_attr(mattr);
 553
 554         if (!attribute->param->ops->set)
 555                 return -EPERM;
 556
 557         mutex_lock(&param_lock);
 558         err = attribute->param->ops->set(buf, attribute->param);
 559         mutex_unlock(&param_lock);
 560         if (!err)
 561                 return len;
 562         return err;
 563 }
 564 #endif
 565
 566 #ifdef CONFIG_MODULES
 567 #define __modinit
 568 #else
 569 #define __modinit __init
 570 #endif
 571
 572 #ifdef CONFIG_SYSFS
 573 void __kernel_param_lock(void)
 574 {
 575         mutex_lock(&param_lock);
 576 }
 577 EXPORT_SYMBOL(__kernel_param_lock);
 578
 579 void __kernel_param_unlock(void)
 580 {
 581         mutex_unlock(&param_lock);
 582 }
 583 EXPORT_SYMBOL(__kernel_param_unlock);
 584
 585 /*
 586  * add_sysfs_param - add a parameter to sysfs
 587  * @mk: struct module_kobject
 588  * @kparam: the actual parameter definition to add to sysfs
 589  * @name: name of parameter
 590  *
 591  * Create a kobject if for a (per-module) parameter if mp NULL, and
 592  * create file in sysfs.  Returns an error on out of memory.  Always cleans up
 593  * if there's an error.
 594  */
 595 static __modinit int add_sysfs_param(struct module_kobject *mk,
 596                                      const struct kernel_param *kp,
 597                                      const char *name)
 598 {
 599         struct module_param_attrs *new;
 600         struct attribute **attrs;
 601         int err, num;
 602
 603         /* We don't bother calling this with invisible parameters. */
 604         BUG_ON(!kp->perm);
 605
 606         if (!mk->mp) {
 607                 num = 0;
 608                 attrs = NULL;
 609         } else {
 610                 num = mk->mp->num;
 611                 attrs = mk->mp->grp.attrs;
 612         }
 613
 614         /* Enlarge. */
 615         new = krealloc(mk->mp,
 616                        sizeof(*mk->mp) + sizeof(mk->mp->attrs[0]) * (num+1),
 617                        GFP_KERNEL);
 618         if (!new) {
 619                 kfree(mk->mp);
 620                 err = -ENOMEM;
 621                 goto fail;
 622         }
 623         attrs = krealloc(attrs, sizeof(new->grp.attrs[0])*(num+2), GFP_KERNEL);
 624         if (!attrs) {
 625                 err = -ENOMEM;
 626                 goto fail_free_new;
 627         }
 628
 629         /* Sysfs wants everything zeroed. */
 630         memset(new, 0, sizeof(*new));
 631         memset(&new->attrs[num], 0, sizeof(new->attrs[num]));
 632         memset(&attrs[num], 0, sizeof(attrs[num]));
 633         new->grp.name = "parameters";
 634         new->grp.attrs = attrs;
 635
 636         /* Tack new one on the end. */
 637         sysfs_attr_init(&new->attrs[num].mattr.attr);
 638         new->attrs[num].param = kp;
 639         new->attrs[num].mattr.show = param_attr_show;
 640         new->attrs[num].mattr.store = param_attr_store;
 641         new->attrs[num].mattr.attr.name = (char *)name;
 642         new->attrs[num].mattr.attr.mode = kp->perm;
 643         new->num = num+1;
 644
 645         /* Fix up all the pointers, since krealloc can move us */
 646         for (num = 0; num < new->num; num++)
 647                 new->grp.attrs[num] = &new->attrs[num].mattr.attr;
 648         new->grp.attrs[num] = NULL;
 649
 650         mk->mp = new;
 651         return 0;
 652
 653 fail_free_new:
 654         kfree(new);
 655 fail:
 656         mk->mp = NULL;
 657         return err;
 658 }
 659
 660 #ifdef CONFIG_MODULES
 661 static void free_module_param_attrs(struct module_kobject *mk)
 662 {
 663         kfree(mk->mp->grp.attrs);
 664         kfree(mk->mp);
 665         mk->mp = NULL;
 666 }
 667
 668 /*
 669  * module_param_sysfs_setup - setup sysfs support for one module
 670  * @mod: module
 671  * @kparam: module parameters (array)
 672  * @num_params: number of module parameters
 673  *
 674  * Adds sysfs entries for module parameters under
 675  * /sys/module/[mod->name]/parameters/
 676  */
 677 int module_param_sysfs_setup(struct module *mod,
 678                              const struct kernel_param *kparam,
 679                              unsigned int num_params)
 680 {
 681         int i, err;
 682         bool params = false;
 683
 684         for (i = 0; i < num_params; i++) {
 685                 if (kparam[i].perm == 0)
 686                         continue;
 687                 err = add_sysfs_param(&mod->mkobj, &kparam[i], kparam[i].name);
 688                 if (err)
 689                         return err;
 690                 params = true;
 691         }
 692
 693         if (!params)
 694                 return 0;
 695
 696         /* Create the param group. */
 697         err = sysfs_create_group(&mod->mkobj.kobj, &mod->mkobj.mp->grp);
 698         if (err)
 699                 free_module_param_attrs(&mod->mkobj);
 700         return err;
 701 }
 702
 703 /*
 704  * module_param_sysfs_remove - remove sysfs support for one module
 705  * @mod: module
 706  *
 707  * Remove sysfs entries for module parameters and the corresponding
 708  * kobject.
 709  */
 710 void module_param_sysfs_remove(struct module *mod)
 711 {
 712         if (mod->mkobj.mp) {
 713                 sysfs_remove_group(&mod->mkobj.kobj, &mod->mkobj.mp->grp);
 714                 /* We are positive that no one is using any param
 715                  * attrs at this point.  Deallocate immediately. */
 716                 free_module_param_attrs(&mod->mkobj);
 717         }
 718 }
 719 #endif
 720
 721 void destroy_params(const struct kernel_param *params, unsigned num)
 722 {
 723         unsigned int i;
 724
 725         for (i = 0; i < num; i++)
 726                 if (params[i].ops->free)
 727                         params[i].ops->free(params[i].arg);
 728 }
 729
 730 static struct module_kobject * __init locate_module_kobject(const char *name)
 731 {
 732         struct module_kobject *mk;
 733         struct kobject *kobj;
 734         int err;
 735
 736         kobj = kset_find_obj(module_kset, name);
 737         if (kobj) {
 738                 mk = to_module_kobject(kobj);
 739         } else {
 740                 mk = kzalloc(sizeof(struct module_kobject), GFP_KERNEL);
 741                 BUG_ON(!mk);
 742
 743                 mk->mod = THIS_MODULE;
 744                 mk->kobj.kset = module_kset;
 745                 err = kobject_init_and_add(&mk->kobj, &module_ktype, NULL,
 746                                            "%s", name);
 747                 if (err) {
 748                         kobject_put(&mk->kobj);
 749                         printk(KERN_ERR
 750                                 "Module '%s' failed add to sysfs, error number %d\n",
 751                                 name, err);
 752                         printk(KERN_ERR
 753                                 "The system will be unstable now.\n");
 754                         return NULL;
 755                 }
 756
 757                 /* So that we hold reference in both cases. */
 758                 kobject_get(&mk->kobj);
 759         }
 760
 761         return mk;
 762 }
 763
 764 static void __init kernel_add_sysfs_param(const char *name,
 765                                           struct kernel_param *kparam,
 766                                           unsigned int name_skip)
 767 {
 768         struct module_kobject *mk;
 769         int err;
 770
 771         mk = locate_module_kobject(name);
 772         if (!mk)
 773                 return;
 774
 775         /* We need to remove old parameters before adding more. */
 776         if (mk->mp)
 777                 sysfs_remove_group(&mk->kobj, &mk->mp->grp);
 778
 779         /* These should not fail at boot. */
 780         err = add_sysfs_param(mk, kparam, kparam->name + name_skip);
 781         BUG_ON(err);
 782         err = sysfs_create_group(&mk->kobj, &mk->mp->grp);
 783         BUG_ON(err);
 784         kobject_uevent(&mk->kobj, KOBJ_ADD);
 785         kobject_put(&mk->kobj);
 786 }
 787
 788 /*
 789  * param_sysfs_builtin - add contents in /sys/parameters for built-in modules
 790  *
 791  * Add module_parameters to sysfs for "modules" built into the kernel.
 792  *
 793  * The "module" name (KBUILD_MODNAME) is stored before a dot, the
 794  * "parameter" name is stored behind a dot in kernel_param->name. So,
 795  * extract the "module" name for all built-in kernel_param-eters,
 796  * and for all who have the same, call kernel_add_sysfs_param.
 797  */
 798 static void __init param_sysfs_builtin(void)
 799 {
 800         struct kernel_param *kp;
 801         unsigned int name_len;
 802         char modname[MODULE_NAME_LEN];
 803
 804         for (kp = __start___param; kp < __stop___param; kp++) {
 805                 char *dot;
 806
 807                 if (kp->perm == 0)
 808                         continue;
 809
 810                 dot = strchr(kp->name, '.');
 811                 if (!dot) {
 812                         /* This happens for core_param() */
 813                         strcpy(modname, "kernel");
 814                         name_len = 0;
 815                 } else {
 816                         name_len = dot - kp->name + 1;
 817                         strlcpy(modname, kp->name, name_len);
 818                 }
 819                 kernel_add_sysfs_param(modname, kp, name_len);
 820         }
 821 }
 822
 823 ssize_t __modver_version_show(struct module_attribute *mattr,
 824                               struct module *mod, char *buf)
 825 {
 826         struct module_version_attribute *vattr =
 827                 container_of(mattr, struct module_version_attribute, mattr);
 828
 829         return sprintf(buf, "%s\n", vattr->version);
 830 }
 831
 832 extern struct module_version_attribute __start___modver[], __stop___modver[];
 833
 834 static void __init version_sysfs_builtin(void)
 835 {
 836         const struct module_version_attribute *vattr;
 837         struct module_kobject *mk;
 838         int err;
 839
 840         for (vattr = __start___modver; vattr < __stop___modver; vattr++) {
 841                 mk = locate_module_kobject(vattr->module_name);
 842                 if (mk) {
 843                         err = sysfs_create_file(&mk->kobj, &vattr->mattr.attr);
 844                         kobject_uevent(&mk->kobj, KOBJ_ADD);
 845                         kobject_put(&mk->kobj);
 846                 }
 847         }
 848 }
 849
 850 /* module-related sysfs stuff */
 851
 852 static ssize_t module_attr_show(struct kobject *kobj,
 853                                 struct attribute *attr,
 854                                 char *buf)
 855 {
 856         struct module_attribute *attribute;
 857         struct module_kobject *mk;
 858         int ret;
 859
 860         attribute = to_module_attr(attr);
 861         mk = to_module_kobject(kobj);
 862
 863         if (!attribute->show)
 864                 return -EIO;
 865
 866         ret = attribute->show(attribute, mk->mod, buf);
 867
 868         return ret;
 869 }
 870
 871 static ssize_t module_attr_store(struct kobject *kobj,
 872                                 struct attribute *attr,
 873                                 const char *buf, size_t len)
 874 {
 875         struct module_attribute *attribute;
 876         struct module_kobject *mk;
 877         int ret;
 878
 879         attribute = to_module_attr(attr);
 880         mk = to_module_kobject(kobj);
 881
 882         if (!attribute->store)
 883                 return -EIO;
 884
 885         ret = attribute->store(attribute, mk->mod, buf, len);
 886
 887         return ret;
 888 }
 889
 890 static const struct sysfs_ops module_sysfs_ops = {
 891         .show = module_attr_show,
 892         .store = module_attr_store,
 893 };
 894
 895 static int uevent_filter(struct kset *kset, struct kobject *kobj)
 896 {
 897         struct kobj_type *ktype = get_ktype(kobj);
 898
 899         if (ktype == &module_ktype)
 900                 return 1;
 901         return 0;
 902 }
 903
 904 static const struct kset_uevent_ops module_uevent_ops = {
 905         .filter = uevent_filter,
 906 };
 907
 908 struct kset *module_kset;
 909 int module_sysfs_initialized;
 910
 911 struct kobj_type module_ktype = {
 912         .sysfs_ops =    &module_sysfs_ops,
 913 };
 914
 915 /*
 916  * param_sysfs_init - wrapper for built-in params support
 917  */
 918 static int __init param_sysfs_init(void)
 919 {
 920         module_kset = kset_create_and_add("module", &module_uevent_ops, NULL);
 921         if (!module_kset) {
 922                 printk(KERN_WARNING "%s (%d): error creating kset\n",
 923                         __FILE__, __LINE__);
 924                 return -ENOMEM;
 925         }
 926         module_sysfs_initialized = 1;
 927
 928         version_sysfs_builtin();
 929         param_sysfs_builtin();
 930
 931         return 0;
 932 }
 933 subsys_initcall(param_sysfs_init);
 934
 935 #endif /* CONFIG_SYSFS */