| Peng Fan | 35fdfcf | 2024-09-19 12:01:31 +0800 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
| 2 | /* |
| 3 | * Copyright 2024 NXP |
| 4 | */ |
| 5 | |
| 6 | #include <errno.h> |
| 7 | #include <fdtdec.h> |
| 8 | #include <malloc.h> |
| 9 | #include <asm/arch/sys_proto.h> |
| 10 | |
| 11 | static void disable_thermal_cpu_nodes(void *blob, u32 num_disabled_cores, u32 max_cores) |
| 12 | { |
| 13 | static const char * const thermal_path[] = { |
| 14 | "/thermal-zones/cpu-thermal/cooling-maps/map0" |
| 15 | }; |
| 16 | |
| 17 | int nodeoff, cnt, i, ret, j; |
| 18 | u32 num_le32 = max_cores * 3; |
| 19 | u32 *cooling_dev = (u32 *)malloc(num_le32 * sizeof(__le32)); |
| 20 | |
| 21 | if (!cooling_dev) { |
| 22 | printf("failed to alloc cooling dev\n"); |
| 23 | return; |
| 24 | } |
| 25 | |
| 26 | for (i = 0; i < ARRAY_SIZE(thermal_path); i++) { |
| 27 | nodeoff = fdt_path_offset(blob, thermal_path[i]); |
| 28 | if (nodeoff < 0) |
| 29 | continue; /* Not found, skip it */ |
| 30 | |
| 31 | cnt = fdtdec_get_int_array_count(blob, nodeoff, "cooling-device", |
| 32 | cooling_dev, num_le32); |
| 33 | if (cnt < 0) |
| 34 | continue; |
| 35 | |
| 36 | if (cnt != num_le32) |
| 37 | printf("Warning: %s, cooling-device count %d\n", thermal_path[i], cnt); |
| 38 | |
| 39 | for (j = 0; j < cnt; j++) |
| 40 | cooling_dev[j] = cpu_to_fdt32(cooling_dev[j]); |
| 41 | |
| 42 | ret = fdt_setprop(blob, nodeoff, "cooling-device", &cooling_dev, |
| 43 | sizeof(__le32) * (num_le32 - num_disabled_cores * 3)); |
| 44 | if (ret < 0) { |
| 45 | printf("Warning: %s, cooling-device setprop failed %d\n", |
| 46 | thermal_path[i], ret); |
| 47 | continue; |
| 48 | } |
| 49 | |
| 50 | printf("Update node %s, cooling-device prop\n", thermal_path[i]); |
| 51 | } |
| 52 | |
| 53 | free(cooling_dev); |
| 54 | } |
| 55 | |
| 56 | int disable_cpu_nodes(void *blob, const char * const *nodes_path, u32 num_disabled_cores, |
| 57 | u32 max_cores) |
| 58 | { |
| 59 | u32 i = 0; |
| 60 | int rc; |
| 61 | int nodeoff; |
| 62 | |
| 63 | if (max_cores == 0 || (num_disabled_cores > (max_cores - 1))) |
| 64 | return -EINVAL; |
| 65 | |
| 66 | i = max_cores - num_disabled_cores; |
| 67 | |
| 68 | for (; i < max_cores; i++) { |
| 69 | nodeoff = fdt_path_offset(blob, nodes_path[i]); |
| 70 | if (nodeoff < 0) |
| 71 | continue; /* Not found, skip it */ |
| 72 | |
| 73 | debug("Found %s node\n", nodes_path[i]); |
| 74 | |
| 75 | rc = fdt_del_node(blob, nodeoff); |
| 76 | if (rc < 0) { |
| 77 | printf("Unable to delete node %s, err=%s\n", |
| 78 | nodes_path[i], fdt_strerror(rc)); |
| 79 | } else { |
| 80 | printf("Delete node %s\n", nodes_path[i]); |
| 81 | } |
| 82 | } |
| 83 | |
| 84 | disable_thermal_cpu_nodes(blob, num_disabled_cores, max_cores); |
| 85 | |
| 86 | return 0; |
| 87 | } |
| Peng Fan | a74bf4b | 2024-09-19 12:01:34 +0800 | [diff] [blame] | 88 | |
| 89 | int fixup_thermal_trips(void *blob, const char *name) |
| 90 | { |
| 91 | int minc, maxc; |
| 92 | int node, trip; |
| 93 | |
| 94 | node = fdt_path_offset(blob, "/thermal-zones"); |
| 95 | if (node < 0) |
| 96 | return node; |
| 97 | |
| 98 | node = fdt_subnode_offset(blob, node, name); |
| 99 | if (node < 0) |
| 100 | return node; |
| 101 | |
| 102 | node = fdt_subnode_offset(blob, node, "trips"); |
| 103 | if (node < 0) |
| 104 | return node; |
| 105 | |
| 106 | get_cpu_temp_grade(&minc, &maxc); |
| 107 | |
| 108 | fdt_for_each_subnode(trip, blob, node) { |
| 109 | const char *type; |
| 110 | int temp, ret; |
| 111 | |
| 112 | type = fdt_getprop(blob, trip, "type", NULL); |
| 113 | if (!type) |
| 114 | continue; |
| 115 | |
| 116 | temp = 0; |
| 117 | if (!strcmp(type, "critical")) |
| 118 | temp = 1000 * (maxc - 5); |
| 119 | else if (!strcmp(type, "passive")) |
| 120 | temp = 1000 * (maxc - 10); |
| 121 | if (temp) { |
| 122 | ret = fdt_setprop_u32(blob, trip, "temperature", temp); |
| 123 | if (ret) |
| 124 | return ret; |
| 125 | } |
| 126 | } |
| 127 | |
| 128 | return 0; |
| 129 | } |