|
@@ -101,11 +101,12 @@ static struct property *dlpar_clone_property(struct property *prop,
|
|
|
return new_prop;
|
|
|
}
|
|
|
|
|
|
-static u32 find_aa_index(struct device_node *dr_node,
|
|
|
- struct property *ala_prop, const u32 *lmb_assoc)
|
|
|
+static bool find_aa_index(struct device_node *dr_node,
|
|
|
+ struct property *ala_prop,
|
|
|
+ const u32 *lmb_assoc, u32 *aa_index)
|
|
|
{
|
|
|
- u32 *assoc_arrays;
|
|
|
- u32 aa_index;
|
|
|
+ u32 *assoc_arrays, new_prop_size;
|
|
|
+ struct property *new_prop;
|
|
|
int aa_arrays, aa_array_entries, aa_array_sz;
|
|
|
int i, index;
|
|
|
|
|
@@ -121,46 +122,39 @@ static u32 find_aa_index(struct device_node *dr_node,
|
|
|
aa_array_entries = be32_to_cpu(assoc_arrays[1]);
|
|
|
aa_array_sz = aa_array_entries * sizeof(u32);
|
|
|
|
|
|
- aa_index = -1;
|
|
|
for (i = 0; i < aa_arrays; i++) {
|
|
|
index = (i * aa_array_entries) + 2;
|
|
|
|
|
|
if (memcmp(&assoc_arrays[index], &lmb_assoc[1], aa_array_sz))
|
|
|
continue;
|
|
|
|
|
|
- aa_index = i;
|
|
|
- break;
|
|
|
+ *aa_index = i;
|
|
|
+ return true;
|
|
|
}
|
|
|
|
|
|
- if (aa_index == -1) {
|
|
|
- struct property *new_prop;
|
|
|
- u32 new_prop_size;
|
|
|
-
|
|
|
- new_prop_size = ala_prop->length + aa_array_sz;
|
|
|
- new_prop = dlpar_clone_property(ala_prop, new_prop_size);
|
|
|
- if (!new_prop)
|
|
|
- return -1;
|
|
|
-
|
|
|
- assoc_arrays = new_prop->value;
|
|
|
+ new_prop_size = ala_prop->length + aa_array_sz;
|
|
|
+ new_prop = dlpar_clone_property(ala_prop, new_prop_size);
|
|
|
+ if (!new_prop)
|
|
|
+ return false;
|
|
|
|
|
|
- /* increment the number of entries in the lookup array */
|
|
|
- assoc_arrays[0] = cpu_to_be32(aa_arrays + 1);
|
|
|
+ assoc_arrays = new_prop->value;
|
|
|
|
|
|
- /* copy the new associativity into the lookup array */
|
|
|
- index = aa_arrays * aa_array_entries + 2;
|
|
|
- memcpy(&assoc_arrays[index], &lmb_assoc[1], aa_array_sz);
|
|
|
+ /* increment the number of entries in the lookup array */
|
|
|
+ assoc_arrays[0] = cpu_to_be32(aa_arrays + 1);
|
|
|
|
|
|
- of_update_property(dr_node, new_prop);
|
|
|
+ /* copy the new associativity into the lookup array */
|
|
|
+ index = aa_arrays * aa_array_entries + 2;
|
|
|
+ memcpy(&assoc_arrays[index], &lmb_assoc[1], aa_array_sz);
|
|
|
|
|
|
- /*
|
|
|
- * The associativity lookup array index for this lmb is
|
|
|
- * number of entries - 1 since we added its associativity
|
|
|
- * to the end of the lookup array.
|
|
|
- */
|
|
|
- aa_index = be32_to_cpu(assoc_arrays[0]) - 1;
|
|
|
- }
|
|
|
+ of_update_property(dr_node, new_prop);
|
|
|
|
|
|
- return aa_index;
|
|
|
+ /*
|
|
|
+ * The associativity lookup array index for this lmb is
|
|
|
+ * number of entries - 1 since we added its associativity
|
|
|
+ * to the end of the lookup array.
|
|
|
+ */
|
|
|
+ *aa_index = be32_to_cpu(assoc_arrays[0]) - 1;
|
|
|
+ return true;
|
|
|
}
|
|
|
|
|
|
static int update_lmb_associativity_index(struct drmem_lmb *lmb)
|
|
@@ -169,6 +163,7 @@ static int update_lmb_associativity_index(struct drmem_lmb *lmb)
|
|
|
struct property *ala_prop;
|
|
|
const u32 *lmb_assoc;
|
|
|
u32 aa_index;
|
|
|
+ bool found;
|
|
|
|
|
|
parent = of_find_node_by_path("/");
|
|
|
if (!parent)
|
|
@@ -200,11 +195,11 @@ static int update_lmb_associativity_index(struct drmem_lmb *lmb)
|
|
|
return -ENODEV;
|
|
|
}
|
|
|
|
|
|
- aa_index = find_aa_index(dr_node, ala_prop, lmb_assoc);
|
|
|
+ found = find_aa_index(dr_node, ala_prop, lmb_assoc, &aa_index);
|
|
|
|
|
|
dlpar_free_cc_nodes(lmb_node);
|
|
|
|
|
|
- if (aa_index < 0) {
|
|
|
+ if (!found) {
|
|
|
pr_err("Could not find LMB associativity\n");
|
|
|
return -1;
|
|
|
}
|