]>
Commit | Line | Data |
---|---|---|
80c4b236 JF |
1 | /** @file\r |
2 | CPU Register Table Library functions.\r | |
3 | \r | |
87ad6913 | 4 | Copyright (c) 2017 - 2019, Intel Corporation. All rights reserved.<BR>\r |
0acd8697 | 5 | SPDX-License-Identifier: BSD-2-Clause-Patent\r |
80c4b236 JF |
6 | \r |
7 | **/\r | |
8 | \r | |
9 | #include <PiDxe.h>\r | |
10 | \r | |
11 | #include <Library/UefiBootServicesTableLib.h>\r | |
b3c71b47 | 12 | #include <Library/UefiLib.h>\r |
80c4b236 JF |
13 | \r |
14 | #include "RegisterCpuFeatures.h"\r | |
15 | \r | |
053e878b | 16 | CPU_FEATURES_DATA mCpuFeaturesData = { 0 };\r |
80c4b236 JF |
17 | \r |
18 | /**\r | |
19 | Worker function to get CPU_FEATURES_DATA pointer.\r | |
20 | \r | |
21 | @return Pointer to CPU_FEATURES_DATA.\r | |
22 | **/\r | |
23 | CPU_FEATURES_DATA *\r | |
24 | GetCpuFeaturesData (\r | |
25 | VOID\r | |
26 | )\r | |
27 | {\r | |
28 | return &mCpuFeaturesData;\r | |
29 | }\r | |
30 | \r | |
31 | /**\r | |
32 | Worker function to get EFI_MP_SERVICES_PROTOCOL pointer.\r | |
33 | \r | |
7217b879 | 34 | @return MP_SERVICES variable.\r |
80c4b236 | 35 | **/\r |
7217b879 ED |
36 | MP_SERVICES\r |
37 | GetMpService (\r | |
80c4b236 JF |
38 | VOID\r |
39 | )\r | |
40 | {\r | |
053e878b MK |
41 | EFI_STATUS Status;\r |
42 | MP_SERVICES MpService;\r | |
80c4b236 | 43 | \r |
7217b879 ED |
44 | //\r |
45 | // Get MP Services Protocol\r | |
46 | //\r | |
47 | Status = gBS->LocateProtocol (\r | |
053e878b MK |
48 | &gEfiMpServiceProtocolGuid,\r |
49 | NULL,\r | |
50 | (VOID **)&MpService.Protocol\r | |
51 | );\r | |
7217b879 ED |
52 | ASSERT_EFI_ERROR (Status);\r |
53 | \r | |
54 | return MpService;\r | |
80c4b236 JF |
55 | }\r |
56 | \r | |
57 | /**\r | |
58 | Worker function to return processor index.\r | |
59 | \r | |
7217b879 ED |
60 | @param CpuFeaturesData Cpu Feature Data structure.\r |
61 | \r | |
80c4b236 JF |
62 | @return The processor index.\r |
63 | **/\r | |
64 | UINTN\r | |
65 | GetProcessorIndex (\r | |
053e878b | 66 | IN CPU_FEATURES_DATA *CpuFeaturesData\r |
80c4b236 JF |
67 | )\r |
68 | {\r | |
053e878b MK |
69 | EFI_STATUS Status;\r |
70 | UINTN ProcessorIndex;\r | |
71 | EFI_MP_SERVICES_PROTOCOL *MpServices;\r | |
80c4b236 | 72 | \r |
7217b879 | 73 | MpServices = CpuFeaturesData->MpService.Protocol;\r |
053e878b | 74 | Status = MpServices->WhoAmI (MpServices, &ProcessorIndex);\r |
80c4b236 JF |
75 | ASSERT_EFI_ERROR (Status);\r |
76 | return ProcessorIndex;\r | |
77 | }\r | |
78 | \r | |
79 | /**\r | |
80 | Gets detailed MP-related information on the requested processor at the\r | |
81 | instant this call is made.\r | |
82 | \r | |
83 | @param[in] ProcessorNumber The handle number of processor.\r | |
84 | @param[out] ProcessorInfoBuffer A pointer to the buffer where information for\r | |
85 | the requested processor is deposited.\r | |
86 | \r | |
87 | @return Status of MpServices->GetProcessorInfo().\r | |
88 | **/\r | |
89 | EFI_STATUS\r | |
90 | GetProcessorInformation (\r | |
053e878b MK |
91 | IN UINTN ProcessorNumber,\r |
92 | OUT EFI_PROCESSOR_INFORMATION *ProcessorInfoBuffer\r | |
80c4b236 JF |
93 | )\r |
94 | {\r | |
053e878b MK |
95 | EFI_STATUS Status;\r |
96 | EFI_MP_SERVICES_PROTOCOL *MpServices;\r | |
97 | CPU_FEATURES_DATA *CpuFeaturesData;\r | |
7217b879 ED |
98 | \r |
99 | CpuFeaturesData = GetCpuFeaturesData ();\r | |
053e878b | 100 | MpServices = CpuFeaturesData->MpService.Protocol;\r |
80c4b236 | 101 | \r |
80c4b236 | 102 | Status = MpServices->GetProcessorInfo (\r |
053e878b MK |
103 | MpServices,\r |
104 | ProcessorNumber,\r | |
105 | ProcessorInfoBuffer\r | |
106 | );\r | |
80c4b236 JF |
107 | return Status;\r |
108 | }\r | |
109 | \r | |
110 | /**\r | |
111 | Worker function to execute a caller provided function on all enabled APs.\r | |
112 | \r | |
113 | @param[in] Procedure A pointer to the function to be run on\r | |
114 | enabled APs of the system.\r | |
b3c71b47 ED |
115 | @param[in] MpEvent A pointer to the event to be used later\r |
116 | to check whether procedure has done.\r | |
80c4b236 JF |
117 | **/\r |
118 | VOID\r | |
87ad6913 | 119 | StartupAllAPsWorker (\r |
053e878b MK |
120 | IN EFI_AP_PROCEDURE Procedure,\r |
121 | IN EFI_EVENT MpEvent\r | |
80c4b236 JF |
122 | )\r |
123 | {\r | |
053e878b MK |
124 | EFI_STATUS Status;\r |
125 | EFI_MP_SERVICES_PROTOCOL *MpServices;\r | |
126 | CPU_FEATURES_DATA *CpuFeaturesData;\r | |
b3c71b47 ED |
127 | \r |
128 | CpuFeaturesData = GetCpuFeaturesData ();\r | |
053e878b | 129 | MpServices = CpuFeaturesData->MpService.Protocol;\r |
80c4b236 | 130 | \r |
80c4b236 JF |
131 | //\r |
132 | // Wakeup all APs\r | |
133 | //\r | |
134 | Status = MpServices->StartupAllAPs (\r | |
053e878b MK |
135 | MpServices,\r |
136 | Procedure,\r | |
137 | FALSE,\r | |
138 | MpEvent,\r | |
139 | 0,\r | |
140 | CpuFeaturesData,\r | |
141 | NULL\r | |
142 | );\r | |
80c4b236 JF |
143 | ASSERT_EFI_ERROR (Status);\r |
144 | }\r | |
145 | \r | |
146 | /**\r | |
147 | Worker function to switch the requested AP to be the BSP from that point onward.\r | |
148 | \r | |
149 | @param[in] ProcessorNumber The handle number of AP that is to become the new BSP.\r | |
150 | **/\r | |
151 | VOID\r | |
152 | SwitchNewBsp (\r | |
053e878b | 153 | IN UINTN ProcessorNumber\r |
80c4b236 JF |
154 | )\r |
155 | {\r | |
053e878b MK |
156 | EFI_STATUS Status;\r |
157 | EFI_MP_SERVICES_PROTOCOL *MpServices;\r | |
158 | CPU_FEATURES_DATA *CpuFeaturesData;\r | |
7217b879 ED |
159 | \r |
160 | CpuFeaturesData = GetCpuFeaturesData ();\r | |
053e878b | 161 | MpServices = CpuFeaturesData->MpService.Protocol;\r |
80c4b236 | 162 | \r |
80c4b236 JF |
163 | //\r |
164 | // Wakeup all APs\r | |
165 | //\r | |
166 | Status = MpServices->SwitchBSP (\r | |
053e878b MK |
167 | MpServices,\r |
168 | ProcessorNumber,\r | |
169 | TRUE\r | |
170 | );\r | |
80c4b236 JF |
171 | ASSERT_EFI_ERROR (Status);\r |
172 | }\r | |
173 | \r | |
174 | /**\r | |
175 | Worker function to retrieve the number of logical processor in the platform.\r | |
176 | \r | |
177 | @param[out] NumberOfCpus Pointer to the total number of logical\r | |
178 | processors in the system, including the BSP\r | |
179 | and disabled APs.\r | |
180 | @param[out] NumberOfEnabledProcessors Pointer to the number of enabled logical\r | |
181 | processors that exist in system, including\r | |
182 | the BSP.\r | |
183 | **/\r | |
184 | VOID\r | |
185 | GetNumberOfProcessor (\r | |
053e878b MK |
186 | OUT UINTN *NumberOfCpus,\r |
187 | OUT UINTN *NumberOfEnabledProcessors\r | |
80c4b236 JF |
188 | )\r |
189 | {\r | |
053e878b MK |
190 | EFI_STATUS Status;\r |
191 | EFI_MP_SERVICES_PROTOCOL *MpServices;\r | |
192 | CPU_FEATURES_DATA *CpuFeaturesData;\r | |
80c4b236 | 193 | \r |
7217b879 | 194 | CpuFeaturesData = GetCpuFeaturesData ();\r |
053e878b | 195 | MpServices = CpuFeaturesData->MpService.Protocol;\r |
80c4b236 JF |
196 | \r |
197 | //\r | |
198 | // Get the number of CPUs\r | |
199 | //\r | |
200 | Status = MpServices->GetNumberOfProcessors (\r | |
201 | MpServices,\r | |
202 | NumberOfCpus,\r | |
203 | NumberOfEnabledProcessors\r | |
204 | );\r | |
205 | ASSERT_EFI_ERROR (Status);\r | |
206 | }\r | |
207 | \r | |
b3c71b47 ED |
208 | /**\r |
209 | Performs CPU features Initialization.\r | |
210 | \r | |
211 | This service will invoke MP service to perform CPU features\r | |
212 | initialization on BSP/APs per user configuration.\r | |
213 | \r | |
214 | @note This service could be called by BSP only.\r | |
215 | **/\r | |
216 | VOID\r | |
217 | EFIAPI\r | |
218 | CpuFeaturesInitialize (\r | |
219 | VOID\r | |
220 | )\r | |
221 | {\r | |
053e878b MK |
222 | CPU_FEATURES_DATA *CpuFeaturesData;\r |
223 | UINTN OldBspNumber;\r | |
224 | EFI_EVENT MpEvent;\r | |
225 | EFI_STATUS Status;\r | |
b3c71b47 ED |
226 | \r |
227 | CpuFeaturesData = GetCpuFeaturesData ();\r | |
228 | \r | |
053e878b | 229 | OldBspNumber = GetProcessorIndex (CpuFeaturesData);\r |
b3c71b47 ED |
230 | CpuFeaturesData->BspNumber = OldBspNumber;\r |
231 | \r | |
04dd0cb9 SZ |
232 | //\r |
233 | //\r | |
234 | // Initialize MpEvent to suppress incorrect compiler/analyzer warnings.\r | |
235 | //\r | |
236 | MpEvent = NULL;\r | |
237 | \r | |
7a0df266 SZ |
238 | if (CpuFeaturesData->NumberOfCpus > 1) {\r |
239 | Status = gBS->CreateEvent (\r | |
240 | EVT_NOTIFY_WAIT,\r | |
241 | TPL_CALLBACK,\r | |
242 | EfiEventEmptyFunction,\r | |
243 | NULL,\r | |
244 | &MpEvent\r | |
245 | );\r | |
246 | ASSERT_EFI_ERROR (Status);\r | |
247 | \r | |
248 | //\r | |
249 | // Wakeup all APs for programming.\r | |
250 | //\r | |
87ad6913 | 251 | StartupAllAPsWorker (SetProcessorRegister, MpEvent);\r |
7a0df266 | 252 | }\r |
b3c71b47 | 253 | \r |
b3c71b47 ED |
254 | //\r |
255 | // Programming BSP\r | |
256 | //\r | |
257 | SetProcessorRegister (CpuFeaturesData);\r | |
258 | \r | |
7a0df266 SZ |
259 | if (CpuFeaturesData->NumberOfCpus > 1) {\r |
260 | //\r | |
261 | // Wait all processors to finish the task.\r | |
262 | //\r | |
263 | do {\r | |
264 | Status = gBS->CheckEvent (MpEvent);\r | |
265 | } while (Status == EFI_NOT_READY);\r | |
053e878b | 266 | \r |
7a0df266 SZ |
267 | ASSERT_EFI_ERROR (Status);\r |
268 | }\r | |
b3c71b47 ED |
269 | \r |
270 | //\r | |
271 | // Switch to new BSP if required\r | |
272 | //\r | |
273 | if (CpuFeaturesData->BspNumber != OldBspNumber) {\r | |
274 | SwitchNewBsp (CpuFeaturesData->BspNumber);\r | |
275 | }\r | |
276 | }\r |