]>
Commit | Line | Data |
---|---|---|
6e8a984e | 1 | /** @file\r |
509bc208 | 2 | X64 specific functions to support Debug Support protocol.\r |
6e8a984e | 3 | \r |
e5eed7d3 | 4 | Copyright (c) 2008 - 2010, Intel Corporation. All rights reserved.<BR>\r |
9d510e61 | 5 | SPDX-License-Identifier: BSD-2-Clause-Patent\r |
6e8a984e | 6 | \r |
7 | **/\r | |
8 | \r | |
cfcbb8bc | 9 | #include "PlDebugSupport.h"\r |
6e8a984e | 10 | \r |
43a99f08 | 11 | IA32_IDT_GATE_DESCRIPTOR NullDesc = {{0,0}};\r |
12 | \r | |
6e8a984e | 13 | /**\r |
c84507ab | 14 | Get Interrupt Handle from IDT Gate Descriptor.\r |
6e8a984e | 15 | \r |
16 | @param IdtGateDecriptor IDT Gate Descriptor.\r | |
17 | \r | |
c84507ab | 18 | @return Interrupt Handle stored in IDT Gate Descriptor.\r |
6e8a984e | 19 | \r |
20 | **/\r | |
c84507ab | 21 | UINTN\r |
22 | GetInterruptHandleFromIdt (\r | |
6e8a984e | 23 | IN IA32_IDT_GATE_DESCRIPTOR *IdtGateDecriptor\r |
24 | )\r | |
25 | {\r | |
c84507ab | 26 | UINTN InterruptHandle;\r |
cfcbb8bc | 27 | \r |
28 | //\r | |
29 | // InterruptHandle 0-15 : OffsetLow\r | |
30 | // InterruptHandle 16-31 : OffsetHigh\r | |
31 | // InterruptHandle 32-63 : OffsetUpper\r | |
32 | //\r | |
fbe12b79 ED |
33 | InterruptHandle = ((UINTN) IdtGateDecriptor->Bits.OffsetLow) |\r |
34 | (((UINTN) IdtGateDecriptor->Bits.OffsetHigh) << 16) |\r | |
35 | (((UINTN) IdtGateDecriptor->Bits.OffsetUpper) << 32) ;\r | |
6e8a984e | 36 | \r |
c84507ab | 37 | return InterruptHandle;\r |
6e8a984e | 38 | }\r |
39 | \r | |
40 | /**\r | |
41 | Allocate pool for a new IDT entry stub.\r | |
42 | \r | |
43 | Copy the generic stub into the new buffer and fixup the vector number\r | |
44 | and jump target address.\r | |
45 | \r | |
46 | @param ExceptionType This is the exception type that the new stub will be created\r | |
47 | for.\r | |
48 | @param Stub On successful exit, *Stub contains the newly allocated entry stub.\r | |
49 | \r | |
6e8a984e | 50 | **/\r |
c84507ab | 51 | VOID\r |
6e8a984e | 52 | CreateEntryStub (\r |
53 | IN EFI_EXCEPTION_TYPE ExceptionType,\r | |
54 | OUT VOID **Stub\r | |
55 | )\r | |
56 | {\r | |
57 | UINT8 *StubCopy;\r | |
58 | \r | |
59 | StubCopy = *Stub;\r | |
60 | \r | |
61 | //\r | |
62 | // Fixup the stub code for this vector\r | |
63 | //\r | |
64 | \r | |
65 | // The stub code looks like this:\r | |
66 | //\r | |
67 | // 00000000 6A 00 push 0 ; push vector number - will be modified before installed\r | |
68 | // 00000002 E9 db 0e9h ; jump rel32\r | |
69 | // 00000003 00000000 dd 0 ; fixed up to relative address of CommonIdtEntry\r | |
70 | //\r | |
71 | \r | |
72 | //\r | |
73 | // poke in the exception type so the second push pushes the exception type\r | |
74 | //\r | |
75 | StubCopy[0x1] = (UINT8) ExceptionType;\r | |
76 | \r | |
77 | //\r | |
78 | // fixup the jump target to point to the common entry\r | |
79 | //\r | |
80 | *(UINT32 *) &StubCopy[0x3] = (UINT32)((UINTN) CommonIdtEntry - (UINTN) &StubCopy[StubSize]);\r | |
81 | \r | |
c84507ab | 82 | return;\r |
6e8a984e | 83 | }\r |
84 | \r | |
85 | /**\r | |
86 | This is the main worker function that manages the state of the interrupt\r | |
87 | handlers. It both installs and uninstalls interrupt handlers based on the\r | |
88 | value of NewCallback. If NewCallback is NULL, then uninstall is indicated.\r | |
89 | If NewCallback is non-NULL, then install is indicated.\r | |
90 | \r | |
91 | @param NewCallback If non-NULL, NewCallback specifies the new handler to register.\r | |
92 | If NULL, specifies that the previously registered handler should\r | |
93 | be uninstalled.\r | |
94 | @param ExceptionType Indicates which entry to manage.\r | |
95 | \r | |
96 | @retval EFI_SUCCESS Process is ok.\r | |
97 | @retval EFI_INVALID_PARAMETER Requested uninstalling a handler from a vector that has\r | |
98 | no handler registered for it\r | |
99 | @retval EFI_ALREADY_STARTED Requested install to a vector that already has a handler registered.\r | |
100 | @retval others Possible return values are passed through from UnHookEntry and HookEntry.\r | |
101 | \r | |
102 | **/\r | |
103 | EFI_STATUS\r | |
104 | ManageIdtEntryTable (\r | |
1ccdbf2a | 105 | CALLBACK_FUNC NewCallback,\r |
6e8a984e | 106 | EFI_EXCEPTION_TYPE ExceptionType\r |
107 | )\r | |
108 | {\r | |
109 | EFI_STATUS Status;\r | |
110 | \r | |
111 | Status = EFI_SUCCESS;\r | |
112 | \r | |
113 | if (CompareMem (&IdtEntryTable[ExceptionType].NewDesc, &NullDesc, sizeof (IA32_IDT_GATE_DESCRIPTOR)) != 0) {\r | |
114 | //\r | |
115 | // we've already installed to this vector\r | |
116 | //\r | |
117 | if (NewCallback != NULL) {\r | |
118 | //\r | |
119 | // if the input handler is non-null, error\r | |
120 | //\r | |
121 | Status = EFI_ALREADY_STARTED;\r | |
122 | } else {\r | |
c84507ab | 123 | UnhookEntry (ExceptionType);\r |
6e8a984e | 124 | }\r |
125 | } else {\r | |
126 | //\r | |
127 | // no user handler installed on this vector\r | |
128 | //\r | |
129 | if (NewCallback == NULL) {\r | |
130 | //\r | |
131 | // if the input handler is null, error\r | |
132 | //\r | |
133 | Status = EFI_INVALID_PARAMETER;\r | |
134 | } else {\r | |
c84507ab | 135 | HookEntry (ExceptionType, NewCallback);\r |
6e8a984e | 136 | }\r |
137 | }\r | |
cfcbb8bc | 138 | \r |
6e8a984e | 139 | return Status;\r |
140 | }\r |