2 * Support for Partition Mobility/Migration
4 * Copyright (C) 2010 Nathan Fontenot
5 * Copyright (C) 2010 IBM Corporation
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License version
9 * 2 as published by the Free Software Foundation.
12 #include <linux/kernel.h>
13 #include <linux/kobject.h>
14 #include <linux/smp.h>
15 #include <linux/stat.h>
16 #include <linux/completion.h>
17 #include <linux/device.h>
18 #include <linux/delay.h>
19 #include <linux/slab.h>
21 #include <asm/machdep.h>
25 static struct kobject
*mobility_kobj
;
27 struct update_props_workarea
{
34 #define NODE_ACTION_MASK 0xff000000
35 #define NODE_COUNT_MASK 0x00ffffff
37 #define DELETE_DT_NODE 0x01000000
38 #define UPDATE_DT_NODE 0x02000000
39 #define ADD_DT_NODE 0x03000000
41 #define MIGRATION_SCOPE (1)
43 static int mobility_rtas_call(int token
, char *buf
, s32 scope
)
47 spin_lock(&rtas_data_buf_lock
);
49 memcpy(rtas_data_buf
, buf
, RTAS_DATA_BUF_SIZE
);
50 rc
= rtas_call(token
, 2, 1, NULL
, rtas_data_buf
, scope
);
51 memcpy(buf
, rtas_data_buf
, RTAS_DATA_BUF_SIZE
);
53 spin_unlock(&rtas_data_buf_lock
);
57 static int delete_dt_node(u32 phandle
)
59 struct device_node
*dn
;
61 dn
= of_find_node_by_phandle(phandle
);
65 dlpar_detach_node(dn
);
70 static int update_dt_property(struct device_node
*dn
, struct property
**prop
,
71 const char *name
, u32 vd
, char *value
)
73 struct property
*new_prop
= *prop
;
76 /* A negative 'vd' value indicates that only part of the new property
77 * value is contained in the buffer and we need to call
78 * ibm,update-properties again to get the rest of the value.
80 * A negative value is also the two's compliment of the actual value.
82 if (vd
& 0x80000000) {
88 /* partial property fixup */
89 char *new_data
= kzalloc(new_prop
->length
+ vd
, GFP_KERNEL
);
93 memcpy(new_data
, new_prop
->value
, new_prop
->length
);
94 memcpy(new_data
+ new_prop
->length
, value
, vd
);
96 kfree(new_prop
->value
);
97 new_prop
->value
= new_data
;
98 new_prop
->length
+= vd
;
100 new_prop
= kzalloc(sizeof(*new_prop
), GFP_KERNEL
);
104 new_prop
->name
= kstrdup(name
, GFP_KERNEL
);
105 if (!new_prop
->name
) {
110 new_prop
->length
= vd
;
111 new_prop
->value
= kzalloc(new_prop
->length
, GFP_KERNEL
);
112 if (!new_prop
->value
) {
113 kfree(new_prop
->name
);
118 memcpy(new_prop
->value
, value
, vd
);
123 of_update_property(dn
, new_prop
);
130 static int update_dt_node(u32 phandle
, s32 scope
)
132 struct update_props_workarea
*upwa
;
133 struct device_node
*dn
;
134 struct property
*prop
= NULL
;
138 int update_properties_token
;
141 update_properties_token
= rtas_token("ibm,update-properties");
142 if (update_properties_token
== RTAS_UNKNOWN_SERVICE
)
145 rtas_buf
= kzalloc(RTAS_DATA_BUF_SIZE
, GFP_KERNEL
);
149 dn
= of_find_node_by_phandle(phandle
);
155 upwa
= (struct update_props_workarea
*)&rtas_buf
[0];
156 upwa
->phandle
= phandle
;
159 rtas_rc
= mobility_rtas_call(update_properties_token
, rtas_buf
,
164 prop_data
= rtas_buf
+ sizeof(*upwa
);
166 /* On the first call to ibm,update-properties for a node the
167 * the first property value descriptor contains an empty
168 * property name, the property value length encoded as u32,
169 * and the property value is the node path being updated.
171 if (*prop_data
== 0) {
173 vd
= *(u32
*)prop_data
;
174 prop_data
+= vd
+ sizeof(vd
);
178 for (i
= 0; i
< upwa
->nprops
; i
++) {
181 prop_name
= prop_data
;
182 prop_data
+= strlen(prop_name
) + 1;
183 vd
= *(u32
*)prop_data
;
184 prop_data
+= sizeof(vd
);
188 /* name only property, nothing to do */
192 prop
= of_find_property(dn
, prop_name
, NULL
);
193 of_remove_property(dn
, prop
);
198 rc
= update_dt_property(dn
, &prop
, prop_name
,
201 printk(KERN_ERR
"Could not update %s"
202 " property\n", prop_name
);
208 } while (rtas_rc
== 1);
215 static int add_dt_node(u32 parent_phandle
, u32 drc_index
)
217 struct device_node
*dn
;
218 struct device_node
*parent_dn
;
221 parent_dn
= of_find_node_by_phandle(parent_phandle
);
225 dn
= dlpar_configure_connector(drc_index
, parent_dn
);
229 rc
= dlpar_attach_node(dn
);
231 dlpar_free_cc_nodes(dn
);
233 of_node_put(parent_dn
);
237 int pseries_devicetree_update(s32 scope
)
241 int update_nodes_token
;
244 update_nodes_token
= rtas_token("ibm,update-nodes");
245 if (update_nodes_token
== RTAS_UNKNOWN_SERVICE
)
248 rtas_buf
= kzalloc(RTAS_DATA_BUF_SIZE
, GFP_KERNEL
);
253 rc
= mobility_rtas_call(update_nodes_token
, rtas_buf
, scope
);
257 data
= (u32
*)rtas_buf
+ 4;
258 while (*data
& NODE_ACTION_MASK
) {
260 u32 action
= *data
& NODE_ACTION_MASK
;
261 int node_count
= *data
& NODE_COUNT_MASK
;
265 for (i
= 0; i
< node_count
; i
++) {
266 u32 phandle
= *data
++;
271 delete_dt_node(phandle
);
274 update_dt_node(phandle
, scope
);
278 add_dt_node(phandle
, drc_index
);
289 void post_mobility_fixup(void)
292 int activate_fw_token
;
294 activate_fw_token
= rtas_token("ibm,activate-firmware");
295 if (activate_fw_token
== RTAS_UNKNOWN_SERVICE
) {
296 printk(KERN_ERR
"Could not make post-mobility "
297 "activate-fw call.\n");
302 rc
= rtas_call(activate_fw_token
, 0, 1, NULL
);
303 } while (rtas_busy_delay(rc
));
306 printk(KERN_ERR
"Post-mobility activate-fw failed: %d\n", rc
);
308 rc
= pseries_devicetree_update(MIGRATION_SCOPE
);
310 printk(KERN_ERR
"Post-mobility device tree update "
316 static ssize_t
migrate_store(struct class *class, struct class_attribute
*attr
,
317 const char *buf
, size_t count
)
323 rc
= kstrtou64(buf
, 0, &streamid
);
328 rc
= rtas_ibm_suspend_me(streamid
, &vasi_rc
);
329 if (!rc
&& vasi_rc
== RTAS_NOT_SUSPENDABLE
)
331 } while (!rc
&& vasi_rc
== RTAS_NOT_SUSPENDABLE
);
338 post_mobility_fixup();
342 static CLASS_ATTR(migration
, S_IWUSR
, NULL
, migrate_store
);
344 static int __init
mobility_sysfs_init(void)
348 mobility_kobj
= kobject_create_and_add("mobility", kernel_kobj
);
352 rc
= sysfs_create_file(mobility_kobj
, &class_attr_migration
.attr
);
356 machine_device_initcall(pseries
, mobility_sysfs_init
);
This page took 0.049349 seconds and 5 git commands to generate.