1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * OF NUMA Parsing support. 4 * 5 * Copyright (C) 2015 - 2016 Cavium Inc. 6 */ 7 8 #define pr_fmt(fmt) "OF: NUMA: " fmt 9 10 #include <linux/of.h> 11 #include <linux/of_address.h> 12 #include <linux/nodemask.h> 13 14 #include <asm/numa.h> 15 16 /* define default numa node to 0 */ 17 #define DEFAULT_NODE 0 18 19 /* 20 * Even though we connect cpus to numa domains later in SMP 21 * init, we need to know the node ids now for all cpus. 22 */ 23 static void __init of_numa_parse_cpu_nodes(void) 24 { 25 u32 nid; 26 int r; 27 struct device_node *cpus; 28 struct device_node *np = NULL; 29 30 cpus = of_find_node_by_path("/cpus"); 31 if (!cpus) 32 return; 33 34 for_each_child_of_node(cpus, np) { 35 /* Skip things that are not CPUs */ 36 if (of_node_cmp(np->type, "cpu") != 0) 37 continue; 38 39 r = of_property_read_u32(np, "numa-node-id", &nid); 40 if (r) 41 continue; 42 43 pr_debug("CPU on %u\n", nid); 44 if (nid >= MAX_NUMNODES) 45 pr_warn("Node id %u exceeds maximum value\n", nid); 46 else 47 node_set(nid, numa_nodes_parsed); 48 } 49 50 of_node_put(cpus); 51 } 52 53 static int __init of_numa_parse_memory_nodes(void) 54 { 55 struct device_node *np = NULL; 56 struct resource rsrc; 57 u32 nid; 58 int i, r; 59 60 for_each_node_by_type(np, "memory") { 61 r = of_property_read_u32(np, "numa-node-id", &nid); 62 if (r == -EINVAL) 63 /* 64 * property doesn't exist if -EINVAL, continue 65 * looking for more memory nodes with 66 * "numa-node-id" property 67 */ 68 continue; 69 70 if (nid >= MAX_NUMNODES) { 71 pr_warn("Node id %u exceeds maximum value\n", nid); 72 r = -EINVAL; 73 } 74 75 for (i = 0; !r && !of_address_to_resource(np, i, &rsrc); i++) 76 r = numa_add_memblk(nid, rsrc.start, rsrc.end + 1); 77 78 if (!i || r) { 79 of_node_put(np); 80 pr_err("bad property in memory node\n"); 81 return r ? : -EINVAL; 82 } 83 } 84 85 return 0; 86 } 87 88 static int __init of_numa_parse_distance_map_v1(struct device_node *map) 89 { 90 const __be32 *matrix; 91 int entry_count; 92 int i; 93 94 pr_info("parsing numa-distance-map-v1\n"); 95 96 matrix = of_get_property(map, "distance-matrix", NULL); 97 if (!matrix) { 98 pr_err("No distance-matrix property in distance-map\n"); 99 return -EINVAL; 100 } 101 102 entry_count = of_property_count_u32_elems(map, "distance-matrix"); 103 if (entry_count <= 0) { 104 pr_err("Invalid distance-matrix\n"); 105 return -EINVAL; 106 } 107 108 for (i = 0; i + 2 < entry_count; i += 3) { 109 u32 nodea, nodeb, distance; 110 111 nodea = of_read_number(matrix, 1); 112 matrix++; 113 nodeb = of_read_number(matrix, 1); 114 matrix++; 115 distance = of_read_number(matrix, 1); 116 matrix++; 117 118 numa_set_distance(nodea, nodeb, distance); 119 pr_debug("distance[node%d -> node%d] = %d\n", 120 nodea, nodeb, distance); 121 122 /* Set default distance of node B->A same as A->B */ 123 if (nodeb > nodea) 124 numa_set_distance(nodeb, nodea, distance); 125 } 126 127 return 0; 128 } 129 130 static int __init of_numa_parse_distance_map(void) 131 { 132 int ret = 0; 133 struct device_node *np; 134 135 np = of_find_compatible_node(NULL, NULL, 136 "numa-distance-map-v1"); 137 if (np) 138 ret = of_numa_parse_distance_map_v1(np); 139 140 of_node_put(np); 141 return ret; 142 } 143 144 int of_node_to_nid(struct device_node *device) 145 { 146 struct device_node *np; 147 u32 nid; 148 int r = -ENODATA; 149 150 np = of_node_get(device); 151 152 while (np) { 153 r = of_property_read_u32(np, "numa-node-id", &nid); 154 /* 155 * -EINVAL indicates the property was not found, and 156 * we walk up the tree trying to find a parent with a 157 * "numa-node-id". Any other type of error indicates 158 * a bad device tree and we give up. 159 */ 160 if (r != -EINVAL) 161 break; 162 163 np = of_get_next_parent(np); 164 } 165 if (np && r) 166 pr_warn("Invalid \"numa-node-id\" property in node %s\n", 167 np->name); 168 of_node_put(np); 169 170 /* 171 * If numa=off passed on command line, or with a defective 172 * device tree, the nid may not be in the set of possible 173 * nodes. Check for this case and return NUMA_NO_NODE. 174 */ 175 if (!r && nid < MAX_NUMNODES && node_possible(nid)) 176 return nid; 177 178 return NUMA_NO_NODE; 179 } 180 181 int __init of_numa_init(void) 182 { 183 int r; 184 185 of_numa_parse_cpu_nodes(); 186 r = of_numa_parse_memory_nodes(); 187 if (r) 188 return r; 189 return of_numa_parse_distance_map(); 190 } 191