]>
Commit | Line | Data |
---|---|---|
1 | /** @file\r | |
2 | Emulator Thunk to abstract OS services from pure EFI code\r | |
3 | \r | |
4 | Copyright (c) 2008 - 2011, Apple Inc. All rights reserved.<BR>\r | |
5 | Copyright (c) 2011 - 2018, Intel Corporation. All rights reserved.<BR>\r | |
6 | \r | |
7 | SPDX-License-Identifier: BSD-2-Clause-Patent\r | |
8 | \r | |
9 | **/\r | |
10 | \r | |
11 | #include <Uefi.h>\r | |
12 | #include <Library/BaseLib.h>\r | |
13 | #include <Library/BaseMemoryLib.h>\r | |
14 | #include <Library/DebugLib.h>\r | |
15 | #include <Library/MemoryAllocationLib.h>\r | |
16 | \r | |
17 | #include <Protocol/EmuIoThunk.h>\r | |
18 | \r | |
19 | \r | |
20 | #define EMU_IO_THUNK_PROTOCOL_DATA_SIGNATURE SIGNATURE_32('E','m','u','T')\r | |
21 | \r | |
22 | typedef struct {\r | |
23 | UINTN Signature;\r | |
24 | EMU_IO_THUNK_PROTOCOL Data;\r | |
25 | BOOLEAN EmuBusDriver;\r | |
26 | LIST_ENTRY Link;\r | |
27 | } EMU_IO_THUNK_PROTOCOL_DATA;\r | |
28 | \r | |
29 | LIST_ENTRY mThunkList = INITIALIZE_LIST_HEAD_VARIABLE (mThunkList);\r | |
30 | \r | |
31 | \r | |
32 | EFI_STATUS\r | |
33 | EFIAPI\r | |
34 | AddThunkProtocol (\r | |
35 | IN EMU_IO_THUNK_PROTOCOL *ThunkIo,\r | |
36 | IN CHAR16 *ConfigString,\r | |
37 | IN BOOLEAN EmuBusDriver\r | |
38 | )\r | |
39 | {\r | |
40 | CHAR16 *StartString;\r | |
41 | CHAR16 *SubString;\r | |
42 | UINTN Instance;\r | |
43 | EMU_IO_THUNK_PROTOCOL_DATA *Private;\r | |
44 | \r | |
45 | if (ThunkIo == NULL) {\r | |
46 | return EFI_INVALID_PARAMETER;\r | |
47 | }\r | |
48 | \r | |
49 | Instance = 0;\r | |
50 | StartString = AllocatePool (StrSize (ConfigString));\r | |
51 | StrCpy (StartString, ConfigString);\r | |
52 | while (*StartString != '\0') {\r | |
53 | \r | |
54 | //\r | |
55 | // Find the end of the sub string\r | |
56 | //\r | |
57 | SubString = StartString;\r | |
58 | while (*SubString != '\0' && *SubString != '!') {\r | |
59 | SubString++;\r | |
60 | }\r | |
61 | \r | |
62 | if (*SubString == '!') {\r | |
63 | //\r | |
64 | // Replace token with '\0' to make sub strings. If this is the end\r | |
65 | // of the string SubString will already point to NULL.\r | |
66 | //\r | |
67 | *SubString = '\0';\r | |
68 | SubString++;\r | |
69 | }\r | |
70 | \r | |
71 | Private = AllocatePool (sizeof (EMU_IO_THUNK_PROTOCOL_DATA));\r | |
72 | if (Private == NULL) {\r | |
73 | return EFI_OUT_OF_RESOURCES;\r | |
74 | }\r | |
75 | Private->Signature = EMU_IO_THUNK_PROTOCOL_DATA_SIGNATURE;\r | |
76 | Private->EmuBusDriver = EmuBusDriver;\r | |
77 | \r | |
78 | CopyMem (&Private->Data, ThunkIo, sizeof (EMU_IO_THUNK_PROTOCOL));\r | |
79 | Private->Data.Instance = (UINT16)Instance++;\r | |
80 | Private->Data.ConfigString = StartString;\r | |
81 | \r | |
82 | InsertTailList (&mThunkList, &Private->Link);\r | |
83 | \r | |
84 | //\r | |
85 | // Parse Next sub string. This will point to '\0' if we are at the end.\r | |
86 | //\r | |
87 | StartString = SubString;\r | |
88 | }\r | |
89 | \r | |
90 | return EFI_SUCCESS;\r | |
91 | }\r | |
92 | \r | |
93 | \r | |
94 | EFI_STATUS\r | |
95 | EFIAPI\r | |
96 | GetNextThunkProtocol (\r | |
97 | IN BOOLEAN EmuBusDriver,\r | |
98 | OUT EMU_IO_THUNK_PROTOCOL **Instance OPTIONAL\r | |
99 | )\r | |
100 | {\r | |
101 | LIST_ENTRY *Link;\r | |
102 | EMU_IO_THUNK_PROTOCOL_DATA *Private;\r | |
103 | \r | |
104 | if (mThunkList.ForwardLink == &mThunkList) {\r | |
105 | // Skip parsing an empty list\r | |
106 | return EFI_NOT_FOUND;\r | |
107 | }\r | |
108 | \r | |
109 | for (Link = mThunkList.ForwardLink; Link != &mThunkList; Link = Link->ForwardLink) {\r | |
110 | Private = CR (Link, EMU_IO_THUNK_PROTOCOL_DATA, Link, EMU_IO_THUNK_PROTOCOL_DATA_SIGNATURE);\r | |
111 | if (EmuBusDriver & !Private->EmuBusDriver) {\r | |
112 | continue;\r | |
113 | } else if (*Instance == NULL) {\r | |
114 | // Find 1st match in list\r | |
115 | *Instance = &Private->Data;\r | |
116 | return EFI_SUCCESS;\r | |
117 | } else if (*Instance == &Private->Data) {\r | |
118 | // Matched previous call so look for valid next entry\r | |
119 | Link = Link->ForwardLink;\r | |
120 | if (Link == &mThunkList) {\r | |
121 | return EFI_NOT_FOUND;\r | |
122 | }\r | |
123 | Private = CR (Link, EMU_IO_THUNK_PROTOCOL_DATA, Link, EMU_IO_THUNK_PROTOCOL_DATA_SIGNATURE);\r | |
124 | *Instance = &Private->Data;\r | |
125 | return EFI_SUCCESS;\r | |
126 | }\r | |
127 | }\r | |
128 | \r | |
129 | \r | |
130 | return EFI_NOT_FOUND;\r | |
131 | }\r | |
132 | \r |