Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 2 | /* |
Prabhakar Kushwaha | beebb88 | 2012-04-24 20:16:49 +0000 | [diff] [blame] | 3 | * Copyright 2009-2012 Freescale Semiconductor, Inc. |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 4 | * |
Stefan Roese | 88fbf93 | 2010-04-15 16:07:28 +0200 | [diff] [blame] | 5 | * This file is derived from arch/powerpc/cpu/mpc85xx/cpu.c and |
| 6 | * arch/powerpc/cpu/mpc86xx/cpu.c. Basically this file contains |
Peter Tyser | 29514c7 | 2010-04-12 22:28:09 -0500 | [diff] [blame] | 7 | * cpu specific common code for 85xx/86xx processors. |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 8 | */ |
| 9 | |
| 10 | #include <config.h> |
| 11 | #include <common.h> |
| 12 | #include <command.h> |
Simon Glass | 33d1e70 | 2019-11-14 12:57:32 -0700 | [diff] [blame] | 13 | #include <cpu_func.h> |
Simon Glass | 9758973 | 2020-05-10 11:40:02 -0600 | [diff] [blame] | 14 | #include <init.h> |
Simon Glass | 274e0b0 | 2020-05-10 11:39:56 -0600 | [diff] [blame] | 15 | #include <net.h> |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 16 | #include <tsec.h> |
Kumar Gala | 2683c53 | 2011-04-13 08:37:44 -0500 | [diff] [blame] | 17 | #include <fm_eth.h> |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 18 | #include <netdev.h> |
| 19 | #include <asm/cache.h> |
Simon Glass | 3ba929a | 2020-10-30 21:38:53 -0600 | [diff] [blame] | 20 | #include <asm/global_data.h> |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 21 | #include <asm/io.h> |
Codrin Ciubotariu | ef208b5 | 2015-01-21 11:54:10 +0200 | [diff] [blame] | 22 | #include <vsc9953.h> |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 23 | |
| 24 | DECLARE_GLOBAL_DATA_PTR; |
| 25 | |
Kim Phillips | 82f576f | 2012-10-29 13:34:37 +0000 | [diff] [blame] | 26 | static struct cpu_type cpu_type_list[] = { |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 27 | #if defined(CONFIG_MPC85xx) |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 28 | CPU_TYPE_ENTRY(8533, 8533, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 29 | CPU_TYPE_ENTRY(8535, 8535, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 30 | CPU_TYPE_ENTRY(8536, 8536, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 31 | CPU_TYPE_ENTRY(8540, 8540, 1), |
| 32 | CPU_TYPE_ENTRY(8541, 8541, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 33 | CPU_TYPE_ENTRY(8543, 8543, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 34 | CPU_TYPE_ENTRY(8544, 8544, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 35 | CPU_TYPE_ENTRY(8545, 8545, 1), |
York Sun | 8cb6548 | 2012-07-06 17:10:33 -0500 | [diff] [blame] | 36 | CPU_TYPE_ENTRY(8547, 8547, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 37 | CPU_TYPE_ENTRY(8548, 8548, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 38 | CPU_TYPE_ENTRY(8555, 8555, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 39 | CPU_TYPE_ENTRY(8560, 8560, 1), |
| 40 | CPU_TYPE_ENTRY(8567, 8567, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 41 | CPU_TYPE_ENTRY(8568, 8568, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 42 | CPU_TYPE_ENTRY(8569, 8569, 1), |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 43 | CPU_TYPE_ENTRY(8572, 8572, 2), |
Poonam Aggrwal | 2ba3ee0 | 2011-01-13 21:39:27 +0530 | [diff] [blame] | 44 | CPU_TYPE_ENTRY(P1010, P1010, 1), |
Poonam Aggrwal | 13e21b1 | 2009-08-20 18:57:45 +0530 | [diff] [blame] | 45 | CPU_TYPE_ENTRY(P1011, P1011, 1), |
Kumar Gala | 16a276e | 2010-03-30 23:06:53 -0500 | [diff] [blame] | 46 | CPU_TYPE_ENTRY(P1012, P1012, 1), |
Kumar Gala | 16a276e | 2010-03-30 23:06:53 -0500 | [diff] [blame] | 47 | CPU_TYPE_ENTRY(P1013, P1013, 1), |
Poonam Aggrwal | b07a7de | 2011-01-13 21:40:05 +0530 | [diff] [blame] | 48 | CPU_TYPE_ENTRY(P1014, P1014, 1), |
Roy Zang | 1de20b0 | 2011-02-03 22:14:19 -0600 | [diff] [blame] | 49 | CPU_TYPE_ENTRY(P1017, P1017, 1), |
Poonam Aggrwal | dfe86a7 | 2009-07-31 12:08:27 +0530 | [diff] [blame] | 50 | CPU_TYPE_ENTRY(P1020, P1020, 2), |
Kumar Gala | 16a276e | 2010-03-30 23:06:53 -0500 | [diff] [blame] | 51 | CPU_TYPE_ENTRY(P1021, P1021, 2), |
Kumar Gala | 16a276e | 2010-03-30 23:06:53 -0500 | [diff] [blame] | 52 | CPU_TYPE_ENTRY(P1022, P1022, 2), |
Roy Zang | 1de20b0 | 2011-02-03 22:14:19 -0600 | [diff] [blame] | 53 | CPU_TYPE_ENTRY(P1023, P1023, 2), |
Kumar Gala | e4e6925 | 2011-02-05 13:45:07 -0600 | [diff] [blame] | 54 | CPU_TYPE_ENTRY(P1024, P1024, 2), |
Kumar Gala | e4e6925 | 2011-02-05 13:45:07 -0600 | [diff] [blame] | 55 | CPU_TYPE_ENTRY(P1025, P1025, 2), |
Poonam Aggrwal | 13e21b1 | 2009-08-20 18:57:45 +0530 | [diff] [blame] | 56 | CPU_TYPE_ENTRY(P2010, P2010, 1), |
Poonam Aggrwal | 13e21b1 | 2009-08-20 18:57:45 +0530 | [diff] [blame] | 57 | CPU_TYPE_ENTRY(P2020, P2020, 2), |
Kumar Gala | bd29be8 | 2010-06-01 10:29:11 -0500 | [diff] [blame] | 58 | CPU_TYPE_ENTRY(P2040, P2040, 4), |
Kumar Gala | 619541b | 2011-05-13 01:16:07 -0500 | [diff] [blame] | 59 | CPU_TYPE_ENTRY(P2041, P2041, 4), |
Kumar Gala | f2134b8 | 2010-01-27 10:26:46 -0600 | [diff] [blame] | 60 | CPU_TYPE_ENTRY(P3041, P3041, 4), |
Kumar Gala | bb5409c | 2009-03-19 02:39:17 -0500 | [diff] [blame] | 61 | CPU_TYPE_ENTRY(P4040, P4040, 4), |
Kumar Gala | bb5409c | 2009-03-19 02:39:17 -0500 | [diff] [blame] | 62 | CPU_TYPE_ENTRY(P4080, P4080, 8), |
Kumar Gala | 7ee3d94 | 2009-10-21 13:32:58 -0500 | [diff] [blame] | 63 | CPU_TYPE_ENTRY(P5010, P5010, 1), |
Kumar Gala | 7ee3d94 | 2009-10-21 13:32:58 -0500 | [diff] [blame] | 64 | CPU_TYPE_ENTRY(P5020, P5020, 2), |
Timur Tabi | d5e1388 | 2012-10-05 11:09:19 +0000 | [diff] [blame] | 65 | CPU_TYPE_ENTRY(P5021, P5021, 2), |
| 66 | CPU_TYPE_ENTRY(P5040, P5040, 4), |
York Sun | 9941a22 | 2012-10-08 07:44:19 +0000 | [diff] [blame] | 67 | CPU_TYPE_ENTRY(T4240, T4240, 0), |
| 68 | CPU_TYPE_ENTRY(T4120, T4120, 0), |
York Sun | fb5137a | 2013-03-25 07:33:29 +0000 | [diff] [blame] | 69 | CPU_TYPE_ENTRY(T4160, T4160, 0), |
Shengzhou Liu | 26ed2d0 | 2014-04-25 16:31:22 +0800 | [diff] [blame] | 70 | CPU_TYPE_ENTRY(T4080, T4080, 4), |
York Sun | bcf7b3d | 2012-10-08 07:44:20 +0000 | [diff] [blame] | 71 | CPU_TYPE_ENTRY(B4860, B4860, 0), |
| 72 | CPU_TYPE_ENTRY(G4860, G4860, 0), |
York Sun | bcf7b3d | 2012-10-08 07:44:20 +0000 | [diff] [blame] | 73 | CPU_TYPE_ENTRY(B4440, B4440, 0), |
Shaveta Leekha | 00e6ea3 | 2014-05-07 14:43:23 +0530 | [diff] [blame] | 74 | CPU_TYPE_ENTRY(B4460, B4460, 0), |
York Sun | bcf7b3d | 2012-10-08 07:44:20 +0000 | [diff] [blame] | 75 | CPU_TYPE_ENTRY(G4440, G4440, 0), |
| 76 | CPU_TYPE_ENTRY(B4420, B4420, 0), |
| 77 | CPU_TYPE_ENTRY(B4220, B4220, 0), |
York Sun | 4657136 | 2013-03-25 07:40:06 +0000 | [diff] [blame] | 78 | CPU_TYPE_ENTRY(T1040, T1040, 0), |
| 79 | CPU_TYPE_ENTRY(T1041, T1041, 0), |
| 80 | CPU_TYPE_ENTRY(T1042, T1042, 0), |
| 81 | CPU_TYPE_ENTRY(T1020, T1020, 0), |
| 82 | CPU_TYPE_ENTRY(T1021, T1021, 0), |
| 83 | CPU_TYPE_ENTRY(T1022, T1022, 0), |
Shengzhou Liu | e6fb770 | 2014-11-24 17:11:54 +0800 | [diff] [blame] | 84 | CPU_TYPE_ENTRY(T1024, T1024, 0), |
| 85 | CPU_TYPE_ENTRY(T1023, T1023, 0), |
| 86 | CPU_TYPE_ENTRY(T1014, T1014, 0), |
| 87 | CPU_TYPE_ENTRY(T1013, T1013, 0), |
Shengzhou Liu | f305cd2 | 2013-11-22 17:39:10 +0800 | [diff] [blame] | 88 | CPU_TYPE_ENTRY(T2080, T2080, 0), |
| 89 | CPU_TYPE_ENTRY(T2081, T2081, 0), |
Prabhakar Kushwaha | beebb88 | 2012-04-24 20:16:49 +0000 | [diff] [blame] | 90 | CPU_TYPE_ENTRY(BSC9130, 9130, 1), |
Prabhakar Kushwaha | beebb88 | 2012-04-24 20:16:49 +0000 | [diff] [blame] | 91 | CPU_TYPE_ENTRY(BSC9131, 9131, 1), |
Prabhakar Kushwaha | 92543c2 | 2013-01-23 17:59:57 +0000 | [diff] [blame] | 92 | CPU_TYPE_ENTRY(BSC9132, 9132, 2), |
| 93 | CPU_TYPE_ENTRY(BSC9232, 9232, 2), |
Mingkai Hu | 1a25807 | 2013-07-04 17:30:36 +0800 | [diff] [blame] | 94 | CPU_TYPE_ENTRY(C291, C291, 1), |
| 95 | CPU_TYPE_ENTRY(C292, C292, 1), |
| 96 | CPU_TYPE_ENTRY(C293, C293, 1), |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 97 | #elif defined(CONFIG_MPC86xx) |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 98 | CPU_TYPE_ENTRY(8610, 8610, 1), |
| 99 | CPU_TYPE_ENTRY(8641, 8641, 2), |
| 100 | CPU_TYPE_ENTRY(8641D, 8641D, 2), |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 101 | #endif |
| 102 | }; |
| 103 | |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 104 | #ifdef CONFIG_SYS_FSL_QORIQ_CHASSIS2 |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 105 | static inline u32 init_type(u32 cluster, int init_id) |
| 106 | { |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 107 | ccsr_gur_t *gur = (void __iomem *)(CFG_SYS_MPC85xx_GUTS_ADDR); |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 108 | u32 idx = (cluster >> (init_id * 8)) & TP_CLUSTER_INIT_MASK; |
| 109 | u32 type = in_be32(&gur->tp_ityp[idx]); |
| 110 | |
| 111 | if (type & TP_ITYP_AV) |
| 112 | return type; |
| 113 | |
| 114 | return 0; |
| 115 | } |
| 116 | |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 117 | u32 compute_ppc_cpumask(void) |
| 118 | { |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 119 | ccsr_gur_t *gur = (void __iomem *)(CFG_SYS_MPC85xx_GUTS_ADDR); |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 120 | int i = 0, count = 0; |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 121 | u32 cluster, type, mask = 0; |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 122 | |
| 123 | do { |
| 124 | int j; |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 125 | cluster = in_be32(&gur->tp_cluster[i].lower); |
| 126 | for (j = 0; j < TP_INIT_PER_CLUSTER; j++) { |
| 127 | type = init_type(cluster, j); |
| 128 | if (type) { |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 129 | if (TP_ITYP_TYPE(type) == TP_ITYP_TYPE_PPC) |
| 130 | mask |= 1 << count; |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 131 | count++; |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 132 | } |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 133 | } |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 134 | i++; |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 135 | } while ((cluster & TP_CLUSTER_EOC) != TP_CLUSTER_EOC); |
| 136 | |
| 137 | return mask; |
| 138 | } |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 139 | |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 140 | #ifdef CONFIG_HETROGENOUS_CLUSTERS |
| 141 | u32 compute_dsp_cpumask(void) |
| 142 | { |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 143 | ccsr_gur_t *gur = (void __iomem *)(CFG_SYS_MPC85xx_GUTS_ADDR); |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 144 | int i = CONFIG_DSP_CLUSTER_START, count = 0; |
| 145 | u32 cluster, type, dsp_mask = 0; |
| 146 | |
| 147 | do { |
| 148 | int j; |
| 149 | cluster = in_be32(&gur->tp_cluster[i].lower); |
| 150 | for (j = 0; j < TP_INIT_PER_CLUSTER; j++) { |
| 151 | type = init_type(cluster, j); |
| 152 | if (type) { |
| 153 | if (TP_ITYP_TYPE(type) == TP_ITYP_TYPE_SC) |
| 154 | dsp_mask |= 1 << count; |
| 155 | count++; |
| 156 | } |
| 157 | } |
| 158 | i++; |
| 159 | } while ((cluster & TP_CLUSTER_EOC) != TP_CLUSTER_EOC); |
| 160 | |
| 161 | return dsp_mask; |
| 162 | } |
| 163 | |
| 164 | int fsl_qoriq_dsp_core_to_cluster(unsigned int core) |
| 165 | { |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 166 | ccsr_gur_t *gur = (void __iomem *)(CFG_SYS_MPC85xx_GUTS_ADDR); |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 167 | int count = 0, i = CONFIG_DSP_CLUSTER_START; |
| 168 | u32 cluster; |
| 169 | |
| 170 | do { |
| 171 | int j; |
| 172 | cluster = in_be32(&gur->tp_cluster[i].lower); |
| 173 | for (j = 0; j < TP_INIT_PER_CLUSTER; j++) { |
| 174 | if (init_type(cluster, j)) { |
| 175 | if (count == core) |
| 176 | return i; |
| 177 | count++; |
| 178 | } |
| 179 | } |
| 180 | i++; |
| 181 | } while ((cluster & TP_CLUSTER_EOC) != TP_CLUSTER_EOC); |
| 182 | |
| 183 | return -1; /* cannot identify the cluster */ |
| 184 | } |
| 185 | #endif |
| 186 | |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 187 | int fsl_qoriq_core_to_cluster(unsigned int core) |
| 188 | { |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 189 | ccsr_gur_t *gur = (void __iomem *)(CFG_SYS_MPC85xx_GUTS_ADDR); |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 190 | int i = 0, count = 0; |
| 191 | u32 cluster; |
| 192 | |
| 193 | do { |
| 194 | int j; |
| 195 | cluster = in_be32(&gur->tp_cluster[i].lower); |
| 196 | for (j = 0; j < TP_INIT_PER_CLUSTER; j++) { |
| 197 | if (init_type(cluster, j)) { |
| 198 | if (count == core) |
| 199 | return i; |
| 200 | count++; |
| 201 | } |
| 202 | } |
| 203 | i++; |
| 204 | } while ((cluster & TP_CLUSTER_EOC) != TP_CLUSTER_EOC); |
| 205 | |
| 206 | return -1; /* cannot identify the cluster */ |
| 207 | } |
| 208 | |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 209 | #else /* CONFIG_SYS_FSL_QORIQ_CHASSIS2 */ |
| 210 | /* |
| 211 | * Before chassis genenration 2, the cpumask should be hard-coded. |
| 212 | * In case of cpu type unknown or cpumask unset, use 1 as fail save. |
| 213 | */ |
| 214 | #define compute_ppc_cpumask() 1 |
York Sun | aa150bb | 2013-03-25 07:40:07 +0000 | [diff] [blame] | 215 | #define fsl_qoriq_core_to_cluster(x) x |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 216 | #endif /* CONFIG_SYS_FSL_QORIQ_CHASSIS2 */ |
| 217 | |
Kim Phillips | 82f576f | 2012-10-29 13:34:37 +0000 | [diff] [blame] | 218 | static struct cpu_type cpu_type_unknown = CPU_TYPE_ENTRY(Unknown, Unknown, 0); |
Poonam Aggrwal | da6e1ca | 2009-09-02 13:35:21 +0530 | [diff] [blame] | 219 | |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 220 | struct cpu_type *identify_cpu(u32 ver) |
| 221 | { |
| 222 | int i; |
| 223 | for (i = 0; i < ARRAY_SIZE(cpu_type_list); i++) { |
| 224 | if (cpu_type_list[i].soc_ver == ver) |
| 225 | return &cpu_type_list[i]; |
| 226 | } |
Poonam Aggrwal | da6e1ca | 2009-09-02 13:35:21 +0530 | [diff] [blame] | 227 | return &cpu_type_unknown; |
Poonam Aggrwal | 9120884 | 2009-07-31 12:07:45 +0530 | [diff] [blame] | 228 | } |
| 229 | |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 230 | #define MPC8xxx_PICFRR_NCPU_MASK 0x00001f00 |
| 231 | #define MPC8xxx_PICFRR_NCPU_SHIFT 8 |
| 232 | |
| 233 | /* |
| 234 | * Return a 32-bit mask indicating which cores are present on this SOC. |
| 235 | */ |
Alexander Graf | 5b9e18c | 2014-04-30 19:21:10 +0200 | [diff] [blame] | 236 | __weak u32 cpu_mask(void) |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 237 | { |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 238 | ccsr_pic_t __iomem *pic = (void *)CFG_SYS_MPC8xxx_PIC_ADDR; |
Simon Glass | a8b5739 | 2012-12-13 20:48:48 +0000 | [diff] [blame] | 239 | struct cpu_type *cpu = gd->arch.cpu; |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 240 | |
| 241 | /* better to query feature reporting register than just assume 1 */ |
| 242 | if (cpu == &cpu_type_unknown) |
| 243 | return ((in_be32(&pic->frr) & MPC8xxx_PICFRR_NCPU_MASK) >> |
| 244 | MPC8xxx_PICFRR_NCPU_SHIFT) + 1; |
| 245 | |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 246 | if (cpu->num_cores == 0) |
| 247 | return compute_ppc_cpumask(); |
| 248 | |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 249 | return cpu->mask; |
| 250 | } |
| 251 | |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 252 | #ifdef CONFIG_HETROGENOUS_CLUSTERS |
| 253 | __weak u32 cpu_dsp_mask(void) |
| 254 | { |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 255 | ccsr_pic_t __iomem *pic = (void *)CFG_SYS_MPC8xxx_PIC_ADDR; |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 256 | struct cpu_type *cpu = gd->arch.cpu; |
| 257 | |
| 258 | /* better to query feature reporting register than just assume 1 */ |
| 259 | if (cpu == &cpu_type_unknown) |
| 260 | return ((in_be32(&pic->frr) & MPC8xxx_PICFRR_NCPU_MASK) >> |
| 261 | MPC8xxx_PICFRR_NCPU_SHIFT) + 1; |
| 262 | |
| 263 | if (cpu->dsp_num_cores == 0) |
| 264 | return compute_dsp_cpumask(); |
| 265 | |
| 266 | return cpu->dsp_mask; |
| 267 | } |
| 268 | |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 269 | /* |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 270 | * Return the number of SC/DSP cores on this SOC. |
| 271 | */ |
| 272 | __weak int cpu_num_dspcores(void) |
| 273 | { |
| 274 | struct cpu_type *cpu = gd->arch.cpu; |
| 275 | |
| 276 | /* |
| 277 | * Report # of cores in terms of the cpu_mask if we haven't |
| 278 | * figured out how many there are yet |
| 279 | */ |
| 280 | if (cpu->dsp_num_cores == 0) |
| 281 | return hweight32(cpu_dsp_mask()); |
| 282 | |
| 283 | return cpu->dsp_num_cores; |
| 284 | } |
| 285 | #endif |
| 286 | |
| 287 | /* |
| 288 | * Return the number of PPC cores on this SOC. |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 289 | */ |
Alexander Graf | 5b9e18c | 2014-04-30 19:21:10 +0200 | [diff] [blame] | 290 | __weak int cpu_numcores(void) |
Kim Phillips | 82f576f | 2012-10-29 13:34:37 +0000 | [diff] [blame] | 291 | { |
Simon Glass | a8b5739 | 2012-12-13 20:48:48 +0000 | [diff] [blame] | 292 | struct cpu_type *cpu = gd->arch.cpu; |
Kim Phillips | 875935e | 2010-07-14 19:47:29 -0500 | [diff] [blame] | 293 | |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 294 | /* |
| 295 | * Report # of cores in terms of the cpu_mask if we haven't |
| 296 | * figured out how many there are yet |
| 297 | */ |
| 298 | if (cpu->num_cores == 0) |
| 299 | return hweight32(cpu_mask()); |
Kim Phillips | 875935e | 2010-07-14 19:47:29 -0500 | [diff] [blame] | 300 | |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 301 | return cpu->num_cores; |
| 302 | } |
| 303 | |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 304 | |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 305 | /* |
| 306 | * Check if the given core ID is valid |
| 307 | * |
| 308 | * Returns zero if it isn't, 1 if it is. |
| 309 | */ |
| 310 | int is_core_valid(unsigned int core) |
| 311 | { |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 312 | return !!((1 << core) & cpu_mask()); |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 313 | } |
| 314 | |
Simon Glass | 302445a | 2017-01-23 13:31:22 -0700 | [diff] [blame] | 315 | int arch_cpu_init(void) |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 316 | { |
| 317 | uint svr; |
| 318 | uint ver; |
| 319 | |
| 320 | svr = get_svr(); |
| 321 | ver = SVR_SOC_VER(svr); |
| 322 | |
Simon Glass | a8b5739 | 2012-12-13 20:48:48 +0000 | [diff] [blame] | 323 | gd->arch.cpu = identify_cpu(ver); |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 324 | |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 325 | return 0; |
| 326 | } |
| 327 | |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 328 | /* Once in memory, compute mask & # cores once and save them off */ |
| 329 | int fixup_cpu(void) |
| 330 | { |
Simon Glass | a8b5739 | 2012-12-13 20:48:48 +0000 | [diff] [blame] | 331 | struct cpu_type *cpu = gd->arch.cpu; |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 332 | |
| 333 | if (cpu->num_cores == 0) { |
| 334 | cpu->mask = cpu_mask(); |
| 335 | cpu->num_cores = cpu_numcores(); |
| 336 | } |
| 337 | |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 338 | #ifdef CONFIG_HETROGENOUS_CLUSTERS |
| 339 | if (cpu->dsp_num_cores == 0) { |
| 340 | cpu->dsp_mask = cpu_dsp_mask(); |
| 341 | cpu->dsp_num_cores = cpu_num_dspcores(); |
| 342 | } |
| 343 | #endif |
York Sun | 7b2947f | 2012-08-17 08:20:22 +0000 | [diff] [blame] | 344 | return 0; |
| 345 | } |