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