1 | /*++
|
---|
2 |
|
---|
3 | Copyright (c) 1998 Intel Corporation
|
---|
4 |
|
---|
5 | Module Name:
|
---|
6 |
|
---|
7 | dpath.c
|
---|
8 |
|
---|
9 | Abstract:
|
---|
10 | MBR & Device Path functions
|
---|
11 |
|
---|
12 |
|
---|
13 |
|
---|
14 | Revision History
|
---|
15 |
|
---|
16 | --*/
|
---|
17 |
|
---|
18 | #include "lib.h"
|
---|
19 |
|
---|
20 | #define ALIGN_SIZE(a) ((a % MIN_ALIGNMENT_SIZE) ? MIN_ALIGNMENT_SIZE - (a % MIN_ALIGNMENT_SIZE) : 0)
|
---|
21 |
|
---|
22 |
|
---|
23 |
|
---|
24 | EFI_DEVICE_PATH *
|
---|
25 | DevicePathFromHandle (
|
---|
26 | IN EFI_HANDLE Handle
|
---|
27 | )
|
---|
28 | {
|
---|
29 | EFI_STATUS Status;
|
---|
30 | EFI_DEVICE_PATH *DevicePath;
|
---|
31 |
|
---|
32 | Status = BS->HandleProtocol (Handle, &DevicePathProtocol, (VOID*)&DevicePath);
|
---|
33 | if (EFI_ERROR(Status)) {
|
---|
34 | DevicePath = NULL;
|
---|
35 | }
|
---|
36 |
|
---|
37 | return DevicePath;
|
---|
38 | }
|
---|
39 |
|
---|
40 |
|
---|
41 | EFI_DEVICE_PATH *
|
---|
42 | DevicePathInstance (
|
---|
43 | IN OUT EFI_DEVICE_PATH **DevicePath,
|
---|
44 | OUT UINTN *Size
|
---|
45 | )
|
---|
46 | {
|
---|
47 | EFI_DEVICE_PATH *Start, *Next, *DevPath;
|
---|
48 | UINTN Count;
|
---|
49 |
|
---|
50 | DevPath = *DevicePath;
|
---|
51 | Start = DevPath;
|
---|
52 |
|
---|
53 | if (!DevPath) {
|
---|
54 | return NULL;
|
---|
55 | }
|
---|
56 |
|
---|
57 | //
|
---|
58 | // Check for end of device path type
|
---|
59 | //
|
---|
60 |
|
---|
61 | for (Count = 0; ; Count++) {
|
---|
62 | Next = NextDevicePathNode(DevPath);
|
---|
63 |
|
---|
64 | if (IsDevicePathEndType(DevPath)) {
|
---|
65 | break;
|
---|
66 | }
|
---|
67 |
|
---|
68 | if (Count > 01000) {
|
---|
69 | //
|
---|
70 | // BugBug: Debug code to catch bogus device paths
|
---|
71 | //
|
---|
72 | DEBUG((D_ERROR, "DevicePathInstance: DevicePath %x Size %d", *DevicePath, ((UINT8 *) DevPath) - ((UINT8 *) Start) ));
|
---|
73 | DumpHex (0, 0, ((UINT8 *) DevPath) - ((UINT8 *) Start), Start);
|
---|
74 | break;
|
---|
75 | }
|
---|
76 |
|
---|
77 | DevPath = Next;
|
---|
78 | }
|
---|
79 |
|
---|
80 | ASSERT (DevicePathSubType(DevPath) == END_ENTIRE_DEVICE_PATH_SUBTYPE ||
|
---|
81 | DevicePathSubType(DevPath) == END_INSTANCE_DEVICE_PATH_SUBTYPE);
|
---|
82 |
|
---|
83 | //
|
---|
84 | // Set next position
|
---|
85 | //
|
---|
86 |
|
---|
87 | if (DevicePathSubType(DevPath) == END_ENTIRE_DEVICE_PATH_SUBTYPE) {
|
---|
88 | Next = NULL;
|
---|
89 | }
|
---|
90 |
|
---|
91 | *DevicePath = Next;
|
---|
92 |
|
---|
93 | //
|
---|
94 | // Return size and start of device path instance
|
---|
95 | //
|
---|
96 |
|
---|
97 | *Size = ((UINT8 *) DevPath) - ((UINT8 *) Start);
|
---|
98 | return Start;
|
---|
99 | }
|
---|
100 |
|
---|
101 | UINTN
|
---|
102 | DevicePathInstanceCount (
|
---|
103 | IN EFI_DEVICE_PATH *DevicePath
|
---|
104 | )
|
---|
105 | {
|
---|
106 | UINTN Count, Size;
|
---|
107 |
|
---|
108 | Count = 0;
|
---|
109 | while (DevicePathInstance(&DevicePath, &Size)) {
|
---|
110 | Count += 1;
|
---|
111 | }
|
---|
112 |
|
---|
113 | return Count;
|
---|
114 | }
|
---|
115 |
|
---|
116 |
|
---|
117 | EFI_DEVICE_PATH *
|
---|
118 | AppendDevicePath (
|
---|
119 | IN EFI_DEVICE_PATH *Src1,
|
---|
120 | IN EFI_DEVICE_PATH *Src2
|
---|
121 | )
|
---|
122 | // Src1 may have multiple "instances" and each instance is appended
|
---|
123 | // Src2 is appended to each instance is Src1. (E.g., it's possible
|
---|
124 | // to append a new instance to the complete device path by passing
|
---|
125 | // it in Src2)
|
---|
126 | {
|
---|
127 | UINTN Src1Size, Src1Inst, Src2Size, Size;
|
---|
128 | EFI_DEVICE_PATH *Dst, *Inst;
|
---|
129 | UINT8 *DstPos;
|
---|
130 |
|
---|
131 | //
|
---|
132 | // If there's only 1 path, just duplicate it
|
---|
133 | //
|
---|
134 |
|
---|
135 | if (!Src1) {
|
---|
136 | ASSERT (!IsDevicePathUnpacked (Src2));
|
---|
137 | return DuplicateDevicePath (Src2);
|
---|
138 | }
|
---|
139 |
|
---|
140 | if (!Src2) {
|
---|
141 | ASSERT (!IsDevicePathUnpacked (Src1));
|
---|
142 | return DuplicateDevicePath (Src1);
|
---|
143 | }
|
---|
144 |
|
---|
145 | //
|
---|
146 | // Verify we're not working with unpacked paths
|
---|
147 | //
|
---|
148 |
|
---|
149 | // ASSERT (!IsDevicePathUnpacked (Src1));
|
---|
150 | // ASSERT (!IsDevicePathUnpacked (Src2));
|
---|
151 |
|
---|
152 | //
|
---|
153 | // Append Src2 to every instance in Src1
|
---|
154 | //
|
---|
155 |
|
---|
156 | Src1Size = DevicePathSize(Src1);
|
---|
157 | Src1Inst = DevicePathInstanceCount(Src1);
|
---|
158 | Src2Size = DevicePathSize(Src2);
|
---|
159 | Size = Src1Size * Src1Inst + Src2Size;
|
---|
160 |
|
---|
161 | Dst = AllocatePool (Size);
|
---|
162 | if (Dst) {
|
---|
163 | DstPos = (UINT8 *) Dst;
|
---|
164 |
|
---|
165 | //
|
---|
166 | // Copy all device path instances
|
---|
167 | //
|
---|
168 |
|
---|
169 | while ((Inst = DevicePathInstance (&Src1, &Size))) {
|
---|
170 |
|
---|
171 | CopyMem(DstPos, Inst, Size);
|
---|
172 | DstPos += Size;
|
---|
173 |
|
---|
174 | CopyMem(DstPos, Src2, Src2Size);
|
---|
175 | DstPos += Src2Size;
|
---|
176 |
|
---|
177 | CopyMem(DstPos, EndInstanceDevicePath, sizeof(EFI_DEVICE_PATH));
|
---|
178 | DstPos += sizeof(EFI_DEVICE_PATH);
|
---|
179 | }
|
---|
180 |
|
---|
181 | // Change last end marker
|
---|
182 | DstPos -= sizeof(EFI_DEVICE_PATH);
|
---|
183 | CopyMem(DstPos, EndDevicePath, sizeof(EFI_DEVICE_PATH));
|
---|
184 | }
|
---|
185 |
|
---|
186 | return Dst;
|
---|
187 | }
|
---|
188 |
|
---|
189 |
|
---|
190 | EFI_DEVICE_PATH *
|
---|
191 | AppendDevicePathNode (
|
---|
192 | IN EFI_DEVICE_PATH *Src1,
|
---|
193 | IN EFI_DEVICE_PATH *Src2
|
---|
194 | )
|
---|
195 | // Src1 may have multiple "instances" and each instance is appended
|
---|
196 | // Src2 is a signal device path node (without a terminator) that is
|
---|
197 | // appended to each instance is Src1.
|
---|
198 | {
|
---|
199 | EFI_DEVICE_PATH *Temp, *Eop;
|
---|
200 | UINTN Length;
|
---|
201 |
|
---|
202 | //
|
---|
203 | // Build a Src2 that has a terminator on it
|
---|
204 | //
|
---|
205 |
|
---|
206 | Length = DevicePathNodeLength(Src2);
|
---|
207 | Temp = AllocatePool (Length + sizeof(EFI_DEVICE_PATH));
|
---|
208 | if (!Temp) {
|
---|
209 | return NULL;
|
---|
210 | }
|
---|
211 |
|
---|
212 | CopyMem (Temp, Src2, Length);
|
---|
213 | Eop = NextDevicePathNode(Temp);
|
---|
214 | SetDevicePathEndNode(Eop);
|
---|
215 |
|
---|
216 | //
|
---|
217 | // Append device paths
|
---|
218 | //
|
---|
219 |
|
---|
220 | Src1 = AppendDevicePath (Src1, Temp);
|
---|
221 | FreePool (Temp);
|
---|
222 | return Src1;
|
---|
223 | }
|
---|
224 |
|
---|
225 |
|
---|
226 | EFI_DEVICE_PATH *
|
---|
227 | FileDevicePath (
|
---|
228 | IN EFI_HANDLE Device OPTIONAL,
|
---|
229 | IN CHAR16 *FileName
|
---|
230 | )
|
---|
231 | /*++
|
---|
232 |
|
---|
233 | N.B. Results are allocated from pool. The caller must FreePool
|
---|
234 | the resulting device path structure
|
---|
235 |
|
---|
236 | --*/
|
---|
237 | {
|
---|
238 | UINTN Size;
|
---|
239 | FILEPATH_DEVICE_PATH *FilePath;
|
---|
240 | EFI_DEVICE_PATH *Eop, *DevicePath;
|
---|
241 |
|
---|
242 | Size = StrSize(FileName);
|
---|
243 | FilePath = AllocateZeroPool (Size + SIZE_OF_FILEPATH_DEVICE_PATH + sizeof(EFI_DEVICE_PATH));
|
---|
244 | DevicePath = NULL;
|
---|
245 |
|
---|
246 | if (FilePath) {
|
---|
247 |
|
---|
248 | //
|
---|
249 | // Build a file path
|
---|
250 | //
|
---|
251 |
|
---|
252 | FilePath->Header.Type = MEDIA_DEVICE_PATH;
|
---|
253 | FilePath->Header.SubType = MEDIA_FILEPATH_DP;
|
---|
254 | SetDevicePathNodeLength (&FilePath->Header, Size + SIZE_OF_FILEPATH_DEVICE_PATH);
|
---|
255 | CopyMem (FilePath->PathName, FileName, Size);
|
---|
256 | Eop = NextDevicePathNode(&FilePath->Header);
|
---|
257 | SetDevicePathEndNode(Eop);
|
---|
258 |
|
---|
259 | //
|
---|
260 | // Append file path to device's device path
|
---|
261 | //
|
---|
262 |
|
---|
263 | DevicePath = (EFI_DEVICE_PATH *) FilePath;
|
---|
264 | if (Device) {
|
---|
265 | DevicePath = AppendDevicePath (
|
---|
266 | DevicePathFromHandle(Device),
|
---|
267 | DevicePath
|
---|
268 | );
|
---|
269 |
|
---|
270 | FreePool(FilePath);
|
---|
271 | }
|
---|
272 | }
|
---|
273 |
|
---|
274 | return DevicePath;
|
---|
275 | }
|
---|
276 |
|
---|
277 |
|
---|
278 |
|
---|
279 | UINTN
|
---|
280 | DevicePathSize (
|
---|
281 | IN EFI_DEVICE_PATH *DevPath
|
---|
282 | )
|
---|
283 | {
|
---|
284 | EFI_DEVICE_PATH *Start;
|
---|
285 |
|
---|
286 | //
|
---|
287 | // Search for the end of the device path structure
|
---|
288 | //
|
---|
289 |
|
---|
290 | Start = DevPath;
|
---|
291 | while (!IsDevicePathEnd(DevPath)) {
|
---|
292 | DevPath = NextDevicePathNode(DevPath);
|
---|
293 | }
|
---|
294 |
|
---|
295 | //
|
---|
296 | // Compute the size
|
---|
297 | //
|
---|
298 |
|
---|
299 | return ((UINTN) DevPath - (UINTN) Start) + sizeof(EFI_DEVICE_PATH);
|
---|
300 | }
|
---|
301 |
|
---|
302 | EFI_DEVICE_PATH *
|
---|
303 | DuplicateDevicePath (
|
---|
304 | IN EFI_DEVICE_PATH *DevPath
|
---|
305 | )
|
---|
306 | {
|
---|
307 | EFI_DEVICE_PATH *NewDevPath;
|
---|
308 | UINTN Size;
|
---|
309 |
|
---|
310 |
|
---|
311 | //
|
---|
312 | // Compute the size
|
---|
313 | //
|
---|
314 |
|
---|
315 | Size = DevicePathSize (DevPath);
|
---|
316 |
|
---|
317 | //
|
---|
318 | // Make a copy
|
---|
319 | //
|
---|
320 |
|
---|
321 | NewDevPath = AllocatePool (Size);
|
---|
322 | if (NewDevPath) {
|
---|
323 | CopyMem (NewDevPath, DevPath, Size);
|
---|
324 | }
|
---|
325 |
|
---|
326 | return NewDevPath;
|
---|
327 | }
|
---|
328 |
|
---|
329 | EFI_DEVICE_PATH *
|
---|
330 | UnpackDevicePath (
|
---|
331 | IN EFI_DEVICE_PATH *DevPath
|
---|
332 | )
|
---|
333 | {
|
---|
334 | EFI_DEVICE_PATH *Src, *Dest, *NewPath;
|
---|
335 | UINTN Size;
|
---|
336 |
|
---|
337 | //
|
---|
338 | // Walk device path and round sizes to valid boundries
|
---|
339 | //
|
---|
340 |
|
---|
341 | Src = DevPath;
|
---|
342 | Size = 0;
|
---|
343 | for (; ;) {
|
---|
344 | Size += DevicePathNodeLength(Src);
|
---|
345 | Size += ALIGN_SIZE(Size);
|
---|
346 |
|
---|
347 | if (IsDevicePathEnd(Src)) {
|
---|
348 | break;
|
---|
349 | }
|
---|
350 |
|
---|
351 | Src = NextDevicePathNode(Src);
|
---|
352 | }
|
---|
353 |
|
---|
354 |
|
---|
355 | //
|
---|
356 | // Allocate space for the unpacked path
|
---|
357 | //
|
---|
358 |
|
---|
359 | NewPath = AllocateZeroPool (Size);
|
---|
360 | if (NewPath) {
|
---|
361 |
|
---|
362 | ASSERT (((UINTN)NewPath) % MIN_ALIGNMENT_SIZE == 0);
|
---|
363 |
|
---|
364 | //
|
---|
365 | // Copy each node
|
---|
366 | //
|
---|
367 |
|
---|
368 | Src = DevPath;
|
---|
369 | Dest = NewPath;
|
---|
370 | for (; ;) {
|
---|
371 | Size = DevicePathNodeLength(Src);
|
---|
372 | CopyMem (Dest, Src, Size);
|
---|
373 | Size += ALIGN_SIZE(Size);
|
---|
374 | SetDevicePathNodeLength (Dest, Size);
|
---|
375 | Dest->Type |= EFI_DP_TYPE_UNPACKED;
|
---|
376 | Dest = (EFI_DEVICE_PATH *) (((UINT8 *) Dest) + Size);
|
---|
377 |
|
---|
378 | if (IsDevicePathEnd(Src)) {
|
---|
379 | break;
|
---|
380 | }
|
---|
381 |
|
---|
382 | Src = NextDevicePathNode(Src);
|
---|
383 | }
|
---|
384 | }
|
---|
385 |
|
---|
386 | return NewPath;
|
---|
387 | }
|
---|
388 |
|
---|
389 |
|
---|
390 | EFI_DEVICE_PATH*
|
---|
391 | AppendDevicePathInstance (
|
---|
392 | IN EFI_DEVICE_PATH *Src,
|
---|
393 | IN EFI_DEVICE_PATH *Instance
|
---|
394 | )
|
---|
395 | {
|
---|
396 | UINT8 *Ptr;
|
---|
397 | EFI_DEVICE_PATH *DevPath;
|
---|
398 | UINTN SrcSize;
|
---|
399 | UINTN InstanceSize;
|
---|
400 |
|
---|
401 | if (Src == NULL) {
|
---|
402 | return DuplicateDevicePath (Instance);
|
---|
403 | }
|
---|
404 | SrcSize = DevicePathSize(Src);
|
---|
405 | InstanceSize = DevicePathSize(Instance);
|
---|
406 | Ptr = AllocatePool (SrcSize + InstanceSize);
|
---|
407 | DevPath = (EFI_DEVICE_PATH *)Ptr;
|
---|
408 | ASSERT(DevPath);
|
---|
409 |
|
---|
410 | CopyMem (Ptr, Src, SrcSize);
|
---|
411 | // FreePool (Src);
|
---|
412 |
|
---|
413 | while (!IsDevicePathEnd(DevPath)) {
|
---|
414 | DevPath = NextDevicePathNode(DevPath);
|
---|
415 | }
|
---|
416 | //
|
---|
417 | // Convert the End to an End Instance, since we are
|
---|
418 | // appending another instacne after this one its a good
|
---|
419 | // idea.
|
---|
420 | //
|
---|
421 | DevPath->SubType = END_INSTANCE_DEVICE_PATH_SUBTYPE;
|
---|
422 |
|
---|
423 | DevPath = NextDevicePathNode(DevPath);
|
---|
424 | CopyMem (DevPath, Instance, InstanceSize);
|
---|
425 | return (EFI_DEVICE_PATH *)Ptr;
|
---|
426 | }
|
---|
427 |
|
---|
428 | EFI_STATUS
|
---|
429 | LibDevicePathToInterface (
|
---|
430 | IN EFI_GUID *Protocol,
|
---|
431 | IN EFI_DEVICE_PATH *FilePath,
|
---|
432 | OUT VOID **Interface
|
---|
433 | )
|
---|
434 | {
|
---|
435 | EFI_STATUS Status;
|
---|
436 | EFI_HANDLE Device;
|
---|
437 |
|
---|
438 | Status = BS->LocateDevicePath (Protocol, &FilePath, &Device);
|
---|
439 |
|
---|
440 | if (!EFI_ERROR(Status)) {
|
---|
441 |
|
---|
442 | // If we didn't get a direct match return not found
|
---|
443 | Status = EFI_NOT_FOUND;
|
---|
444 |
|
---|
445 | if (IsDevicePathEnd(FilePath)) {
|
---|
446 |
|
---|
447 | //
|
---|
448 | // It was a direct match, lookup the protocol interface
|
---|
449 | //
|
---|
450 |
|
---|
451 | Status = BS->HandleProtocol (Device, Protocol, Interface);
|
---|
452 | }
|
---|
453 | }
|
---|
454 |
|
---|
455 | //
|
---|
456 | // If there was an error, do not return an interface
|
---|
457 | //
|
---|
458 |
|
---|
459 | if (EFI_ERROR(Status)) {
|
---|
460 | *Interface = NULL;
|
---|
461 | }
|
---|
462 |
|
---|
463 | return Status;
|
---|
464 | }
|
---|
465 |
|
---|
466 | VOID
|
---|
467 | _DevPathPci (
|
---|
468 | IN OUT POOL_PRINT *Str,
|
---|
469 | IN VOID *DevPath
|
---|
470 | )
|
---|
471 | {
|
---|
472 | PCI_DEVICE_PATH *Pci;
|
---|
473 |
|
---|
474 | Pci = DevPath;
|
---|
475 | CatPrint(Str, L"Pci(%x|%x)", Pci->Device, Pci->Function);
|
---|
476 | }
|
---|
477 |
|
---|
478 | VOID
|
---|
479 | _DevPathPccard (
|
---|
480 | IN OUT POOL_PRINT *Str,
|
---|
481 | IN VOID *DevPath
|
---|
482 | )
|
---|
483 | {
|
---|
484 | PCCARD_DEVICE_PATH *Pccard;
|
---|
485 |
|
---|
486 | Pccard = DevPath;
|
---|
487 | CatPrint(Str, L"Pccard(Socket%x)", Pccard->SocketNumber);
|
---|
488 | }
|
---|
489 |
|
---|
490 | VOID
|
---|
491 | _DevPathMemMap (
|
---|
492 | IN OUT POOL_PRINT *Str,
|
---|
493 | IN VOID *DevPath
|
---|
494 | )
|
---|
495 | {
|
---|
496 | MEMMAP_DEVICE_PATH *MemMap;
|
---|
497 |
|
---|
498 | MemMap = DevPath;
|
---|
499 | CatPrint(Str, L"MemMap(%d:%x-%x)",
|
---|
500 | MemMap->MemoryType,
|
---|
501 | MemMap->StartingAddress,
|
---|
502 | MemMap->EndingAddress
|
---|
503 | );
|
---|
504 | }
|
---|
505 |
|
---|
506 | VOID
|
---|
507 | _DevPathController (
|
---|
508 | IN OUT POOL_PRINT *Str,
|
---|
509 | IN VOID *DevPath
|
---|
510 | )
|
---|
511 | {
|
---|
512 | CONTROLLER_DEVICE_PATH *Controller;
|
---|
513 |
|
---|
514 | Controller = DevPath;
|
---|
515 | CatPrint(Str, L"Ctrl(%d)",
|
---|
516 | Controller->Controller
|
---|
517 | );
|
---|
518 | }
|
---|
519 |
|
---|
520 | VOID
|
---|
521 | _DevPathVendor (
|
---|
522 | IN OUT POOL_PRINT *Str,
|
---|
523 | IN VOID *DevPath
|
---|
524 | )
|
---|
525 | {
|
---|
526 | VENDOR_DEVICE_PATH *Vendor;
|
---|
527 | CHAR16 *Type;
|
---|
528 | UNKNOWN_DEVICE_VENDOR_DEVICE_PATH *UnknownDevPath;
|
---|
529 |
|
---|
530 | Vendor = DevPath;
|
---|
531 | switch (DevicePathType(&Vendor->Header)) {
|
---|
532 | case HARDWARE_DEVICE_PATH: Type = L"Hw"; break;
|
---|
533 | case MESSAGING_DEVICE_PATH: Type = L"Msg"; break;
|
---|
534 | case MEDIA_DEVICE_PATH: Type = L"Media"; break;
|
---|
535 | default: Type = L"?"; break;
|
---|
536 | }
|
---|
537 |
|
---|
538 | CatPrint(Str, L"Ven%s(%g", Type, &Vendor->Guid);
|
---|
539 | if (CompareGuid (&Vendor->Guid, &UnknownDevice) == 0) {
|
---|
540 | //
|
---|
541 | // GUID used by EFI to enumerate an EDD 1.1 device
|
---|
542 | //
|
---|
543 | UnknownDevPath = (UNKNOWN_DEVICE_VENDOR_DEVICE_PATH *)Vendor;
|
---|
544 | CatPrint(Str, L":%02x)", UnknownDevPath->LegacyDriveLetter);
|
---|
545 | } else {
|
---|
546 | CatPrint(Str, L")");
|
---|
547 | }
|
---|
548 | }
|
---|
549 |
|
---|
550 |
|
---|
551 | VOID
|
---|
552 | _DevPathAcpi (
|
---|
553 | IN OUT POOL_PRINT *Str,
|
---|
554 | IN VOID *DevPath
|
---|
555 | )
|
---|
556 | {
|
---|
557 | ACPI_HID_DEVICE_PATH *Acpi;
|
---|
558 |
|
---|
559 | Acpi = DevPath;
|
---|
560 | if ((Acpi->HID & PNP_EISA_ID_MASK) == PNP_EISA_ID_CONST) {
|
---|
561 | CatPrint(Str, L"Acpi(PNP%04x,%x)", EISA_ID_TO_NUM (Acpi->HID), Acpi->UID);
|
---|
562 | } else {
|
---|
563 | CatPrint(Str, L"Acpi(%08x,%x)", Acpi->HID, Acpi->UID);
|
---|
564 | }
|
---|
565 | }
|
---|
566 |
|
---|
567 |
|
---|
568 | VOID
|
---|
569 | _DevPathAtapi (
|
---|
570 | IN OUT POOL_PRINT *Str,
|
---|
571 | IN VOID *DevPath
|
---|
572 | )
|
---|
573 | {
|
---|
574 | ATAPI_DEVICE_PATH *Atapi;
|
---|
575 |
|
---|
576 | Atapi = DevPath;
|
---|
577 | CatPrint(Str, L"Ata(%s,%s)",
|
---|
578 | Atapi->PrimarySecondary ? L"Secondary" : L"Primary",
|
---|
579 | Atapi->SlaveMaster ? L"Slave" : L"Master"
|
---|
580 | );
|
---|
581 | }
|
---|
582 |
|
---|
583 | VOID
|
---|
584 | _DevPathScsi (
|
---|
585 | IN OUT POOL_PRINT *Str,
|
---|
586 | IN VOID *DevPath
|
---|
587 | )
|
---|
588 | {
|
---|
589 | SCSI_DEVICE_PATH *Scsi;
|
---|
590 |
|
---|
591 | Scsi = DevPath;
|
---|
592 | CatPrint(Str, L"Scsi(Pun%x,Lun%x)", Scsi->Pun, Scsi->Lun);
|
---|
593 | }
|
---|
594 |
|
---|
595 |
|
---|
596 | VOID
|
---|
597 | _DevPathFibre (
|
---|
598 | IN OUT POOL_PRINT *Str,
|
---|
599 | IN VOID *DevPath
|
---|
600 | )
|
---|
601 | {
|
---|
602 | FIBRECHANNEL_DEVICE_PATH *Fibre;
|
---|
603 |
|
---|
604 | Fibre = DevPath;
|
---|
605 | CatPrint(Str, L"Fibre(%lx)", Fibre->WWN);
|
---|
606 | }
|
---|
607 |
|
---|
608 | VOID
|
---|
609 | _DevPath1394 (
|
---|
610 | IN OUT POOL_PRINT *Str,
|
---|
611 | IN VOID *DevPath
|
---|
612 | )
|
---|
613 | {
|
---|
614 | F1394_DEVICE_PATH *F1394;
|
---|
615 |
|
---|
616 | F1394 = DevPath;
|
---|
617 | CatPrint(Str, L"1394(%g)", &F1394->Guid);
|
---|
618 | }
|
---|
619 |
|
---|
620 |
|
---|
621 |
|
---|
622 | VOID
|
---|
623 | _DevPathUsb (
|
---|
624 | IN OUT POOL_PRINT *Str,
|
---|
625 | IN VOID *DevPath
|
---|
626 | )
|
---|
627 | {
|
---|
628 | USB_DEVICE_PATH *Usb;
|
---|
629 |
|
---|
630 | Usb = DevPath;
|
---|
631 | CatPrint(Str, L"Usb(%x)", Usb->Port);
|
---|
632 | }
|
---|
633 |
|
---|
634 |
|
---|
635 | VOID
|
---|
636 | _DevPathI2O (
|
---|
637 | IN OUT POOL_PRINT *Str,
|
---|
638 | IN VOID *DevPath
|
---|
639 | )
|
---|
640 | {
|
---|
641 | I2O_DEVICE_PATH *I2O;
|
---|
642 |
|
---|
643 | I2O = DevPath;
|
---|
644 | CatPrint(Str, L"I2O(%x)", I2O->Tid);
|
---|
645 | }
|
---|
646 |
|
---|
647 | VOID
|
---|
648 | _DevPathMacAddr (
|
---|
649 | IN OUT POOL_PRINT *Str,
|
---|
650 | IN VOID *DevPath
|
---|
651 | )
|
---|
652 | {
|
---|
653 | MAC_ADDR_DEVICE_PATH *MAC;
|
---|
654 | UINTN HwAddressSize;
|
---|
655 | UINTN Index;
|
---|
656 |
|
---|
657 | MAC = DevPath;
|
---|
658 |
|
---|
659 | HwAddressSize = sizeof(EFI_MAC_ADDRESS);
|
---|
660 | if (MAC->IfType == 0x01 || MAC->IfType == 0x00) {
|
---|
661 | HwAddressSize = 6;
|
---|
662 | }
|
---|
663 |
|
---|
664 | CatPrint(Str, L"Mac(");
|
---|
665 |
|
---|
666 | for(Index = 0; Index < HwAddressSize; Index++) {
|
---|
667 | CatPrint(Str, L"%02x",MAC->MacAddress.Addr[Index]);
|
---|
668 | }
|
---|
669 | CatPrint(Str, L")");
|
---|
670 | }
|
---|
671 |
|
---|
672 | VOID
|
---|
673 | _DevPathIPv4 (
|
---|
674 | IN OUT POOL_PRINT *Str,
|
---|
675 | IN VOID *DevPath
|
---|
676 | )
|
---|
677 | {
|
---|
678 | IPv4_DEVICE_PATH *IP;
|
---|
679 |
|
---|
680 | IP = DevPath;
|
---|
681 | CatPrint(Str, L"IPv4(not-done)");
|
---|
682 | }
|
---|
683 |
|
---|
684 | VOID
|
---|
685 | _DevPathIPv6 (
|
---|
686 | IN OUT POOL_PRINT *Str,
|
---|
687 | IN VOID *DevPath
|
---|
688 | )
|
---|
689 | {
|
---|
690 | IPv6_DEVICE_PATH *IP;
|
---|
691 |
|
---|
692 | IP = DevPath;
|
---|
693 | CatPrint(Str, L"IP-v6(not-done)");
|
---|
694 | }
|
---|
695 |
|
---|
696 | VOID
|
---|
697 | _DevPathInfiniBand (
|
---|
698 | IN OUT POOL_PRINT *Str,
|
---|
699 | IN VOID *DevPath
|
---|
700 | )
|
---|
701 | {
|
---|
702 | INFINIBAND_DEVICE_PATH *InfiniBand;
|
---|
703 |
|
---|
704 | InfiniBand = DevPath;
|
---|
705 | CatPrint(Str, L"InfiniBand(not-done)");
|
---|
706 | }
|
---|
707 |
|
---|
708 | VOID
|
---|
709 | _DevPathUart (
|
---|
710 | IN OUT POOL_PRINT *Str,
|
---|
711 | IN VOID *DevPath
|
---|
712 | )
|
---|
713 | {
|
---|
714 | UART_DEVICE_PATH *Uart;
|
---|
715 | CHAR8 Parity;
|
---|
716 |
|
---|
717 | Uart = DevPath;
|
---|
718 | switch (Uart->Parity) {
|
---|
719 | case 0 : Parity = 'D'; break;
|
---|
720 | case 1 : Parity = 'N'; break;
|
---|
721 | case 2 : Parity = 'E'; break;
|
---|
722 | case 3 : Parity = 'O'; break;
|
---|
723 | case 4 : Parity = 'M'; break;
|
---|
724 | case 5 : Parity = 'S'; break;
|
---|
725 | default : Parity = 'x'; break;
|
---|
726 | }
|
---|
727 |
|
---|
728 | if (Uart->BaudRate == 0) {
|
---|
729 | CatPrint(Str, L"Uart(DEFAULT %c",Uart->BaudRate,Parity);
|
---|
730 | } else {
|
---|
731 | CatPrint(Str, L"Uart(%d %c",Uart->BaudRate,Parity);
|
---|
732 | }
|
---|
733 |
|
---|
734 | if (Uart->DataBits == 0) {
|
---|
735 | CatPrint(Str, L"D");
|
---|
736 | } else {
|
---|
737 | CatPrint(Str, L"%d",Uart->DataBits);
|
---|
738 | }
|
---|
739 |
|
---|
740 | switch (Uart->StopBits) {
|
---|
741 | case 0 : CatPrint(Str, L"D)"); break;
|
---|
742 | case 1 : CatPrint(Str, L"1)"); break;
|
---|
743 | case 2 : CatPrint(Str, L"1.5)"); break;
|
---|
744 | case 3 : CatPrint(Str, L"2)"); break;
|
---|
745 | default : CatPrint(Str, L"x)"); break;
|
---|
746 | }
|
---|
747 | }
|
---|
748 |
|
---|
749 |
|
---|
750 | VOID
|
---|
751 | _DevPathHardDrive (
|
---|
752 | IN OUT POOL_PRINT *Str,
|
---|
753 | IN VOID *DevPath
|
---|
754 | )
|
---|
755 | {
|
---|
756 | HARDDRIVE_DEVICE_PATH *Hd;
|
---|
757 |
|
---|
758 | Hd = DevPath;
|
---|
759 | switch (Hd->SignatureType) {
|
---|
760 | case SIGNATURE_TYPE_MBR:
|
---|
761 | CatPrint(Str, L"HD(Part%d,Sig%08X)",
|
---|
762 | Hd->PartitionNumber,
|
---|
763 | *((UINT32 *)(&(Hd->Signature[0])))
|
---|
764 | );
|
---|
765 | break;
|
---|
766 | case SIGNATURE_TYPE_GUID:
|
---|
767 | CatPrint(Str, L"HD(Part%d,Sig%g)",
|
---|
768 | Hd->PartitionNumber,
|
---|
769 | (EFI_GUID *) &(Hd->Signature[0])
|
---|
770 | );
|
---|
771 | break;
|
---|
772 | default:
|
---|
773 | CatPrint(Str, L"HD(Part%d,MBRType=%02x,SigType=%02x)",
|
---|
774 | Hd->PartitionNumber,
|
---|
775 | Hd->MBRType,
|
---|
776 | Hd->SignatureType
|
---|
777 | );
|
---|
778 | break;
|
---|
779 | }
|
---|
780 | }
|
---|
781 |
|
---|
782 | VOID
|
---|
783 | _DevPathCDROM (
|
---|
784 | IN OUT POOL_PRINT *Str,
|
---|
785 | IN VOID *DevPath
|
---|
786 | )
|
---|
787 | {
|
---|
788 | CDROM_DEVICE_PATH *Cd;
|
---|
789 |
|
---|
790 | Cd = DevPath;
|
---|
791 | CatPrint(Str, L"CDROM(Entry%x)", Cd->BootEntry);
|
---|
792 | }
|
---|
793 |
|
---|
794 | VOID
|
---|
795 | _DevPathFilePath (
|
---|
796 | IN OUT POOL_PRINT *Str,
|
---|
797 | IN VOID *DevPath
|
---|
798 | )
|
---|
799 | {
|
---|
800 | FILEPATH_DEVICE_PATH *Fp;
|
---|
801 |
|
---|
802 | Fp = DevPath;
|
---|
803 | CatPrint(Str, L"%s", Fp->PathName);
|
---|
804 | }
|
---|
805 |
|
---|
806 | VOID
|
---|
807 | _DevPathMediaProtocol (
|
---|
808 | IN OUT POOL_PRINT *Str,
|
---|
809 | IN VOID *DevPath
|
---|
810 | )
|
---|
811 | {
|
---|
812 | MEDIA_PROTOCOL_DEVICE_PATH *MediaProt;
|
---|
813 |
|
---|
814 | MediaProt = DevPath;
|
---|
815 | CatPrint(Str, L"%g", &MediaProt->Protocol);
|
---|
816 | }
|
---|
817 |
|
---|
818 | VOID
|
---|
819 | _DevPathBssBss (
|
---|
820 | IN OUT POOL_PRINT *Str,
|
---|
821 | IN VOID *DevPath
|
---|
822 | )
|
---|
823 | {
|
---|
824 | BBS_BBS_DEVICE_PATH *Bss;
|
---|
825 | CHAR16 *Type;
|
---|
826 |
|
---|
827 | Bss = DevPath;
|
---|
828 | switch (Bss->DeviceType) {
|
---|
829 | case BBS_TYPE_FLOPPY: Type = L"Floppy"; break;
|
---|
830 | case BBS_TYPE_HARDDRIVE: Type = L"Harddrive"; break;
|
---|
831 | case BBS_TYPE_CDROM: Type = L"CDROM"; break;
|
---|
832 | case BBS_TYPE_PCMCIA: Type = L"PCMCIA"; break;
|
---|
833 | case BBS_TYPE_USB: Type = L"Usb"; break;
|
---|
834 | case BBS_TYPE_EMBEDDED_NETWORK: Type = L"Net"; break;
|
---|
835 | default: Type = L"?"; break;
|
---|
836 | }
|
---|
837 |
|
---|
838 | CatPrint(Str, L"Bss-%s(%a)", Type, Bss->String);
|
---|
839 | }
|
---|
840 |
|
---|
841 |
|
---|
842 | VOID
|
---|
843 | _DevPathEndInstance (
|
---|
844 | IN OUT POOL_PRINT *Str,
|
---|
845 | IN VOID *DevPath
|
---|
846 | )
|
---|
847 | {
|
---|
848 | CatPrint(Str, L",");
|
---|
849 | }
|
---|
850 |
|
---|
851 | VOID
|
---|
852 | _DevPathNodeUnknown (
|
---|
853 | IN OUT POOL_PRINT *Str,
|
---|
854 | IN VOID *DevPath
|
---|
855 | )
|
---|
856 | {
|
---|
857 | CatPrint(Str, L"?");
|
---|
858 | }
|
---|
859 |
|
---|
860 |
|
---|
861 | struct {
|
---|
862 | UINT8 Type;
|
---|
863 | UINT8 SubType;
|
---|
864 | VOID (*Function)(POOL_PRINT *, VOID *);
|
---|
865 | } DevPathTable[] = {
|
---|
866 | { HARDWARE_DEVICE_PATH, HW_PCI_DP, _DevPathPci},
|
---|
867 | { HARDWARE_DEVICE_PATH, HW_PCCARD_DP, _DevPathPccard},
|
---|
868 | { HARDWARE_DEVICE_PATH, HW_MEMMAP_DP, _DevPathMemMap},
|
---|
869 | { HARDWARE_DEVICE_PATH, HW_VENDOR_DP, _DevPathVendor},
|
---|
870 | { HARDWARE_DEVICE_PATH, HW_CONTROLLER_DP, _DevPathController},
|
---|
871 | { ACPI_DEVICE_PATH, ACPI_DP, _DevPathAcpi},
|
---|
872 | { MESSAGING_DEVICE_PATH, MSG_ATAPI_DP, _DevPathAtapi},
|
---|
873 | { MESSAGING_DEVICE_PATH, MSG_SCSI_DP, _DevPathScsi},
|
---|
874 | { MESSAGING_DEVICE_PATH, MSG_FIBRECHANNEL_DP, _DevPathFibre},
|
---|
875 | { MESSAGING_DEVICE_PATH, MSG_1394_DP, _DevPath1394},
|
---|
876 | { MESSAGING_DEVICE_PATH, MSG_USB_DP, _DevPathUsb},
|
---|
877 | { MESSAGING_DEVICE_PATH, MSG_I2O_DP, _DevPathI2O},
|
---|
878 | { MESSAGING_DEVICE_PATH, MSG_MAC_ADDR_DP, _DevPathMacAddr},
|
---|
879 | { MESSAGING_DEVICE_PATH, MSG_IPv4_DP, _DevPathIPv4},
|
---|
880 | { MESSAGING_DEVICE_PATH, MSG_IPv6_DP, _DevPathIPv6},
|
---|
881 | { MESSAGING_DEVICE_PATH, MSG_INFINIBAND_DP, _DevPathInfiniBand},
|
---|
882 | { MESSAGING_DEVICE_PATH, MSG_UART_DP, _DevPathUart},
|
---|
883 | { MESSAGING_DEVICE_PATH, MSG_VENDOR_DP, _DevPathVendor},
|
---|
884 | { MEDIA_DEVICE_PATH, MEDIA_HARDDRIVE_DP, _DevPathHardDrive},
|
---|
885 | { MEDIA_DEVICE_PATH, MEDIA_CDROM_DP, _DevPathCDROM},
|
---|
886 | { MEDIA_DEVICE_PATH, MEDIA_VENDOR_DP, _DevPathVendor},
|
---|
887 | { MEDIA_DEVICE_PATH, MEDIA_FILEPATH_DP, _DevPathFilePath},
|
---|
888 | { MEDIA_DEVICE_PATH, MEDIA_PROTOCOL_DP, _DevPathMediaProtocol},
|
---|
889 | { BBS_DEVICE_PATH, BBS_BBS_DP, _DevPathBssBss},
|
---|
890 | { END_DEVICE_PATH_TYPE, END_INSTANCE_DEVICE_PATH_SUBTYPE, _DevPathEndInstance},
|
---|
891 | { 0, 0, NULL}
|
---|
892 | };
|
---|
893 |
|
---|
894 |
|
---|
895 | CHAR16 *
|
---|
896 | DevicePathToStr (
|
---|
897 | EFI_DEVICE_PATH *DevPath
|
---|
898 | )
|
---|
899 | /*++
|
---|
900 |
|
---|
901 | Turns the Device Path into a printable string. Allcoates
|
---|
902 | the string from pool. The caller must FreePool the returned
|
---|
903 | string.
|
---|
904 |
|
---|
905 | --*/
|
---|
906 | {
|
---|
907 | POOL_PRINT Str;
|
---|
908 | EFI_DEVICE_PATH *DevPathNode;
|
---|
909 | VOID (*DumpNode)(POOL_PRINT *, VOID *);
|
---|
910 | UINTN Index, NewSize;
|
---|
911 |
|
---|
912 | ZeroMem(&Str, sizeof(Str));
|
---|
913 |
|
---|
914 | //
|
---|
915 | // Unpacked the device path
|
---|
916 | //
|
---|
917 |
|
---|
918 | DevPath = UnpackDevicePath(DevPath);
|
---|
919 | ASSERT (DevPath);
|
---|
920 |
|
---|
921 |
|
---|
922 | //
|
---|
923 | // Process each device path node
|
---|
924 | //
|
---|
925 |
|
---|
926 | DevPathNode = DevPath;
|
---|
927 | while (!IsDevicePathEnd(DevPathNode)) {
|
---|
928 | //
|
---|
929 | // Find the handler to dump this device path node
|
---|
930 | //
|
---|
931 |
|
---|
932 | DumpNode = NULL;
|
---|
933 | for (Index = 0; DevPathTable[Index].Function; Index += 1) {
|
---|
934 |
|
---|
935 | if (DevicePathType(DevPathNode) == DevPathTable[Index].Type &&
|
---|
936 | DevicePathSubType(DevPathNode) == DevPathTable[Index].SubType) {
|
---|
937 | DumpNode = DevPathTable[Index].Function;
|
---|
938 | break;
|
---|
939 | }
|
---|
940 | }
|
---|
941 |
|
---|
942 | //
|
---|
943 | // If not found, use a generic function
|
---|
944 | //
|
---|
945 |
|
---|
946 | if (!DumpNode) {
|
---|
947 | DumpNode = _DevPathNodeUnknown;
|
---|
948 | }
|
---|
949 |
|
---|
950 | //
|
---|
951 | // Put a path seperator in if needed
|
---|
952 | //
|
---|
953 |
|
---|
954 | if (Str.len && DumpNode != _DevPathEndInstance) {
|
---|
955 | CatPrint (&Str, L"/");
|
---|
956 | }
|
---|
957 |
|
---|
958 | //
|
---|
959 | // Print this node of the device path
|
---|
960 | //
|
---|
961 |
|
---|
962 | DumpNode (&Str, DevPathNode);
|
---|
963 |
|
---|
964 | //
|
---|
965 | // Next device path node
|
---|
966 | //
|
---|
967 |
|
---|
968 | DevPathNode = NextDevicePathNode(DevPathNode);
|
---|
969 | }
|
---|
970 |
|
---|
971 | //
|
---|
972 | // Shrink pool used for string allocation
|
---|
973 | //
|
---|
974 |
|
---|
975 | FreePool (DevPath);
|
---|
976 | NewSize = (Str.len + 1) * sizeof(CHAR16);
|
---|
977 | Str.str = ReallocatePool (Str.str, NewSize, NewSize);
|
---|
978 | Str.str[Str.len] = 0;
|
---|
979 | return Str.str;
|
---|
980 | }
|
---|
981 |
|
---|
982 | BOOLEAN
|
---|
983 | LibMatchDevicePaths (
|
---|
984 | IN EFI_DEVICE_PATH *Multi,
|
---|
985 | IN EFI_DEVICE_PATH *Single
|
---|
986 | )
|
---|
987 | {
|
---|
988 | EFI_DEVICE_PATH *DevicePath, *DevicePathInst;
|
---|
989 | UINTN Size;
|
---|
990 |
|
---|
991 | if (!Multi || !Single) {
|
---|
992 | return FALSE;
|
---|
993 | }
|
---|
994 |
|
---|
995 | DevicePath = Multi;
|
---|
996 | while ((DevicePathInst = DevicePathInstance (&DevicePath, &Size))) {
|
---|
997 | if (CompareMem (Single, DevicePathInst, Size) == 0) {
|
---|
998 | return TRUE;
|
---|
999 | }
|
---|
1000 | }
|
---|
1001 | return FALSE;
|
---|
1002 | }
|
---|
1003 |
|
---|
1004 | EFI_DEVICE_PATH *
|
---|
1005 | LibDuplicateDevicePathInstance (
|
---|
1006 | IN EFI_DEVICE_PATH *DevPath
|
---|
1007 | )
|
---|
1008 | {
|
---|
1009 | EFI_DEVICE_PATH *NewDevPath,*DevicePathInst,*Temp;
|
---|
1010 | UINTN Size;
|
---|
1011 |
|
---|
1012 | //
|
---|
1013 | // get the size of an instance from the input
|
---|
1014 | //
|
---|
1015 |
|
---|
1016 | Temp = DevPath;
|
---|
1017 | DevicePathInst = DevicePathInstance (&Temp, &Size);
|
---|
1018 |
|
---|
1019 | //
|
---|
1020 | // Make a copy and set proper end type
|
---|
1021 | //
|
---|
1022 | NewDevPath = NULL;
|
---|
1023 | if (Size) {
|
---|
1024 | NewDevPath = AllocatePool (Size + sizeof(EFI_DEVICE_PATH));
|
---|
1025 | }
|
---|
1026 |
|
---|
1027 | if (NewDevPath) {
|
---|
1028 | CopyMem (NewDevPath, DevicePathInst, Size);
|
---|
1029 | Temp = NextDevicePathNode(NewDevPath);
|
---|
1030 | SetDevicePathEndNode(Temp);
|
---|
1031 | }
|
---|
1032 |
|
---|
1033 | return NewDevPath;
|
---|
1034 | }
|
---|
1035 |
|
---|