]>
Commit | Line | Data |
---|---|---|
5d73d92f | 1 | /** @file\r |
2 | Main file for Mm shell Debug1 function.\r | |
3 | \r | |
4 | Copyright (c) 2005 - 2010, Intel Corporation. All rights reserved.<BR>\r | |
5 | This program and the accompanying materials\r | |
6 | are licensed and made available under the terms and conditions of the BSD License\r | |
7 | which accompanies this distribution. The full text of the license may be found at\r | |
8 | http://opensource.org/licenses/bsd-license.php\r | |
9 | \r | |
10 | THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r | |
11 | WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r | |
12 | \r | |
13 | **/\r | |
14 | \r | |
15 | #include "UefiShellDebug1CommandsLib.h"\r | |
16 | #include <Library/ShellLib.h>\r | |
17 | #include <Protocol/PciRootBridgeIo.h>\r | |
18 | #include <Protocol/DeviceIo.h>\r | |
19 | \r | |
20 | typedef enum {\r | |
21 | EfiMemory,\r | |
22 | EFIMemoryMappedIo,\r | |
23 | EfiIo,\r | |
24 | EfiPciConfig,\r | |
25 | EfiPciEConfig\r | |
26 | } EFI_ACCESS_TYPE;\r | |
27 | \r | |
28 | EFI_STATUS\r | |
29 | EFIAPI\r | |
30 | DumpIoModify (\r | |
31 | IN EFI_HANDLE ImageHandle,\r | |
32 | IN EFI_SYSTEM_TABLE *SystemTable\r | |
33 | );\r | |
34 | \r | |
35 | VOID\r | |
36 | EFIAPI\r | |
37 | ReadMem (\r | |
38 | IN EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH Width,\r | |
39 | IN UINT64 Address,\r | |
40 | IN UINTN Size,\r | |
41 | IN VOID *Buffer\r | |
42 | );\r | |
43 | \r | |
44 | VOID\r | |
45 | EFIAPI\r | |
46 | WriteMem (\r | |
47 | IN EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH Width,\r | |
48 | IN UINT64 Address,\r | |
49 | IN UINTN Size,\r | |
50 | IN VOID *Buffer\r | |
51 | );\r | |
52 | \r | |
53 | BOOLEAN\r | |
54 | EFIAPI\r | |
55 | GetHex (\r | |
56 | IN UINT16 *str,\r | |
57 | OUT UINT64 *data\r | |
58 | );\r | |
59 | \r | |
60 | STATIC CONST SHELL_PARAM_ITEM ParamList[] = {\r | |
61 | {L"-mmio", TypeFlag},\r | |
62 | {L"-mem", TypeFlag},\r | |
63 | {L"-io", TypeFlag},\r | |
64 | {L"-pci", TypeFlag},\r | |
65 | {L"-pcie", TypeFlag},\r | |
66 | {L"-n", TypeFlag},\r | |
67 | {L"-w", TypeValue},\r | |
68 | {NULL, TypeMax}\r | |
69 | };\r | |
70 | \r | |
71 | STATIC CONST UINT64 MaxNum[9] = { 0xff, 0xffff, 0xffffffff, 0xffffffffffffffff };\r | |
72 | \r | |
73 | /**\r | |
74 | Get the PCI-E Address from a PCI address format 0x0000ssbbddffrrr\r | |
75 | where ss is SEGMENT, bb is BUS, dd is DEVICE, ff is FUNCTION\r | |
76 | and rrr is REGISTER (extension format for PCI-E).\r | |
77 | \r | |
78 | @param[in] InputAddress PCI address format on input.\r | |
79 | @param[out]PciEAddress PCI-E address extention format.\r | |
80 | **/\r | |
81 | VOID\r | |
82 | EFIAPI\r | |
83 | GetPciEAddressFromInputAddress (\r | |
84 | IN UINT64 InputAddress,\r | |
85 | OUT UINT64 *PciEAddress\r | |
86 | )\r | |
87 | {\r | |
88 | *PciEAddress = RShiftU64(InputAddress & ~(UINT64) 0xFFF, 4);\r | |
89 | *PciEAddress += LShiftU64((UINT16) InputAddress & 0x0FFF, 32);\r | |
90 | }\r | |
91 | \r | |
92 | /**\r | |
93 | Function for 'mm' command.\r | |
94 | \r | |
95 | @param[in] ImageHandle Handle to the Image (NULL if Internal).\r | |
96 | @param[in] SystemTable Pointer to the System Table (NULL if Internal).\r | |
97 | **/\r | |
98 | SHELL_STATUS\r | |
99 | EFIAPI\r | |
100 | ShellCommandRunMm (\r | |
101 | IN EFI_HANDLE ImageHandle,\r | |
102 | IN EFI_SYSTEM_TABLE *SystemTable\r | |
103 | )\r | |
104 | {\r | |
105 | EFI_STATUS Status;\r | |
106 | EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL *IoDev;\r | |
107 | UINT64 Address;\r | |
108 | UINT64 PciEAddress;\r | |
109 | UINT64 Value;\r | |
110 | UINT32 SegmentNumber;\r | |
111 | EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH Width;\r | |
112 | EFI_ACCESS_TYPE AccessType;\r | |
113 | UINT64 Buffer;\r | |
114 | UINTN Index;\r | |
115 | UINTN Size;\r | |
116 | CHAR16 *AddressStr;\r | |
117 | // CHAR16 *ValueStr;\r | |
118 | BOOLEAN Complete;\r | |
119 | CHAR16 *InputStr;\r | |
120 | BOOLEAN Interactive;\r | |
121 | EFI_HANDLE *HandleBuffer;\r | |
122 | UINTN BufferSize;\r | |
123 | UINTN ItemValue;\r | |
124 | LIST_ENTRY *Package;\r | |
125 | CHAR16 *ProblemParam;\r | |
126 | SHELL_STATUS ShellStatus;\r | |
127 | CONST CHAR16 *Temp;\r | |
128 | \r | |
129 | Address = 0;\r | |
130 | PciEAddress = 0;\r | |
131 | IoDev = NULL;\r | |
132 | HandleBuffer = NULL;\r | |
133 | BufferSize = 0;\r | |
134 | SegmentNumber = 0;\r | |
135 | ShellStatus = SHELL_SUCCESS;\r | |
136 | InputStr = NULL;\r | |
137 | \r | |
138 | //\r | |
139 | // Parse arguments\r | |
140 | //\r | |
141 | Width = EfiPciWidthUint8;\r | |
142 | Size = 1;\r | |
143 | AccessType = EfiMemory;\r | |
144 | AddressStr = NULL;\r | |
145 | // ValueStr = NULL;\r | |
146 | Interactive = TRUE;\r | |
147 | Package = NULL;\r | |
148 | \r | |
149 | Status = ShellCommandLineParse (ParamList, &Package, &ProblemParam, TRUE);\r | |
150 | if (EFI_ERROR(Status)) {\r | |
151 | if (Status == EFI_VOLUME_CORRUPTED && ProblemParam != NULL) {\r | |
152 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_GEN_PROBLEM), gShellDebug1HiiHandle, ProblemParam);\r | |
153 | FreePool(ProblemParam);\r | |
154 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
155 | goto Done;\r | |
156 | } else {\r | |
157 | ASSERT(FALSE);\r | |
158 | }\r | |
159 | } else {\r | |
160 | if (ShellCommandLineGetCount(Package) < 1) {\r | |
161 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_GEN_TOO_FEW), gShellDebug1HiiHandle);\r | |
162 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
163 | goto Done;\r | |
164 | } else if (ShellCommandLineGetCount(Package) > 3) {\r | |
165 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_GEN_TOO_MANY), gShellDebug1HiiHandle);\r | |
166 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
167 | goto Done;\r | |
168 | } else {\r | |
169 | if (ShellCommandLineGetFlag(Package, L"-mmio")) {\r | |
170 | AccessType = EFIMemoryMappedIo;\r | |
171 | } else if (ShellCommandLineGetFlag(Package, L"-mem")) {\r | |
172 | AccessType = EfiMemory;\r | |
173 | } else if (ShellCommandLineGetFlag(Package, L"-io")) {\r | |
174 | AccessType = EfiIo;\r | |
175 | } else if (ShellCommandLineGetFlag(Package, L"-pci")) {\r | |
176 | AccessType = EfiPciConfig;\r | |
177 | } else if (ShellCommandLineGetFlag(Package, L"-pcie")) {\r | |
178 | AccessType = EfiPciEConfig;\r | |
179 | }\r | |
180 | }\r | |
181 | \r | |
182 | if (ShellCommandLineGetFlag (Package, L"-n")) {\r | |
183 | Interactive = FALSE;\r | |
184 | }\r | |
185 | \r | |
186 | Temp = ShellCommandLineGetValue(Package, L"-w");\r | |
187 | if (Temp != NULL) {\r | |
188 | ItemValue = StrDecimalToUintn (Temp);\r | |
189 | \r | |
190 | switch (ItemValue) {\r | |
191 | case 1:\r | |
192 | Width = EfiPciWidthUint8;\r | |
193 | Size = 1;\r | |
194 | break;\r | |
195 | \r | |
196 | case 2:\r | |
197 | Width = EfiPciWidthUint16;\r | |
198 | Size = 2;\r | |
199 | break;\r | |
200 | \r | |
201 | case 4:\r | |
202 | Width = EfiPciWidthUint32;\r | |
203 | Size = 4;\r | |
204 | break;\r | |
205 | \r | |
206 | case 8:\r | |
207 | Width = EfiPciWidthUint64;\r | |
208 | Size = 8;\r | |
209 | break;\r | |
210 | \r | |
211 | default:\r | |
212 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_GEN_PROBLEM), gShellDebug1HiiHandle, L"-w");\r | |
213 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
214 | goto Done;\r | |
215 | }\r | |
216 | }\r | |
217 | \r | |
218 | Temp = ShellCommandLineGetRawValue(Package, 1);\r | |
219 | if (Temp != NULL) {\r | |
220 | Address = StrHexToUint64(Temp);\r | |
221 | }\r | |
222 | \r | |
223 | Temp = ShellCommandLineGetRawValue(Package, 2);\r | |
224 | if (Temp != NULL) {\r | |
225 | Value = StrHexToUint64(Temp);\r | |
226 | switch (Size) {\r | |
227 | case 1:\r | |
228 | if (Value > 0xFF) {\r | |
229 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
230 | }\r | |
231 | break;\r | |
232 | \r | |
233 | case 2:\r | |
234 | if (Value > 0xFFFF) {\r | |
235 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
236 | }\r | |
237 | break;\r | |
238 | \r | |
239 | case 4:\r | |
240 | if (Value > 0xFFFFFFFF) {\r | |
241 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
242 | }\r | |
243 | break;\r | |
244 | \r | |
245 | default:\r | |
246 | break;\r | |
247 | }\r | |
248 | \r | |
249 | if (ShellStatus != SHELL_SUCCESS) {\r | |
250 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_GEN_PROBLEM), gShellDebug1HiiHandle, Temp);\r | |
251 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
252 | goto Done;\r | |
253 | }\r | |
254 | }\r | |
255 | \r | |
256 | if ((Address & (Size - 1)) != 0) {\r | |
257 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_NOT_ALIGNED), gShellDebug1HiiHandle, Address);\r | |
258 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
259 | goto Done;\r | |
260 | }\r | |
261 | //\r | |
262 | // locate DeviceIO protocol interface\r | |
263 | //\r | |
264 | if (AccessType != EfiMemory) {\r | |
265 | Status = gBS->LocateHandleBuffer (\r | |
266 | ByProtocol,\r | |
267 | &gEfiPciRootBridgeIoProtocolGuid,\r | |
268 | NULL,\r | |
269 | &BufferSize,\r | |
270 | &HandleBuffer\r | |
271 | );\r | |
272 | if (EFI_ERROR (Status)) {\r | |
273 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_GEN_PCIRBIO_NF), gShellDebug1HiiHandle);\r | |
274 | ShellStatus = SHELL_NOT_FOUND;\r | |
275 | goto Done;\r | |
276 | }\r | |
277 | //\r | |
278 | // In the case of PCI or PCIE\r | |
279 | // Get segment number and mask the segment bits in Address\r | |
280 | //\r | |
281 | if (AccessType == EfiPciEConfig) {\r | |
282 | SegmentNumber = (UINT32) RShiftU64 (Address, 36) & 0xff;\r | |
283 | Address &= 0xfffffffff;\r | |
284 | } else {\r | |
285 | if (AccessType == EfiPciConfig) {\r | |
286 | SegmentNumber = (UINT32) RShiftU64 (Address, 32) & 0xff;\r | |
287 | Address &= 0xffffffff;\r | |
288 | }\r | |
289 | }\r | |
290 | //\r | |
291 | // Find the EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL of the specified segment number\r | |
292 | //\r | |
293 | for (Index = 0; Index < BufferSize; Index++) {\r | |
294 | Status = gBS->HandleProtocol (\r | |
295 | HandleBuffer[Index],\r | |
296 | &gEfiPciRootBridgeIoProtocolGuid,\r | |
297 | (VOID *) &IoDev\r | |
298 | );\r | |
299 | if (EFI_ERROR (Status)) {\r | |
300 | continue;\r | |
301 | }\r | |
302 | if (IoDev->SegmentNumber != SegmentNumber) {\r | |
303 | IoDev = NULL;\r | |
304 | }\r | |
305 | }\r | |
306 | if (IoDev == NULL) {\r | |
307 | // TODO add token\r | |
308 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_SEGMENT_NOT_FOUND), gShellDebug1HiiHandle, SegmentNumber);\r | |
309 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
310 | goto Done;\r | |
311 | }\r | |
312 | }\r | |
313 | \r | |
314 | if (AccessType == EfiIo && Address + Size > 0x10000) {\r | |
315 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_ADDRESS_RANGE), gShellDebug1HiiHandle);\r | |
316 | ShellStatus = SHELL_INVALID_PARAMETER;\r | |
317 | goto Done;\r | |
318 | }\r | |
319 | \r | |
320 | if (AccessType == EfiPciEConfig) {\r | |
321 | GetPciEAddressFromInputAddress (Address, &PciEAddress);\r | |
322 | }\r | |
323 | \r | |
324 | // //\r | |
325 | // // Set value\r | |
326 | // //\r | |
327 | // if (ValueStr != NULL) {\r | |
328 | // if (AccessType == EFIMemoryMappedIo) {\r | |
329 | // IoDev->Mem.Write (IoDev, Width, Address, 1, &Value);\r | |
330 | // } else if (AccessType == EfiIo) {\r | |
331 | // IoDev->Io.Write (IoDev, Width, Address, 1, &Value);\r | |
332 | // } else if (AccessType == EfiPciConfig) {\r | |
333 | // IoDev->Pci.Write (IoDev, Width, Address, 1, &Value);\r | |
334 | // } else if (AccessType == EfiPciEConfig) {\r | |
335 | // IoDev->Pci.Write (IoDev, Width, PciEAddress, 1, &Buffer);\r | |
336 | // } else {\r | |
337 | // WriteMem (Width, Address, 1, &Value);\r | |
338 | // }\r | |
339 | //\r | |
340 | // ASSERT(ShellStatus == SHELL_SUCCESS);\r | |
341 | // goto Done;\r | |
342 | // }\r | |
343 | \r | |
344 | \r | |
345 | //\r | |
346 | // non-interactive mode\r | |
347 | //\r | |
348 | if (!Interactive) {\r | |
349 | Buffer = 0;\r | |
350 | if (AccessType == EFIMemoryMappedIo) {\r | |
351 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_MMIO), gShellDebug1HiiHandle);\r | |
352 | IoDev->Mem.Read (IoDev, Width, Address, 1, &Buffer);\r | |
353 | } else if (AccessType == EfiIo) {\r | |
354 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_IO), gShellDebug1HiiHandle);\r | |
355 | IoDev->Io.Read (IoDev, Width, Address, 1, &Buffer);\r | |
356 | } else if (AccessType == EfiPciConfig) {\r | |
357 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_PCI), gShellDebug1HiiHandle);\r | |
358 | IoDev->Pci.Read (IoDev, Width, Address, 1, &Buffer);\r | |
359 | } else if (AccessType == EfiPciEConfig) {\r | |
360 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_PCIE), gShellDebug1HiiHandle);\r | |
361 | IoDev->Pci.Read (IoDev, Width, PciEAddress, 1, &Buffer);\r | |
362 | } else {\r | |
363 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_MEM), gShellDebug1HiiHandle);\r | |
364 | ReadMem (Width, Address, 1, &Buffer);\r | |
365 | }\r | |
366 | \r | |
367 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_ADDRESS), gShellDebug1HiiHandle, Address);\r | |
368 | if (Size == 1) {\r | |
369 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_BUF2), gShellDebug1HiiHandle, Buffer);\r | |
370 | } else if (Size == 2) {\r | |
371 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_BUF4), gShellDebug1HiiHandle, Buffer);\r | |
372 | } else if (Size == 4) {\r | |
373 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_BUF8), gShellDebug1HiiHandle, Buffer);\r | |
374 | } else if (Size == 8) {\r | |
375 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_BUF16), gShellDebug1HiiHandle, Buffer);\r | |
376 | }\r | |
377 | \r | |
378 | ShellPrintEx(-1, -1, L"\r\n");\r | |
379 | \r | |
380 | ASSERT(ShellStatus == SHELL_SUCCESS);\r | |
381 | goto Done;\r | |
382 | }\r | |
383 | //\r | |
384 | // interactive mode\r | |
385 | //\r | |
386 | Complete = FALSE;\r | |
387 | do {\r | |
388 | if (AccessType == EfiIo && Address + Size > 0x10000) {\r | |
389 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_ADDRESS_RANGE2), gShellDebug1HiiHandle);\r | |
390 | // PrintToken (STRING_TOKEN (STR_IOMOD_IO_ADDRESS_2), HiiHandle, L"mm");\r | |
391 | break;\r | |
392 | }\r | |
393 | \r | |
394 | Buffer = 0;\r | |
395 | if (AccessType == EFIMemoryMappedIo) {\r | |
396 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_MMIO), gShellDebug1HiiHandle);\r | |
397 | // PrintToken (STRING_TOKEN (STR_IOMOD_HMMIO), HiiHandle);\r | |
398 | IoDev->Mem.Read (IoDev, Width, Address, 1, &Buffer);\r | |
399 | } else if (AccessType == EfiIo) {\r | |
400 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_IO), gShellDebug1HiiHandle);\r | |
401 | // PrintToken (STRING_TOKEN (STR_IOMOD_HIO), HiiHandle);\r | |
402 | IoDev->Io.Read (IoDev, Width, Address, 1, &Buffer);\r | |
403 | } else if (AccessType == EfiPciConfig) {\r | |
404 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_PCI), gShellDebug1HiiHandle);\r | |
405 | // PrintToken (STRING_TOKEN (STR_IOMOD_HPCI), HiiHandle);\r | |
406 | IoDev->Pci.Read (IoDev, Width, Address, 1, &Buffer);\r | |
407 | } else if (AccessType == EfiPciEConfig) {\r | |
408 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_PCIE), gShellDebug1HiiHandle);\r | |
409 | // PrintToken (STRING_TOKEN (STR_IOMOD_HPCIE), HiiHandle);\r | |
410 | IoDev->Pci.Read (IoDev, Width, PciEAddress, 1, &Buffer);\r | |
411 | } else {\r | |
412 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_MEM), gShellDebug1HiiHandle);\r | |
413 | // PrintToken (STRING_TOKEN (STR_IOMOD_HMEM), HiiHandle);\r | |
414 | ReadMem (Width, Address, 1, &Buffer);\r | |
415 | }\r | |
416 | \r | |
417 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_ADDRESS), gShellDebug1HiiHandle, Address);\r | |
418 | // PrintToken (STRING_TOKEN (STR_IOMOD_ADDRESS), HiiHandle, Address);\r | |
419 | \r | |
420 | if (Size == 1) {\r | |
421 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_BUF2), gShellDebug1HiiHandle, Buffer);\r | |
422 | // PrintToken (STRING_TOKEN (STR_IOMOD_BUFFER_2), HiiHandle, Buffer);\r | |
423 | } else if (Size == 2) {\r | |
424 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_BUF4), gShellDebug1HiiHandle, Buffer);\r | |
425 | // PrintToken (STRING_TOKEN (STR_IOMOD_BUFFER_4), HiiHandle, Buffer);\r | |
426 | } else if (Size == 4) {\r | |
427 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_BUF8), gShellDebug1HiiHandle, Buffer);\r | |
428 | // PrintToken (STRING_TOKEN (STR_IOMOD_BUFFER_8), HiiHandle, Buffer);\r | |
429 | } else if (Size == 8) {\r | |
430 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_BUF16), gShellDebug1HiiHandle, Buffer);\r | |
431 | // PrintToken (STRING_TOKEN (STR_IOMOD_BUFFER_16), HiiHandle, Buffer);\r | |
432 | }\r | |
433 | //\r | |
434 | // wait user input to modify\r | |
435 | //\r | |
436 | if (InputStr != NULL) {\r | |
437 | FreePool(InputStr);\r | |
438 | }\r | |
439 | ShellPromptForResponse(ShellPromptResponseTypeFreeform, NULL, (VOID**)&InputStr);\r | |
440 | \r | |
441 | //\r | |
442 | // skip space characters\r | |
443 | //\r | |
444 | for (Index = 0; InputStr[Index] == ' '; Index++);\r | |
445 | \r | |
446 | //\r | |
447 | // parse input string\r | |
448 | //\r | |
449 | if (InputStr[Index] == '.' || InputStr[Index] == 'q' || InputStr[Index] == 'Q') {\r | |
450 | Complete = TRUE;\r | |
451 | } else if (InputStr[Index] == CHAR_NULL) {\r | |
452 | //\r | |
453 | // Continue to next address\r | |
454 | //\r | |
455 | } else if (GetHex (InputStr + Index, &Buffer) && Buffer <= MaxNum[Width]) {\r | |
456 | if (AccessType == EFIMemoryMappedIo) {\r | |
457 | IoDev->Mem.Write (IoDev, Width, Address, 1, &Buffer);\r | |
458 | } else if (AccessType == EfiIo) {\r | |
459 | IoDev->Io.Write (IoDev, Width, Address, 1, &Buffer);\r | |
460 | } else if (AccessType == EfiPciConfig) {\r | |
461 | IoDev->Pci.Write (IoDev, Width, Address, 1, &Buffer);\r | |
462 | } else if (AccessType == EfiPciEConfig) {\r | |
463 | IoDev->Pci.Write (IoDev, Width, PciEAddress, 1, &Buffer);\r | |
464 | } else {\r | |
465 | WriteMem (Width, Address, 1, &Buffer);\r | |
466 | }\r | |
467 | } else {\r | |
468 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_ERROR), gShellDebug1HiiHandle);\r | |
469 | // PrintToken (STRING_TOKEN (STR_IOMOD_ERROR), HiiHandle);\r | |
470 | continue;\r | |
471 | }\r | |
472 | \r | |
473 | Address += Size;\r | |
474 | if (AccessType == EfiPciEConfig) {\r | |
475 | GetPciEAddressFromInputAddress (Address, &PciEAddress);\r | |
476 | }\r | |
477 | ShellPrintEx(-1, -1, L"\r\n");\r | |
478 | // Print (L"\n");\r | |
479 | } while (!Complete);\r | |
480 | }\r | |
481 | ASSERT(ShellStatus == SHELL_SUCCESS);\r | |
482 | Done:\r | |
483 | \r | |
484 | if (InputStr != NULL) {\r | |
485 | FreePool(InputStr);\r | |
486 | }\r | |
487 | if (HandleBuffer != NULL) {\r | |
488 | FreePool (HandleBuffer);\r | |
489 | }\r | |
490 | if (Package != NULL) {\r | |
491 | ShellCommandLineFreeVarList (Package);\r | |
492 | }\r | |
493 | return ShellStatus;\r | |
494 | }\r | |
495 | \r | |
496 | \r | |
497 | VOID\r | |
498 | EFIAPI\r | |
499 | ReadMem (\r | |
500 | IN EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH Width,\r | |
501 | IN UINT64 Address,\r | |
502 | IN UINTN Size,\r | |
503 | IN VOID *Buffer\r | |
504 | )\r | |
505 | {\r | |
506 | do {\r | |
507 | if (Width == EfiPciWidthUint8) {\r | |
508 | *(UINT8 *) Buffer = *(UINT8 *) (UINTN) Address;\r | |
509 | Address -= 1;\r | |
510 | } else if (Width == EfiPciWidthUint16) {\r | |
511 | *(UINT16 *) Buffer = *(UINT16 *) (UINTN) Address;\r | |
512 | Address -= 2;\r | |
513 | } else if (Width == EfiPciWidthUint32) {\r | |
514 | *(UINT32 *) Buffer = *(UINT32 *) (UINTN) Address;\r | |
515 | Address -= 4;\r | |
516 | } else if (Width == EfiPciWidthUint64) {\r | |
517 | *(UINT64 *) Buffer = *(UINT64 *) (UINTN) Address;\r | |
518 | Address -= 8;\r | |
519 | } else {\r | |
520 | ShellPrintHiiEx(-1, -1, NULL, STRING_TOKEN (STR_MM_READ_ERROR), gShellDebug1HiiHandle);\r | |
521 | // PrintToken (STRING_TOKEN (STR_IOMOD_READ_MEM_ERROR), HiiHandle);\r | |
522 | break;\r | |
523 | }\r | |
524 | //\r | |
525 | //\r | |
526 | //\r | |
527 | Size--;\r | |
528 | } while (Size > 0);\r | |
529 | }\r | |
530 | \r | |
531 | VOID\r | |
532 | EFIAPI\r | |
533 | WriteMem (\r | |
534 | IN EFI_PCI_ROOT_BRIDGE_IO_PROTOCOL_WIDTH Width,\r | |
535 | IN UINT64 Address,\r | |
536 | IN UINTN Size,\r | |
537 | IN VOID *Buffer\r | |
538 | )\r | |
539 | {\r | |
540 | do {\r | |
541 | if (Width == EfiPciWidthUint8) {\r | |
542 | *(UINT8 *) (UINTN) Address = *(UINT8 *) Buffer;\r | |
543 | Address += 1;\r | |
544 | } else if (Width == EfiPciWidthUint16) {\r | |
545 | *(UINT16 *) (UINTN) Address = *(UINT16 *) Buffer;\r | |
546 | Address += 2;\r | |
547 | } else if (Width == EfiPciWidthUint32) {\r | |
548 | *(UINT32 *) (UINTN) Address = *(UINT32 *) Buffer;\r | |
549 | Address += 4;\r | |
550 | } else if (Width == EfiPciWidthUint64) {\r | |
551 | *(UINT64 *) (UINTN) Address = *(UINT64 *) Buffer;\r | |
552 | Address += 8;\r | |
553 | } else {\r | |
554 | ASSERT (FALSE);\r | |
555 | }\r | |
556 | //\r | |
557 | //\r | |
558 | //\r | |
559 | Size--;\r | |
560 | } while (Size > 0);\r | |
561 | }\r | |
562 | \r | |
563 | BOOLEAN\r | |
564 | EFIAPI\r | |
565 | GetHex (\r | |
566 | IN UINT16 *str,\r | |
567 | OUT UINT64 *data\r | |
568 | )\r | |
569 | {\r | |
570 | UINTN u;\r | |
571 | CHAR16 c;\r | |
572 | BOOLEAN Find;\r | |
573 | \r | |
574 | Find = FALSE;\r | |
575 | //\r | |
576 | // convert hex digits\r | |
577 | //\r | |
578 | u = 0;\r | |
579 | c = *(str++);\r | |
580 | while (c != CHAR_NULL) {\r | |
581 | if (c >= 'a' && c <= 'f') {\r | |
582 | c -= 'a' - 'A';\r | |
583 | }\r | |
584 | \r | |
585 | if (c == ' ') {\r | |
586 | break;\r | |
587 | }\r | |
588 | \r | |
589 | if ((c >= '0' && c <= '9') || (c >= 'A' && c <= 'F')) {\r | |
590 | u = u << 4 | c - (c >= 'A' ? 'A' - 10 : '0');\r | |
591 | \r | |
592 | Find = TRUE;\r | |
593 | } else {\r | |
594 | return FALSE;\r | |
595 | }\r | |
596 | \r | |
597 | c = *(str++);\r | |
598 | }\r | |
599 | \r | |
600 | *data = u;\r | |
601 | return Find;\r | |
602 | }\r |