arch/powerpc/platforms/pseries/reconfig.c

   1 /*
   2  * pSeries_reconfig.c - support for dynamic reconfiguration (including PCI
   3  * Hotplug and Dynamic Logical Partitioning on RPA platforms).
   4  *
   5  * Copyright (C) 2005 Nathan Lynch
   6  * Copyright (C) 2005 IBM Corporation
   7  *
   8  *
   9  *      This program is free software; you can redistribute it and/or
  10  *      modify it under the terms of the GNU General Public License version
  11  *      2 as published by the Free Software Foundation.
  12  */
  13
  14 #include <linux/kernel.h>
  15 #include <linux/notifier.h>
  16 #include <linux/proc_fs.h>
  17 #include <linux/slab.h>
  18 #include <linux/of.h>
  19
  20 #include <asm/prom.h>
  21 #include <asm/machdep.h>
  22 #include <linux/uaccess.h>
  23 #include <asm/mmu.h>
  24
  25 #include "of_helpers.h"
  26
  27 static int pSeries_reconfig_add_node(const char *path, struct property *proplist)
  28 {
  29         struct device_node *np;
  30         int err = -ENOMEM;
  31
  32         np = kzalloc(sizeof(*np), GFP_KERNEL);
  33         if (!np)
  34                 goto out_err;
  35
  36         np->full_name = kstrdup(path, GFP_KERNEL);
  37         if (!np->full_name)
  38                 goto out_err;
  39
  40         np->properties = proplist;
  41         of_node_set_flag(np, OF_DYNAMIC);
  42         of_node_init(np);
  43
  44         np->parent = pseries_of_derive_parent(path);
  45         if (IS_ERR(np->parent)) {
  46                 err = PTR_ERR(np->parent);
  47                 goto out_err;
  48         }
  49
  50         err = of_attach_node(np);
  51         if (err) {
  52                 printk(KERN_ERR "Failed to add device node %s\n", path);
  53                 goto out_err;
  54         }
  55
  56         of_node_put(np->parent);
  57
  58         return 0;
  59
  60 out_err:
  61         if (np) {
  62                 of_node_put(np->parent);
  63                 kfree(np->full_name);
  64                 kfree(np);
  65         }
  66         return err;
  67 }
  68
  69 static int pSeries_reconfig_remove_node(struct device_node *np)
  70 {
  71         struct device_node *parent, *child;
  72
  73         parent = of_get_parent(np);
  74         if (!parent)
  75                 return -EINVAL;
  76
  77         if ((child = of_get_next_child(np, NULL))) {
  78                 of_node_put(child);
  79                 of_node_put(parent);
  80                 return -EBUSY;
  81         }
  82
  83         of_detach_node(np);
  84         of_node_put(parent);
  85         of_node_put(np); /* Must decrement the refcount */
  86         return 0;
  87 }
  88
  89 /*
  90  * /proc/powerpc/ofdt - yucky binary interface for adding and removing
  91  * OF device nodes.  Should be deprecated as soon as we get an
  92  * in-kernel wrapper for the RTAS ibm,configure-connector call.
  93  */
  94
  95 static void release_prop_list(const struct property *prop)
  96 {
  97         struct property *next;
  98         for (; prop; prop = next) {
  99                 next = prop->next;
 100                 kfree(prop->name);
 101                 kfree(prop->value);
 102                 kfree(prop);
 103         }
 104
 105 }
 106
 107 /**
 108  * parse_next_property - process the next property from raw input buffer
 109  * @buf: input buffer, must be nul-terminated
 110  * @end: end of the input buffer + 1, for validation
 111  * @name: return value; set to property name in buf
 112  * @length: return value; set to length of value
 113  * @value: return value; set to the property value in buf
 114  *
 115  * Note that the caller must make copies of the name and value returned,
 116  * this function does no allocation or copying of the data.  Return value
 117  * is set to the next name in buf, or NULL on error.
 118  */
 119 static char * parse_next_property(char *buf, char *end, char **name, int *length,
 120                                   unsigned char **value)
 121 {
 122         char *tmp;
 123
 124         *name = buf;
 125
 126         tmp = strchr(buf, ' ');
 127         if (!tmp) {
 128                 printk(KERN_ERR "property parse failed in %s at line %d\n",
 129                        __func__, __LINE__);
 130                 return NULL;
 131         }
 132         *tmp = '\0';
 133
 134         if (++tmp >= end) {
 135                 printk(KERN_ERR "property parse failed in %s at line %d\n",
 136                        __func__, __LINE__);
 137                 return NULL;
 138         }
 139
 140         /* now we're on the length */
 141         *length = -1;
 142         *length = simple_strtoul(tmp, &tmp, 10);
 143         if (*length == -1) {
 144                 printk(KERN_ERR "property parse failed in %s at line %d\n",
 145                        __func__, __LINE__);
 146                 return NULL;
 147         }
 148         if (*tmp != ' ' || ++tmp >= end) {
 149                 printk(KERN_ERR "property parse failed in %s at line %d\n",
 150                        __func__, __LINE__);
 151                 return NULL;
 152         }
 153
 154         /* now we're on the value */
 155         *value = tmp;
 156         tmp += *length;
 157         if (tmp > end) {
 158                 printk(KERN_ERR "property parse failed in %s at line %d\n",
 159                        __func__, __LINE__);
 160                 return NULL;
 161         }
 162         else if (tmp < end && *tmp != ' ' && *tmp != '\0') {
 163                 printk(KERN_ERR "property parse failed in %s at line %d\n",
 164                        __func__, __LINE__);
 165                 return NULL;
 166         }
 167         tmp++;
 168
 169         /* and now we should be on the next name, or the end */
 170         return tmp;
 171 }
 172
 173 static struct property *new_property(const char *name, const int length,
 174                                      const unsigned char *value, struct property *last)
 175 {
 176         struct property *new = kzalloc(sizeof(*new), GFP_KERNEL);
 177
 178         if (!new)
 179                 return NULL;
 180
 181         if (!(new->name = kstrdup(name, GFP_KERNEL)))
 182                 goto cleanup;
 183         if (!(new->value = kmalloc(length + 1, GFP_KERNEL)))
 184                 goto cleanup;
 185
 186         memcpy(new->value, value, length);
 187         *(((char *)new->value) + length) = 0;
 188         new->length = length;
 189         new->next = last;
 190         return new;
 191
 192 cleanup:
 193         kfree(new->name);
 194         kfree(new->value);
 195         kfree(new);
 196         return NULL;
 197 }
 198
 199 static int do_add_node(char *buf, size_t bufsize)
 200 {
 201         char *path, *end, *name;
 202         struct device_node *np;
 203         struct property *prop = NULL;
 204         unsigned char* value;
 205         int length, rv = 0;
 206
 207         end = buf + bufsize;
 208         path = buf;
 209         buf = strchr(buf, ' ');
 210         if (!buf)
 211                 return -EINVAL;
 212         *buf = '\0';
 213         buf++;
 214
 215         if ((np = of_find_node_by_path(path))) {
 216                 of_node_put(np);
 217                 return -EINVAL;
 218         }
 219
 220         /* rv = build_prop_list(tmp, bufsize - (tmp - buf), &proplist); */
 221         while (buf < end &&
 222                (buf = parse_next_property(buf, end, &name, &length, &value))) {
 223                 struct property *last = prop;
 224
 225                 prop = new_property(name, length, value, last);
 226                 if (!prop) {
 227                         rv = -ENOMEM;
 228                         prop = last;
 229                         goto out;
 230                 }
 231         }
 232         if (!buf) {
 233                 rv = -EINVAL;
 234                 goto out;
 235         }
 236
 237         rv = pSeries_reconfig_add_node(path, prop);
 238
 239 out:
 240         if (rv)
 241                 release_prop_list(prop);
 242         return rv;
 243 }
 244
 245 static int do_remove_node(char *buf)
 246 {
 247         struct device_node *node;
 248         int rv = -ENODEV;
 249
 250         if ((node = of_find_node_by_path(buf)))
 251                 rv = pSeries_reconfig_remove_node(node);
 252
 253         of_node_put(node);
 254         return rv;
 255 }
 256
 257 static char *parse_node(char *buf, size_t bufsize, struct device_node **npp)
 258 {
 259         char *handle_str;
 260         phandle handle;
 261         *npp = NULL;
 262
 263         handle_str = buf;
 264
 265         buf = strchr(buf, ' ');
 266         if (!buf)
 267                 return NULL;
 268         *buf = '\0';
 269         buf++;
 270
 271         handle = simple_strtoul(handle_str, NULL, 0);
 272
 273         *npp = of_find_node_by_phandle(handle);
 274         return buf;
 275 }
 276
 277 static int do_add_property(char *buf, size_t bufsize)
 278 {
 279         struct property *prop = NULL;
 280         struct device_node *np;
 281         unsigned char *value;
 282         char *name, *end;
 283         int length;
 284         end = buf + bufsize;
 285         buf = parse_node(buf, bufsize, &np);
 286
 287         if (!np)
 288                 return -ENODEV;
 289
 290         if (parse_next_property(buf, end, &name, &length, &value) == NULL)
 291                 return -EINVAL;
 292
 293         prop = new_property(name, length, value, NULL);
 294         if (!prop)
 295                 return -ENOMEM;
 296
 297         of_add_property(np, prop);
 298
 299         return 0;
 300 }
 301
 302 static int do_remove_property(char *buf, size_t bufsize)
 303 {
 304         struct device_node *np;
 305         char *tmp;
 306         buf = parse_node(buf, bufsize, &np);
 307
 308         if (!np)
 309                 return -ENODEV;
 310
 311         tmp = strchr(buf,' ');
 312         if (tmp)
 313                 *tmp = '\0';
 314
 315         if (strlen(buf) == 0)
 316                 return -EINVAL;
 317
 318         return of_remove_property(np, of_find_property(np, buf, NULL));
 319 }
 320
 321 static int do_update_property(char *buf, size_t bufsize)
 322 {
 323         struct device_node *np;
 324         unsigned char *value;
 325         char *name, *end, *next_prop;
 326         int length;
 327         struct property *newprop;
 328         buf = parse_node(buf, bufsize, &np);
 329         end = buf + bufsize;
 330
 331         if (!np)
 332                 return -ENODEV;
 333
 334         next_prop = parse_next_property(buf, end, &name, &length, &value);
 335         if (!next_prop)
 336                 return -EINVAL;
 337
 338         if (!strlen(name))
 339                 return -ENODEV;
 340
 341         newprop = new_property(name, length, value, NULL);
 342         if (!newprop)
 343                 return -ENOMEM;
 344
 345         if (!strcmp(name, "slb-size") || !strcmp(name, "ibm,slb-size"))
 346                 slb_set_size(*(int *)value);
 347
 348         return of_update_property(np, newprop);
 349 }
 350
 351 /**
 352  * ofdt_write - perform operations on the Open Firmware device tree
 353  *
 354  * @file: not used
 355  * @buf: command and arguments
 356  * @count: size of the command buffer
 357  * @off: not used
 358  *
 359  * Operations supported at this time are addition and removal of
 360  * whole nodes along with their properties.  Operations on individual
 361  * properties are not implemented (yet).
 362  */
 363 static ssize_t ofdt_write(struct file *file, const char __user *buf, size_t count,
 364                           loff_t *off)
 365 {
 366         int rv = 0;
 367         char *kbuf;
 368         char *tmp;
 369
 370         if (!(kbuf = kmalloc(count + 1, GFP_KERNEL))) {
 371                 rv = -ENOMEM;
 372                 goto out;
 373         }
 374         if (copy_from_user(kbuf, buf, count)) {
 375                 rv = -EFAULT;
 376                 goto out;
 377         }
 378
 379         kbuf[count] = '\0';
 380
 381         tmp = strchr(kbuf, ' ');
 382         if (!tmp) {
 383                 rv = -EINVAL;
 384                 goto out;
 385         }
 386         *tmp = '\0';
 387         tmp++;
 388
 389         if (!strcmp(kbuf, "add_node"))
 390                 rv = do_add_node(tmp, count - (tmp - kbuf));
 391         else if (!strcmp(kbuf, "remove_node"))
 392                 rv = do_remove_node(tmp);
 393         else if (!strcmp(kbuf, "add_property"))
 394                 rv = do_add_property(tmp, count - (tmp - kbuf));
 395         else if (!strcmp(kbuf, "remove_property"))
 396                 rv = do_remove_property(tmp, count - (tmp - kbuf));
 397         else if (!strcmp(kbuf, "update_property"))
 398                 rv = do_update_property(tmp, count - (tmp - kbuf));
 399         else
 400                 rv = -EINVAL;
 401 out:
 402         kfree(kbuf);
 403         return rv ? rv : count;
 404 }
 405
 406 static const struct file_operations ofdt_fops = {
 407         .write = ofdt_write,
 408         .llseek = noop_llseek,
 409 };
 410
 411 /* create /proc/powerpc/ofdt write-only by root */
 412 static int proc_ppc64_create_ofdt(void)
 413 {
 414         struct proc_dir_entry *ent;
 415
 416         ent = proc_create("powerpc/ofdt", S_IWUSR, NULL, &ofdt_fops);
 417         if (ent)
 418                 proc_set_size(ent, 0);
 419
 420         return 0;
 421 }
 422 machine_device_initcall(pseries, proc_ppc64_create_ofdt);