[mirror_ubuntu-bionic-kernel.git] / arch / powerpc / platforms / pseries / dlpar.c

/*
 * Support for dynamic reconfiguration for PCI, Memory, and CPU
 * Hotplug and Dynamic Logical Partitioning on RPA platforms.
 *
 * Copyright (C) 2009 Nathan Fontenot
 * Copyright (C) 2009 IBM Corporation
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License version
 * 2 as published by the Free Software Foundation.
 */

#define pr_fmt(fmt)	"dlpar: " fmt

#include <linux/kernel.h>
#include <linux/notifier.h>
#include <linux/spinlock.h>
#include <linux/cpu.h>
#include <linux/slab.h>
#include <linux/of.h>

#include "of_helpers.h"
#include "pseries.h"

#include <asm/prom.h>
#include <asm/machdep.h>
#include <linux/uaccess.h>
#include <asm/rtas.h>

static struct workqueue_struct *pseries_hp_wq;

struct pseries_hp_work {
	struct work_struct work;
	struct pseries_hp_errorlog *errlog;
	struct completion *hp_completion;
	int *rc;
};

struct cc_workarea {
	__be32	drc_index;
	__be32	zero;
	__be32	name_offset;
	__be32	prop_length;
	__be32	prop_offset;
};

void dlpar_free_cc_property(struct property *prop)
{
	kfree(prop->name);
	kfree(prop->value);
	kfree(prop);
}

static struct property *dlpar_parse_cc_property(struct cc_workarea *ccwa)
{
	struct property *prop;
	char *name;
	char *value;

	prop = kzalloc(sizeof(*prop), GFP_KERNEL);
	if (!prop)
		return NULL;

	name = (char *)ccwa + be32_to_cpu(ccwa->name_offset);
	prop->name = kstrdup(name, GFP_KERNEL);

	prop->length = be32_to_cpu(ccwa->prop_length);
	value = (char *)ccwa + be32_to_cpu(ccwa->prop_offset);
	prop->value = kmemdup(value, prop->length, GFP_KERNEL);
	if (!prop->value) {
		dlpar_free_cc_property(prop);
		return NULL;
	}

	return prop;
}

static struct device_node *dlpar_parse_cc_node(struct cc_workarea *ccwa,
					       const char *path)
{
	struct device_node *dn;
	char *name;

	/* If parent node path is "/" advance path to NULL terminator to
	 * prevent double leading slashs in full_name.
	 */
	if (!path[1])
		path++;

	dn = kzalloc(sizeof(*dn), GFP_KERNEL);
	if (!dn)
		return NULL;

	name = (char *)ccwa + be32_to_cpu(ccwa->name_offset);
	dn->full_name = kasprintf(GFP_KERNEL, "%s/%s", path, name);
	if (!dn->full_name) {
		kfree(dn);
		return NULL;
	}

	of_node_set_flag(dn, OF_DYNAMIC);
	of_node_init(dn);

	return dn;
}

static void dlpar_free_one_cc_node(struct device_node *dn)
{
	struct property *prop;

	while (dn->properties) {
		prop = dn->properties;
		dn->properties = prop->next;
		dlpar_free_cc_property(prop);
	}

	kfree(dn->full_name);
	kfree(dn);
}

void dlpar_free_cc_nodes(struct device_node *dn)
{
	if (dn->child)
		dlpar_free_cc_nodes(dn->child);

	if (dn->sibling)
		dlpar_free_cc_nodes(dn->sibling);

	dlpar_free_one_cc_node(dn);
}

#define COMPLETE	0
#define NEXT_SIBLING    1
#define NEXT_CHILD      2
#define NEXT_PROPERTY   3
#define PREV_PARENT     4
#define MORE_MEMORY     5
#define CALL_AGAIN	-2
#define ERR_CFG_USE     -9003

struct device_node *dlpar_configure_connector(__be32 drc_index,
					      struct device_node *parent)
{
	struct device_node *dn;
	struct device_node *first_dn = NULL;
	struct device_node *last_dn = NULL;
	struct property *property;
	struct property *last_property = NULL;
	struct cc_workarea *ccwa;
	char *data_buf;
	const char *parent_path = parent->full_name;
	int cc_token;
	int rc = -1;

	cc_token = rtas_token("ibm,configure-connector");
	if (cc_token == RTAS_UNKNOWN_SERVICE)
		return NULL;

	data_buf = kzalloc(RTAS_DATA_BUF_SIZE, GFP_KERNEL);
	if (!data_buf)
		return NULL;

	ccwa = (struct cc_workarea *)&data_buf[0];
	ccwa->drc_index = drc_index;
	ccwa->zero = 0;

	do {
		/* Since we release the rtas_data_buf lock between configure
		 * connector calls we want to re-populate the rtas_data_buffer
		 * with the contents of the previous call.
		 */
		spin_lock(&rtas_data_buf_lock);

		memcpy(rtas_data_buf, data_buf, RTAS_DATA_BUF_SIZE);
		rc = rtas_call(cc_token, 2, 1, NULL, rtas_data_buf, NULL);
		memcpy(data_buf, rtas_data_buf, RTAS_DATA_BUF_SIZE);

		spin_unlock(&rtas_data_buf_lock);

		switch (rc) {
		case COMPLETE:
			break;

		case NEXT_SIBLING:
			dn = dlpar_parse_cc_node(ccwa, parent_path);
			if (!dn)
				goto cc_error;

			dn->parent = last_dn->parent;
			last_dn->sibling = dn;
			last_dn = dn;
			break;

		case NEXT_CHILD:
			if (first_dn)
				parent_path = last_dn->full_name;

			dn = dlpar_parse_cc_node(ccwa, parent_path);
			if (!dn)
				goto cc_error;

			if (!first_dn) {
				dn->parent = parent;
				first_dn = dn;
			} else {
				dn->parent = last_dn;
				if (last_dn)
					last_dn->child = dn;
			}

			last_dn = dn;
			break;

		case NEXT_PROPERTY:
			property = dlpar_parse_cc_property(ccwa);
			if (!property)
				goto cc_error;

			if (!last_dn->properties)
				last_dn->properties = property;
			else
				last_property->next = property;

			last_property = property;
			break;

		case PREV_PARENT:
			last_dn = last_dn->parent;
			parent_path = last_dn->parent->full_name;
			break;

		case CALL_AGAIN:
			break;

		case MORE_MEMORY:
		case ERR_CFG_USE:
		default:
			printk(KERN_ERR "Unexpected Error (%d) "
			       "returned from configure-connector\n", rc);
			goto cc_error;
		}
	} while (rc);

cc_error:
	kfree(data_buf);

	if (rc) {
		if (first_dn)
			dlpar_free_cc_nodes(first_dn);

		return NULL;
	}

	return first_dn;
}

int dlpar_attach_node(struct device_node *dn, struct device_node *parent)
{
	int rc;

	dn->parent = parent;

	rc = of_attach_node(dn);
	if (rc) {
		printk(KERN_ERR "Failed to add device node %pOF\n", dn);
		return rc;
	}

	return 0;
}

int dlpar_detach_node(struct device_node *dn)
{
	struct device_node *child;
	int rc;

	child = of_get_next_child(dn, NULL);
	while (child) {
		dlpar_detach_node(child);
		child = of_get_next_child(dn, child);
	}

	rc = of_detach_node(dn);
	if (rc)
		return rc;

	return 0;
}

#define DR_ENTITY_SENSE		9003
#define DR_ENTITY_PRESENT	1
#define DR_ENTITY_UNUSABLE	2
#define ALLOCATION_STATE	9003
#define ALLOC_UNUSABLE		0
#define ALLOC_USABLE		1
#define ISOLATION_STATE		9001
#define ISOLATE			0
#define UNISOLATE		1

int dlpar_acquire_drc(u32 drc_index)
{
	int dr_status, rc;

	rc = rtas_call(rtas_token("get-sensor-state"), 2, 2, &dr_status,
		       DR_ENTITY_SENSE, drc_index);
	if (rc || dr_status != DR_ENTITY_UNUSABLE)
		return -1;

	rc = rtas_set_indicator(ALLOCATION_STATE, drc_index, ALLOC_USABLE);
	if (rc)
		return rc;

	rc = rtas_set_indicator(ISOLATION_STATE, drc_index, UNISOLATE);
	if (rc) {
		rtas_set_indicator(ALLOCATION_STATE, drc_index, ALLOC_UNUSABLE);
		return rc;
	}

	return 0;
}

int dlpar_release_drc(u32 drc_index)
{
	int dr_status, rc;

	rc = rtas_call(rtas_token("get-sensor-state"), 2, 2, &dr_status,
		       DR_ENTITY_SENSE, drc_index);
	if (rc || dr_status != DR_ENTITY_PRESENT)
		return -1;

	rc = rtas_set_indicator(ISOLATION_STATE, drc_index, ISOLATE);
	if (rc)
		return rc;

	rc = rtas_set_indicator(ALLOCATION_STATE, drc_index, ALLOC_UNUSABLE);
	if (rc) {
		rtas_set_indicator(ISOLATION_STATE, drc_index, UNISOLATE);
		return rc;
	}

	return 0;
}

static int handle_dlpar_errorlog(struct pseries_hp_errorlog *hp_elog)
{
	int rc;

	/* pseries error logs are in BE format, convert to cpu type */
	switch (hp_elog->id_type) {
	case PSERIES_HP_ELOG_ID_DRC_COUNT:
		hp_elog->_drc_u.drc_count =
				be32_to_cpu(hp_elog->_drc_u.drc_count);
		break;
	case PSERIES_HP_ELOG_ID_DRC_INDEX:
		hp_elog->_drc_u.drc_index =
				be32_to_cpu(hp_elog->_drc_u.drc_index);
		break;
	case PSERIES_HP_ELOG_ID_DRC_IC:
		hp_elog->_drc_u.ic.count =
				be32_to_cpu(hp_elog->_drc_u.ic.count);
		hp_elog->_drc_u.ic.index =
				be32_to_cpu(hp_elog->_drc_u.ic.index);
	}

	switch (hp_elog->resource) {
	case PSERIES_HP_ELOG_RESOURCE_MEM:
		rc = dlpar_memory(hp_elog);
		break;
	case PSERIES_HP_ELOG_RESOURCE_CPU:
		rc = dlpar_cpu(hp_elog);
		break;
	default:
		pr_warn_ratelimited("Invalid resource (%d) specified\n",
				    hp_elog->resource);
		rc = -EINVAL;
	}

	return rc;
}

static void pseries_hp_work_fn(struct work_struct *work)
{
	struct pseries_hp_work *hp_work =
			container_of(work, struct pseries_hp_work, work);

	if (hp_work->rc)
		*(hp_work->rc) = handle_dlpar_errorlog(hp_work->errlog);
	else
		handle_dlpar_errorlog(hp_work->errlog);

	if (hp_work->hp_completion)
		complete(hp_work->hp_completion);

	kfree(hp_work->errlog);
	kfree((void *)work);
}

void queue_hotplug_event(struct pseries_hp_errorlog *hp_errlog,
			 struct completion *hotplug_done, int *rc)
{
	struct pseries_hp_work *work;
	struct pseries_hp_errorlog *hp_errlog_copy;

	hp_errlog_copy = kmalloc(sizeof(struct pseries_hp_errorlog),
				 GFP_KERNEL);
	memcpy(hp_errlog_copy, hp_errlog, sizeof(struct pseries_hp_errorlog));

	work = kmalloc(sizeof(struct pseries_hp_work), GFP_KERNEL);
	if (work) {
		INIT_WORK((struct work_struct *)work, pseries_hp_work_fn);
		work->errlog = hp_errlog_copy;
		work->hp_completion = hotplug_done;
		work->rc = rc;
		queue_work(pseries_hp_wq, (struct work_struct *)work);
	} else {
		*rc = -ENOMEM;
		kfree(hp_errlog_copy);
		complete(hotplug_done);
	}
}

static int dlpar_parse_resource(char **cmd, struct pseries_hp_errorlog *hp_elog)
{
	char *arg;

	arg = strsep(cmd, " ");
	if (!arg)
		return -EINVAL;

	if (sysfs_streq(arg, "memory")) {
		hp_elog->resource = PSERIES_HP_ELOG_RESOURCE_MEM;
	} else if (sysfs_streq(arg, "cpu")) {
		hp_elog->resource = PSERIES_HP_ELOG_RESOURCE_CPU;
	} else {
		pr_err("Invalid resource specified.\n");
		return -EINVAL;
	}

	return 0;
}

static int dlpar_parse_action(char **cmd, struct pseries_hp_errorlog *hp_elog)
{
	char *arg;

	arg = strsep(cmd, " ");
	if (!arg)
		return -EINVAL;

	if (sysfs_streq(arg, "add")) {
		hp_elog->action = PSERIES_HP_ELOG_ACTION_ADD;
	} else if (sysfs_streq(arg, "remove")) {
		hp_elog->action = PSERIES_HP_ELOG_ACTION_REMOVE;
	} else {
		pr_err("Invalid action specified.\n");
		return -EINVAL;
	}

	return 0;
}

static int dlpar_parse_id_type(char **cmd, struct pseries_hp_errorlog *hp_elog)
{
	char *arg;
	u32 count, index;

	arg = strsep(cmd, " ");
	if (!arg)
		return -EINVAL;

	if (sysfs_streq(arg, "indexed-count")) {
		hp_elog->id_type = PSERIES_HP_ELOG_ID_DRC_IC;
		arg = strsep(cmd, " ");
		if (!arg) {
			pr_err("No DRC count specified.\n");
			return -EINVAL;
		}

		if (kstrtou32(arg, 0, &count)) {
			pr_err("Invalid DRC count specified.\n");
			return -EINVAL;
		}

		arg = strsep(cmd, " ");
		if (!arg) {
			pr_err("No DRC Index specified.\n");
			return -EINVAL;
		}

		if (kstrtou32(arg, 0, &index)) {
			pr_err("Invalid DRC Index specified.\n");
			return -EINVAL;
		}

		hp_elog->_drc_u.ic.count = cpu_to_be32(count);
		hp_elog->_drc_u.ic.index = cpu_to_be32(index);
	} else if (sysfs_streq(arg, "index")) {
		hp_elog->id_type = PSERIES_HP_ELOG_ID_DRC_INDEX;
		arg = strsep(cmd, " ");
		if (!arg) {
			pr_err("No DRC Index specified.\n");
			return -EINVAL;
		}

		if (kstrtou32(arg, 0, &index)) {
			pr_err("Invalid DRC Index specified.\n");
			return -EINVAL;
		}

		hp_elog->_drc_u.drc_index = cpu_to_be32(index);
	} else if (sysfs_streq(arg, "count")) {
		hp_elog->id_type = PSERIES_HP_ELOG_ID_DRC_COUNT;
		arg = strsep(cmd, " ");
		if (!arg) {
			pr_err("No DRC count specified.\n");
			return -EINVAL;
		}

		if (kstrtou32(arg, 0, &count)) {
			pr_err("Invalid DRC count specified.\n");
			return -EINVAL;
		}

		hp_elog->_drc_u.drc_count = cpu_to_be32(count);
	} else {
		pr_err("Invalid id_type specified.\n");
		return -EINVAL;
	}

	return 0;
}

static ssize_t dlpar_store(struct class *class, struct class_attribute *attr,
			   const char *buf, size_t count)
{
	struct pseries_hp_errorlog *hp_elog;
	struct completion hotplug_done;
	char *argbuf;
	char *args;
	int rc;

	args = argbuf = kstrdup(buf, GFP_KERNEL);
	hp_elog = kzalloc(sizeof(*hp_elog), GFP_KERNEL);
	if (!hp_elog || !argbuf) {
		pr_info("Could not allocate resources for DLPAR operation\n");
		kfree(argbuf);
		kfree(hp_elog);
		return -ENOMEM;
	}

	/*
	 * Parse out the request from the user, this will be in the form:
	 * <resource> <action> <id_type> <id>
	 */
	rc = dlpar_parse_resource(&args, hp_elog);
	if (rc)
		goto dlpar_store_out;

	rc = dlpar_parse_action(&args, hp_elog);
	if (rc)
		goto dlpar_store_out;

	rc = dlpar_parse_id_type(&args, hp_elog);
	if (rc)
		goto dlpar_store_out;

	init_completion(&hotplug_done);
	queue_hotplug_event(hp_elog, &hotplug_done, &rc);
	wait_for_completion(&hotplug_done);

dlpar_store_out:
	kfree(argbuf);
	kfree(hp_elog);

	if (rc)
		pr_err("Could not handle DLPAR request \"%s\"\n", buf);

	return rc ? rc : count;
}

static ssize_t dlpar_show(struct class *class, struct class_attribute *attr,
			  char *buf)
{
	return sprintf(buf, "%s\n", "memory,cpu");
}

static CLASS_ATTR_RW(dlpar);

static int __init pseries_dlpar_init(void)
{
	pseries_hp_wq = alloc_workqueue("pseries hotplug workqueue",
					WQ_UNBOUND, 1);
	return sysfs_create_file(kernel_kobj, &class_attr_dlpar.attr);
}
machine_device_initcall(pseries, pseries_dlpar_init);
Commit	Line	Data
ab519a01 NF	1	/*
	2	* Support for dynamic reconfiguration for PCI, Memory, and CPU
	3	* Hotplug and Dynamic Logical Partitioning on RPA platforms.
	4	*
	5	* Copyright (C) 2009 Nathan Fontenot
	6	* Copyright (C) 2009 IBM Corporation
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License version
	10	* 2 as published by the Free Software Foundation.
	11	*/
	12
999e2dad NF	13	#define pr_fmt(fmt) "dlpar: " fmt
999e2dad NF	14
ab519a01	15	#include <linux/kernel.h>
ab519a01	16	#include <linux/notifier.h>
ab519a01 NF	17	#include <linux/spinlock.h>
ab519a01 NF	18	#include <linux/cpu.h>
5a0e3ad6	19	#include <linux/slab.h>
1cf3d8b3	20	#include <linux/of.h>
06bacefc AS	21
06bacefc AS	22	#include "of_helpers.h"
1217d34b	23	#include "pseries.h"
ab519a01 NF	24
	25	#include <asm/prom.h>
	26	#include <asm/machdep.h>
7c0f6ba6	27	#include <linux/uaccess.h>
ab519a01	28	#include <asm/rtas.h>
ab519a01	29
7c98bd72	30	static struct workqueue_struct *pseries_hp_wq;
9054619e JA	31
	32	struct pseries_hp_work {
	33	struct work_struct work;
	34	struct pseries_hp_errorlog *errlog;
	35	struct completion *hp_completion;
	36	int *rc;
	37	};
	38
ab519a01	39	struct cc_workarea {
d6f1e7ab BR	40	__be32 drc_index;
	41	__be32 zero;
	42	__be32 name_offset;
	43	__be32 prop_length;
	44	__be32 prop_offset;
ab519a01 NF	45	};
ab519a01 NF	46
20648974	47	void dlpar_free_cc_property(struct property *prop)
ab519a01 NF	48	{
	49	kfree(prop->name);
	50	kfree(prop->value);
	51	kfree(prop);
	52	}
	53
	54	static struct property dlpar_parse_cc_property(struct cc_workarea ccwa)
	55	{
	56	struct property *prop;
	57	char *name;
	58	char *value;
	59
	60	prop = kzalloc(sizeof(*prop), GFP_KERNEL);
	61	if (!prop)
	62	return NULL;
	63
d6f1e7ab	64	name = (char *)ccwa + be32_to_cpu(ccwa->name_offset);
ab519a01 NF	65	prop->name = kstrdup(name, GFP_KERNEL);
ab519a01 NF	66
d6f1e7ab BR	67	prop->length = be32_to_cpu(ccwa->prop_length);
d6f1e7ab BR	68	value = (char *)ccwa + be32_to_cpu(ccwa->prop_offset);
e72ed6b5	69	prop->value = kmemdup(value, prop->length, GFP_KERNEL);
ab519a01 NF	70	if (!prop->value) {
	71	dlpar_free_cc_property(prop);
	72	return NULL;
	73	}
	74
ab519a01 NF	75	return prop;
	76	}
	77
8d5ff320 TD	78	static struct device_node dlpar_parse_cc_node(struct cc_workarea ccwa,
8d5ff320 TD	79	const char *path)
ab519a01 NF	80	{
	81	struct device_node *dn;
	82	char *name;
	83
8d5ff320 TD	84	/* If parent node path is "/" advance path to NULL terminator to
	85	* prevent double leading slashs in full_name.
	86	*/
	87	if (!path[1])
	88	path++;
	89
ab519a01 NF	90	dn = kzalloc(sizeof(*dn), GFP_KERNEL);
	91	if (!dn)
	92	return NULL;
	93
d6f1e7ab	94	name = (char *)ccwa + be32_to_cpu(ccwa->name_offset);
8d5ff320	95	dn->full_name = kasprintf(GFP_KERNEL, "%s/%s", path, name);
ab519a01 NF	96	if (!dn->full_name) {
	97	kfree(dn);
	98	return NULL;
	99	}
	100
1578cb76	101	of_node_set_flag(dn, OF_DYNAMIC);
97a9a717	102	of_node_init(dn);
1578cb76	103
ab519a01 NF	104	return dn;
	105	}
	106
	107	static void dlpar_free_one_cc_node(struct device_node *dn)
	108	{
	109	struct property *prop;
	110
	111	while (dn->properties) {
	112	prop = dn->properties;
	113	dn->properties = prop->next;
	114	dlpar_free_cc_property(prop);
	115	}
	116
	117	kfree(dn->full_name);
	118	kfree(dn);
	119	}
	120
20648974	121	void dlpar_free_cc_nodes(struct device_node *dn)
ab519a01 NF	122	{
	123	if (dn->child)
	124	dlpar_free_cc_nodes(dn->child);
	125
	126	if (dn->sibling)
	127	dlpar_free_cc_nodes(dn->sibling);
	128
	129	dlpar_free_one_cc_node(dn);
	130	}
	131
9c740025	132	#define COMPLETE 0
ab519a01 NF	133	#define NEXT_SIBLING 1
	134	#define NEXT_CHILD 2
	135	#define NEXT_PROPERTY 3
	136	#define PREV_PARENT 4
	137	#define MORE_MEMORY 5
	138	#define CALL_AGAIN -2
	139	#define ERR_CFG_USE -9003
	140
d6f1e7ab	141	struct device_node *dlpar_configure_connector(__be32 drc_index,
8d5ff320	142	struct device_node *parent)
ab519a01 NF	143	{
	144	struct device_node *dn;
	145	struct device_node *first_dn = NULL;
	146	struct device_node *last_dn = NULL;
	147	struct property *property;
	148	struct property *last_property = NULL;
	149	struct cc_workarea *ccwa;
93f68f1e	150	char *data_buf;
8d5ff320	151	const char *parent_path = parent->full_name;
ab519a01	152	int cc_token;
93f68f1e	153	int rc = -1;
ab519a01 NF	154
	155	cc_token = rtas_token("ibm,configure-connector");
	156	if (cc_token == RTAS_UNKNOWN_SERVICE)
	157	return NULL;
	158
93f68f1e NF	159	data_buf = kzalloc(RTAS_DATA_BUF_SIZE, GFP_KERNEL);
	160	if (!data_buf)
	161	return NULL;
	162
	163	ccwa = (struct cc_workarea *)&data_buf[0];
ab519a01 NF	164	ccwa->drc_index = drc_index;
	165	ccwa->zero = 0;
	166
93f68f1e NF	167	do {
	168	/* Since we release the rtas_data_buf lock between configure
	169	* connector calls we want to re-populate the rtas_data_buffer
	170	* with the contents of the previous call.
	171	*/
	172	spin_lock(&rtas_data_buf_lock);
	173
	174	memcpy(rtas_data_buf, data_buf, RTAS_DATA_BUF_SIZE);
	175	rc = rtas_call(cc_token, 2, 1, NULL, rtas_data_buf, NULL);
	176	memcpy(data_buf, rtas_data_buf, RTAS_DATA_BUF_SIZE);
	177
	178	spin_unlock(&rtas_data_buf_lock);
	179
ab519a01	180	switch (rc) {
9c740025 AB	181	case COMPLETE:
	182	break;
	183
ab519a01	184	case NEXT_SIBLING:
8d5ff320	185	dn = dlpar_parse_cc_node(ccwa, parent_path);
ab519a01 NF	186	if (!dn)
	187	goto cc_error;
	188
	189	dn->parent = last_dn->parent;
	190	last_dn->sibling = dn;
	191	last_dn = dn;
	192	break;
	193
	194	case NEXT_CHILD:
8d5ff320 TD	195	if (first_dn)
	196	parent_path = last_dn->full_name;
	197
	198	dn = dlpar_parse_cc_node(ccwa, parent_path);
ab519a01 NF	199	if (!dn)
	200	goto cc_error;
	201
8d5ff320 TD	202	if (!first_dn) {
8d5ff320 TD	203	dn->parent = parent;
ab519a01	204	first_dn = dn;
8d5ff320	205	} else {
ab519a01 NF	206	dn->parent = last_dn;
	207	if (last_dn)
	208	last_dn->child = dn;
	209	}
	210
	211	last_dn = dn;
	212	break;
	213
	214	case NEXT_PROPERTY:
	215	property = dlpar_parse_cc_property(ccwa);
	216	if (!property)
	217	goto cc_error;
	218
	219	if (!last_dn->properties)
	220	last_dn->properties = property;
	221	else
	222	last_property->next = property;
	223
	224	last_property = property;
	225	break;
	226
	227	case PREV_PARENT:
	228	last_dn = last_dn->parent;
8d5ff320	229	parent_path = last_dn->parent->full_name;
ab519a01 NF	230	break;
	231
	232	case CALL_AGAIN:
	233	break;
	234
	235	case MORE_MEMORY:
	236	case ERR_CFG_USE:
	237	default:
	238	printk(KERN_ERR "Unexpected Error (%d) "
	239	"returned from configure-connector\n", rc);
	240	goto cc_error;
	241	}
93f68f1e	242	} while (rc);
ab519a01	243
93f68f1e NF	244	cc_error:
	245	kfree(data_buf);
	246
	247	if (rc) {
	248	if (first_dn)
	249	dlpar_free_cc_nodes(first_dn);
	250
	251	return NULL;
ab519a01 NF	252	}
ab519a01 NF	253
ab519a01	254	return first_dn;
ab519a01 NF	255	}
ab519a01 NF	256
215ee763	257	int dlpar_attach_node(struct device_node dn, struct device_node parent)
ab519a01	258	{
ab519a01 NF	259	int rc;
ab519a01 NF	260
215ee763	261	dn->parent = parent;
ab519a01	262
1cf3d8b3	263	rc = of_attach_node(dn);
3aef19f0	264	if (rc) {
b7c670d6	265	printk(KERN_ERR "Failed to add device node %pOF\n", dn);
3aef19f0	266	return rc;
ab519a01 NF	267	}
ab519a01 NF	268
ab519a01 NF	269	return 0;
	270	}
	271
	272	int dlpar_detach_node(struct device_node *dn)
	273	{
5935ff43	274	struct device_node *child;
1cf3d8b3	275	int rc;
ab519a01	276
5935ff43 TD	277	child = of_get_next_child(dn, NULL);
	278	while (child) {
	279	dlpar_detach_node(child);
	280	child = of_get_next_child(dn, child);
	281	}
	282
1cf3d8b3 NF	283	rc = of_detach_node(dn);
	284	if (rc)
	285	return rc;
	286
ab519a01 NF	287	return 0;
	288	}
	289
	290	#define DR_ENTITY_SENSE 9003
	291	#define DR_ENTITY_PRESENT 1
	292	#define DR_ENTITY_UNUSABLE 2
	293	#define ALLOCATION_STATE 9003
	294	#define ALLOC_UNUSABLE 0
	295	#define ALLOC_USABLE 1
	296	#define ISOLATION_STATE 9001
	297	#define ISOLATE 0
	298	#define UNISOLATE 1
	299
	300	int dlpar_acquire_drc(u32 drc_index)
	301	{
	302	int dr_status, rc;
	303
	304	rc = rtas_call(rtas_token("get-sensor-state"), 2, 2, &dr_status,
	305	DR_ENTITY_SENSE, drc_index);
	306	if (rc \|\| dr_status != DR_ENTITY_UNUSABLE)
	307	return -1;
	308
	309	rc = rtas_set_indicator(ALLOCATION_STATE, drc_index, ALLOC_USABLE);
	310	if (rc)
	311	return rc;
	312
	313	rc = rtas_set_indicator(ISOLATION_STATE, drc_index, UNISOLATE);
	314	if (rc) {
	315	rtas_set_indicator(ALLOCATION_STATE, drc_index, ALLOC_UNUSABLE);
	316	return rc;
	317	}
	318
	319	return 0;
	320	}
	321
	322	int dlpar_release_drc(u32 drc_index)
	323	{
	324	int dr_status, rc;
	325
	326	rc = rtas_call(rtas_token("get-sensor-state"), 2, 2, &dr_status,
	327	DR_ENTITY_SENSE, drc_index);
	328	if (rc \|\| dr_status != DR_ENTITY_PRESENT)
	329	return -1;
	330
	331	rc = rtas_set_indicator(ISOLATION_STATE, drc_index, ISOLATE);
	332	if (rc)
	333	return rc;
	334
	335	rc = rtas_set_indicator(ALLOCATION_STATE, drc_index, ALLOC_UNUSABLE);
	336	if (rc) {
	337	rtas_set_indicator(ISOLATION_STATE, drc_index, UNISOLATE);
	338	return rc;
	339	}
	340
	341	return 0;
	342	}
	343
999e2dad NF	344	static int handle_dlpar_errorlog(struct pseries_hp_errorlog *hp_elog)
	345	{
	346	int rc;
	347
	348	/* pseries error logs are in BE format, convert to cpu type */
	349	switch (hp_elog->id_type) {
	350	case PSERIES_HP_ELOG_ID_DRC_COUNT:
	351	hp_elog->_drc_u.drc_count =
333f7b76	352	be32_to_cpu(hp_elog->_drc_u.drc_count);
999e2dad NF	353	break;
	354	case PSERIES_HP_ELOG_ID_DRC_INDEX:
	355	hp_elog->_drc_u.drc_index =
333f7b76 SM	356	be32_to_cpu(hp_elog->_drc_u.drc_index);
	357	break;
	358	case PSERIES_HP_ELOG_ID_DRC_IC:
	359	hp_elog->_drc_u.ic.count =
	360	be32_to_cpu(hp_elog->_drc_u.ic.count);
	361	hp_elog->_drc_u.ic.index =
	362	be32_to_cpu(hp_elog->_drc_u.ic.index);
999e2dad NF	363	}
	364
	365	switch (hp_elog->resource) {
	366	case PSERIES_HP_ELOG_RESOURCE_MEM:
	367	rc = dlpar_memory(hp_elog);
	368	break;
e9d764f8 NF	369	case PSERIES_HP_ELOG_RESOURCE_CPU:
	370	rc = dlpar_cpu(hp_elog);
	371	break;
999e2dad NF	372	default:
	373	pr_warn_ratelimited("Invalid resource (%d) specified\n",
	374	hp_elog->resource);
	375	rc = -EINVAL;
	376	}
	377
	378	return rc;
	379	}
	380
7c98bd72	381	static void pseries_hp_work_fn(struct work_struct *work)
9054619e JA	382	{
	383	struct pseries_hp_work *hp_work =
	384	container_of(work, struct pseries_hp_work, work);
	385
	386	if (hp_work->rc)
	387	*(hp_work->rc) = handle_dlpar_errorlog(hp_work->errlog);
	388	else
	389	handle_dlpar_errorlog(hp_work->errlog);
	390
	391	if (hp_work->hp_completion)
	392	complete(hp_work->hp_completion);
	393
	394	kfree(hp_work->errlog);
	395	kfree((void *)work);
	396	}
	397
	398	void queue_hotplug_event(struct pseries_hp_errorlog *hp_errlog,
	399	struct completion hotplug_done, int rc)
	400	{
	401	struct pseries_hp_work *work;
	402	struct pseries_hp_errorlog *hp_errlog_copy;
	403
	404	hp_errlog_copy = kmalloc(sizeof(struct pseries_hp_errorlog),
	405	GFP_KERNEL);
	406	memcpy(hp_errlog_copy, hp_errlog, sizeof(struct pseries_hp_errorlog));
	407
	408	work = kmalloc(sizeof(struct pseries_hp_work), GFP_KERNEL);
	409	if (work) {
	410	INIT_WORK((struct work_struct *)work, pseries_hp_work_fn);
	411	work->errlog = hp_errlog_copy;
	412	work->hp_completion = hotplug_done;
	413	work->rc = rc;
	414	queue_work(pseries_hp_wq, (struct work_struct *)work);
	415	} else {
	416	*rc = -ENOMEM;
90ce3514	417	kfree(hp_errlog_copy);
9054619e JA	418	complete(hotplug_done);
	419	}
	420	}
	421
25b587fb	422	static int dlpar_parse_resource(char *cmd, struct pseries_hp_errorlog hp_elog)
999e2dad	423	{
25b587fb	424	char *arg;
999e2dad	425
25b587fb NF	426	arg = strsep(cmd, " ");
	427	if (!arg)
	428	return -EINVAL;
999e2dad	429
25b587fb	430	if (sysfs_streq(arg, "memory")) {
999e2dad	431	hp_elog->resource = PSERIES_HP_ELOG_RESOURCE_MEM;
25b587fb	432	} else if (sysfs_streq(arg, "cpu")) {
e9d764f8	433	hp_elog->resource = PSERIES_HP_ELOG_RESOURCE_CPU;
999e2dad	434	} else {
25b587fb NF	435	pr_err("Invalid resource specified.\n");
25b587fb NF	436	return -EINVAL;
999e2dad NF	437	}
999e2dad NF	438
25b587fb NF	439	return 0;
	440	}
	441
	442	static int dlpar_parse_action(char *cmd, struct pseries_hp_errorlog hp_elog)
	443	{
	444	char *arg;
	445
	446	arg = strsep(cmd, " ");
	447	if (!arg)
	448	return -EINVAL;
	449
	450	if (sysfs_streq(arg, "add")) {
999e2dad	451	hp_elog->action = PSERIES_HP_ELOG_ACTION_ADD;
25b587fb	452	} else if (sysfs_streq(arg, "remove")) {
999e2dad	453	hp_elog->action = PSERIES_HP_ELOG_ACTION_REMOVE;
999e2dad	454	} else {
25b587fb NF	455	pr_err("Invalid action specified.\n");
25b587fb NF	456	return -EINVAL;
999e2dad NF	457	}
999e2dad NF	458
25b587fb NF	459	return 0;
25b587fb NF	460	}
999e2dad	461
25b587fb NF	462	static int dlpar_parse_id_type(char *cmd, struct pseries_hp_errorlog hp_elog)
	463	{
	464	char *arg;
	465	u32 count, index;
	466
	467	arg = strsep(cmd, " ");
	468	if (!arg)
	469	return -EINVAL;
	470
333f7b76 SM	471	if (sysfs_streq(arg, "indexed-count")) {
	472	hp_elog->id_type = PSERIES_HP_ELOG_ID_DRC_IC;
	473	arg = strsep(cmd, " ");
	474	if (!arg) {
	475	pr_err("No DRC count specified.\n");
	476	return -EINVAL;
	477	}
	478
	479	if (kstrtou32(arg, 0, &count)) {
	480	pr_err("Invalid DRC count specified.\n");
	481	return -EINVAL;
	482	}
	483
	484	arg = strsep(cmd, " ");
	485	if (!arg) {
	486	pr_err("No DRC Index specified.\n");
	487	return -EINVAL;
	488	}
	489
	490	if (kstrtou32(arg, 0, &index)) {
	491	pr_err("Invalid DRC Index specified.\n");
	492	return -EINVAL;
	493	}
	494
	495	hp_elog->_drc_u.ic.count = cpu_to_be32(count);
	496	hp_elog->_drc_u.ic.index = cpu_to_be32(index);
	497	} else if (sysfs_streq(arg, "index")) {
999e2dad	498	hp_elog->id_type = PSERIES_HP_ELOG_ID_DRC_INDEX;
25b587fb NF	499	arg = strsep(cmd, " ");
	500	if (!arg) {
	501	pr_err("No DRC Index specified.\n");
	502	return -EINVAL;
	503	}
	504
999e2dad	505	if (kstrtou32(arg, 0, &index)) {
25b587fb NF	506	pr_err("Invalid DRC Index specified.\n");
25b587fb NF	507	return -EINVAL;
999e2dad NF	508	}
	509
	510	hp_elog->_drc_u.drc_index = cpu_to_be32(index);
25b587fb	511	} else if (sysfs_streq(arg, "count")) {
999e2dad	512	hp_elog->id_type = PSERIES_HP_ELOG_ID_DRC_COUNT;
25b587fb NF	513	arg = strsep(cmd, " ");
	514	if (!arg) {
	515	pr_err("No DRC count specified.\n");
	516	return -EINVAL;
	517	}
	518
999e2dad	519	if (kstrtou32(arg, 0, &count)) {
25b587fb NF	520	pr_err("Invalid DRC count specified.\n");
25b587fb NF	521	return -EINVAL;
999e2dad NF	522	}
	523
	524	hp_elog->_drc_u.drc_count = cpu_to_be32(count);
	525	} else {
25b587fb NF	526	pr_err("Invalid id_type specified.\n");
	527	return -EINVAL;
	528	}
	529
	530	return 0;
	531	}
	532
	533	static ssize_t dlpar_store(struct class class, struct class_attribute attr,
	534	const char *buf, size_t count)
	535	{
	536	struct pseries_hp_errorlog *hp_elog;
	537	struct completion hotplug_done;
	538	char *argbuf;
	539	char *args;
	540	int rc;
	541
	542	args = argbuf = kstrdup(buf, GFP_KERNEL);
	543	hp_elog = kzalloc(sizeof(*hp_elog), GFP_KERNEL);
	544	if (!hp_elog \|\| !argbuf) {
	545	pr_info("Could not allocate resources for DLPAR operation\n");
	546	kfree(argbuf);
	547	kfree(hp_elog);
	548	return -ENOMEM;
999e2dad NF	549	}
999e2dad NF	550
25b587fb NF	551	/*
	552	* Parse out the request from the user, this will be in the form:
	553	* <resource> <action> <id_type> <id>
	554	*/
	555	rc = dlpar_parse_resource(&args, hp_elog);
	556	if (rc)
	557	goto dlpar_store_out;
	558
	559	rc = dlpar_parse_action(&args, hp_elog);
	560	if (rc)
	561	goto dlpar_store_out;
	562
	563	rc = dlpar_parse_id_type(&args, hp_elog);
	564	if (rc)
	565	goto dlpar_store_out;
	566
1dc75956 JA	567	init_completion(&hotplug_done);
	568	queue_hotplug_event(hp_elog, &hotplug_done, &rc);
	569	wait_for_completion(&hotplug_done);
999e2dad NF	570
999e2dad NF	571	dlpar_store_out:
25b587fb	572	kfree(argbuf);
999e2dad	573	kfree(hp_elog);
25b587fb NF	574
	575	if (rc)
	576	pr_err("Could not handle DLPAR request \"%s\"\n", buf);
	577
999e2dad NF	578	return rc ? rc : count;
	579	}
	580
673bc435 NF	581	static ssize_t dlpar_show(struct class class, struct class_attribute attr,
	582	char *buf)
	583	{
	584	return sprintf(buf, "%s\n", "memory,cpu");
	585	}
	586
6f428096	587	static CLASS_ATTR_RW(dlpar);
999e2dad	588
1a8061c4 NF	589	static int __init pseries_dlpar_init(void)
1a8061c4 NF	590	{
9054619e JA	591	pseries_hp_wq = alloc_workqueue("pseries hotplug workqueue",
9054619e JA	592	WQ_UNBOUND, 1);
183deeea	593	return sysfs_create_file(kernel_kobj, &class_attr_dlpar.attr);
1a8061c4 NF	594	}
	595	machine_device_initcall(pseries, pseries_dlpar_init);
	596