]>
Commit | Line | Data |
---|---|---|
2af538fb RN |
1 | /** @file\r |
2 | Implementation for a generic GOP driver.\r | |
3 | \r | |
4 | Copyright (c) 2016, Intel Corporation. All rights reserved.<BR>\r | |
9d510e61 | 5 | SPDX-License-Identifier: BSD-2-Clause-Patent\r |
2af538fb RN |
6 | \r |
7 | \r | |
8 | **/\r | |
9 | \r | |
10 | #include "GraphicsOutput.h"\r | |
1436aea4 | 11 | CONST ACPI_ADR_DEVICE_PATH mGraphicsOutputAdrNode = {\r |
2af538fb RN |
12 | {\r |
13 | ACPI_DEVICE_PATH,\r | |
14 | ACPI_ADR_DP,\r | |
15 | { sizeof (ACPI_ADR_DEVICE_PATH), 0 },\r | |
16 | },\r | |
17 | ACPI_DISPLAY_ADR (1, 0, 0, 1, 0, ACPI_ADR_DISPLAY_TYPE_VGA, 0, 0)\r | |
18 | };\r | |
19 | \r | |
1436aea4 | 20 | EFI_PEI_GRAPHICS_DEVICE_INFO_HOB mDefaultGraphicsDeviceInfo = {\r |
2af538fb RN |
21 | MAX_UINT16, MAX_UINT16, MAX_UINT16, MAX_UINT16, MAX_UINT8, MAX_UINT8\r |
22 | };\r | |
23 | \r | |
24 | //\r | |
25 | // The driver should only start on one graphics controller.\r | |
26 | // So a global flag is used to remember that the driver is already started.\r | |
27 | //\r | |
1436aea4 | 28 | BOOLEAN mDriverStarted = FALSE;\r |
2af538fb RN |
29 | \r |
30 | /**\r | |
31 | Returns information for an available graphics mode that the graphics device\r | |
32 | and the set of active video output devices supports.\r | |
33 | \r | |
34 | @param This The EFI_GRAPHICS_OUTPUT_PROTOCOL instance.\r | |
35 | @param ModeNumber The mode number to return information on.\r | |
36 | @param SizeOfInfo A pointer to the size, in bytes, of the Info buffer.\r | |
37 | @param Info A pointer to callee allocated buffer that returns information about ModeNumber.\r | |
38 | \r | |
39 | @retval EFI_SUCCESS Valid mode information was returned.\r | |
40 | @retval EFI_DEVICE_ERROR A hardware error occurred trying to retrieve the video mode.\r | |
41 | @retval EFI_INVALID_PARAMETER ModeNumber is not valid.\r | |
42 | \r | |
43 | **/\r | |
44 | EFI_STATUS\r | |
45 | EFIAPI\r | |
46 | GraphicsOutputQueryMode (\r | |
47 | IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r | |
48 | IN UINT32 ModeNumber,\r | |
49 | OUT UINTN *SizeOfInfo,\r | |
50 | OUT EFI_GRAPHICS_OUTPUT_MODE_INFORMATION **Info\r | |
51 | )\r | |
52 | {\r | |
1436aea4 | 53 | if ((This == NULL) || (Info == NULL) || (SizeOfInfo == NULL) || (ModeNumber >= This->Mode->MaxMode)) {\r |
2af538fb RN |
54 | return EFI_INVALID_PARAMETER;\r |
55 | }\r | |
56 | \r | |
57 | *SizeOfInfo = This->Mode->SizeOfInfo;\r | |
58 | *Info = AllocateCopyPool (*SizeOfInfo, This->Mode->Info);\r | |
59 | return EFI_SUCCESS;\r | |
60 | }\r | |
61 | \r | |
62 | /**\r | |
63 | Set the video device into the specified mode and clears the visible portions of\r | |
64 | the output display to black.\r | |
65 | \r | |
66 | @param This The EFI_GRAPHICS_OUTPUT_PROTOCOL instance.\r | |
67 | @param ModeNumber Abstraction that defines the current video mode.\r | |
68 | \r | |
69 | @retval EFI_SUCCESS The graphics mode specified by ModeNumber was selected.\r | |
70 | @retval EFI_DEVICE_ERROR The device had an error and could not complete the request.\r | |
71 | @retval EFI_UNSUPPORTED ModeNumber is not supported by this device.\r | |
72 | \r | |
73 | **/\r | |
74 | EFI_STATUS\r | |
75 | EFIAPI\r | |
76 | GraphicsOutputSetMode (\r | |
1436aea4 MK |
77 | IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r |
78 | IN UINT32 ModeNumber\r | |
79 | )\r | |
2af538fb | 80 | {\r |
1436aea4 MK |
81 | RETURN_STATUS Status;\r |
82 | EFI_GRAPHICS_OUTPUT_BLT_PIXEL Black;\r | |
83 | GRAPHICS_OUTPUT_PRIVATE_DATA *Private;\r | |
2af538fb RN |
84 | \r |
85 | if (ModeNumber >= This->Mode->MaxMode) {\r | |
86 | return EFI_UNSUPPORTED;\r | |
87 | }\r | |
88 | \r | |
89 | Private = GRAPHICS_OUTPUT_PRIVATE_FROM_THIS (This);\r | |
90 | \r | |
1436aea4 MK |
91 | Black.Blue = 0;\r |
92 | Black.Green = 0;\r | |
93 | Black.Red = 0;\r | |
2af538fb RN |
94 | Black.Reserved = 0;\r |
95 | \r | |
96 | Status = FrameBufferBlt (\r | |
97 | Private->FrameBufferBltLibConfigure,\r | |
98 | &Black,\r | |
99 | EfiBltVideoFill,\r | |
1436aea4 MK |
100 | 0,\r |
101 | 0,\r | |
102 | 0,\r | |
103 | 0,\r | |
2af538fb RN |
104 | This->Mode->Info->HorizontalResolution,\r |
105 | This->Mode->Info->VerticalResolution,\r | |
106 | 0\r | |
107 | );\r | |
108 | return RETURN_ERROR (Status) ? EFI_DEVICE_ERROR : EFI_SUCCESS;\r | |
109 | }\r | |
110 | \r | |
111 | /**\r | |
112 | Blt a rectangle of pixels on the graphics screen. Blt stands for BLock Transfer.\r | |
113 | \r | |
114 | @param This Protocol instance pointer.\r | |
115 | @param BltBuffer The data to transfer to the graphics screen.\r | |
116 | Size is at least Width*Height*sizeof(EFI_GRAPHICS_OUTPUT_BLT_PIXEL).\r | |
117 | @param BltOperation The operation to perform when copying BltBuffer on to the graphics screen.\r | |
118 | @param SourceX The X coordinate of source for the BltOperation.\r | |
119 | @param SourceY The Y coordinate of source for the BltOperation.\r | |
120 | @param DestinationX The X coordinate of destination for the BltOperation.\r | |
121 | @param DestinationY The Y coordinate of destination for the BltOperation.\r | |
122 | @param Width The width of a rectangle in the blt rectangle in pixels.\r | |
123 | @param Height The height of a rectangle in the blt rectangle in pixels.\r | |
124 | @param Delta Not used for EfiBltVideoFill or the EfiBltVideoToVideo operation.\r | |
125 | If a Delta of zero is used, the entire BltBuffer is being operated on.\r | |
126 | If a subrectangle of the BltBuffer is being used then Delta\r | |
127 | represents the number of bytes in a row of the BltBuffer.\r | |
128 | \r | |
129 | @retval EFI_SUCCESS BltBuffer was drawn to the graphics screen.\r | |
130 | @retval EFI_INVALID_PARAMETER BltOperation is not valid.\r | |
131 | @retval EFI_DEVICE_ERROR The device had an error and could not complete the request.\r | |
132 | \r | |
133 | **/\r | |
134 | EFI_STATUS\r | |
135 | EFIAPI\r | |
136 | GraphicsOutputBlt (\r | |
1436aea4 MK |
137 | IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r |
138 | IN EFI_GRAPHICS_OUTPUT_BLT_PIXEL *BltBuffer OPTIONAL,\r | |
139 | IN EFI_GRAPHICS_OUTPUT_BLT_OPERATION BltOperation,\r | |
140 | IN UINTN SourceX,\r | |
141 | IN UINTN SourceY,\r | |
142 | IN UINTN DestinationX,\r | |
143 | IN UINTN DestinationY,\r | |
144 | IN UINTN Width,\r | |
145 | IN UINTN Height,\r | |
146 | IN UINTN Delta OPTIONAL\r | |
2af538fb RN |
147 | )\r |
148 | {\r | |
1436aea4 MK |
149 | RETURN_STATUS Status;\r |
150 | EFI_TPL Tpl;\r | |
151 | GRAPHICS_OUTPUT_PRIVATE_DATA *Private;\r | |
2af538fb RN |
152 | \r |
153 | Private = GRAPHICS_OUTPUT_PRIVATE_FROM_THIS (This);\r | |
154 | //\r | |
155 | // We have to raise to TPL_NOTIFY, so we make an atomic write to the frame buffer.\r | |
156 | // We would not want a timer based event (Cursor, ...) to come in while we are\r | |
157 | // doing this operation.\r | |
158 | //\r | |
1436aea4 | 159 | Tpl = gBS->RaiseTPL (TPL_NOTIFY);\r |
2af538fb RN |
160 | Status = FrameBufferBlt (\r |
161 | Private->FrameBufferBltLibConfigure,\r | |
162 | BltBuffer,\r | |
163 | BltOperation,\r | |
1436aea4 MK |
164 | SourceX,\r |
165 | SourceY,\r | |
166 | DestinationX,\r | |
167 | DestinationY,\r | |
168 | Width,\r | |
169 | Height,\r | |
2af538fb RN |
170 | Delta\r |
171 | );\r | |
172 | gBS->RestoreTPL (Tpl);\r | |
173 | \r | |
174 | return RETURN_ERROR (Status) ? EFI_INVALID_PARAMETER : EFI_SUCCESS;\r | |
175 | }\r | |
176 | \r | |
1436aea4 | 177 | CONST GRAPHICS_OUTPUT_PRIVATE_DATA mGraphicsOutputInstanceTemplate = {\r |
2af538fb RN |
178 | GRAPHICS_OUTPUT_PRIVATE_DATA_SIGNATURE, // Signature\r |
179 | NULL, // GraphicsOutputHandle\r | |
180 | {\r | |
181 | GraphicsOutputQueryMode,\r | |
182 | GraphicsOutputSetMode,\r | |
183 | GraphicsOutputBlt,\r | |
184 | NULL // Mode\r | |
185 | },\r | |
186 | {\r | |
187 | 1, // MaxMode\r | |
188 | 0, // Mode\r | |
189 | NULL, // Info\r | |
190 | sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION), // SizeOfInfo\r | |
191 | 0, // FrameBufferBase\r | |
192 | 0 // FrameBufferSize\r | |
193 | },\r | |
194 | NULL, // DevicePath\r | |
195 | NULL, // PciIo\r | |
196 | 0, // PciAttributes\r | |
197 | NULL, // FrameBufferBltLibConfigure\r | |
198 | 0 // FrameBufferBltLibConfigureSize\r | |
199 | };\r | |
200 | \r | |
201 | /**\r | |
202 | Test whether the Controller can be managed by the driver.\r | |
203 | \r | |
204 | @param This Driver Binding protocol instance pointer.\r | |
205 | @param Controller The PCI controller.\r | |
206 | @param RemainingDevicePath Optional parameter use to pick a specific child\r | |
207 | device to start.\r | |
208 | \r | |
209 | @retval EFI_SUCCESS The driver can manage the video device.\r | |
210 | @retval other The driver cannot manage the video device.\r | |
211 | **/\r | |
212 | EFI_STATUS\r | |
213 | EFIAPI\r | |
214 | GraphicsOutputDriverBindingSupported (\r | |
1436aea4 MK |
215 | IN EFI_DRIVER_BINDING_PROTOCOL *This,\r |
216 | IN EFI_HANDLE Controller,\r | |
217 | IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath\r | |
2af538fb RN |
218 | )\r |
219 | {\r | |
1436aea4 MK |
220 | EFI_STATUS Status;\r |
221 | EFI_PCI_IO_PROTOCOL *PciIo;\r | |
222 | EFI_DEVICE_PATH_PROTOCOL *DevicePath;\r | |
2af538fb RN |
223 | \r |
224 | //\r | |
225 | // Since there is only one GraphicsInfo HOB, the driver only manages one video device.\r | |
226 | //\r | |
227 | if (mDriverStarted) {\r | |
228 | return EFI_ALREADY_STARTED;\r | |
229 | }\r | |
230 | \r | |
231 | //\r | |
232 | // Test the PCI I/O Protocol\r | |
233 | //\r | |
234 | Status = gBS->OpenProtocol (\r | |
235 | Controller,\r | |
236 | &gEfiPciIoProtocolGuid,\r | |
1436aea4 | 237 | (VOID **)&PciIo,\r |
2af538fb RN |
238 | This->DriverBindingHandle,\r |
239 | Controller,\r | |
240 | EFI_OPEN_PROTOCOL_BY_DRIVER\r | |
241 | );\r | |
242 | if (Status == EFI_ALREADY_STARTED) {\r | |
243 | Status = EFI_SUCCESS;\r | |
244 | }\r | |
1436aea4 | 245 | \r |
2af538fb RN |
246 | if (EFI_ERROR (Status)) {\r |
247 | return Status;\r | |
248 | }\r | |
1436aea4 | 249 | \r |
2af538fb RN |
250 | gBS->CloseProtocol (\r |
251 | Controller,\r | |
252 | &gEfiPciIoProtocolGuid,\r | |
253 | This->DriverBindingHandle,\r | |
254 | Controller\r | |
255 | );\r | |
256 | \r | |
257 | //\r | |
258 | // Test the DevicePath protocol\r | |
259 | //\r | |
260 | Status = gBS->OpenProtocol (\r | |
261 | Controller,\r | |
262 | &gEfiDevicePathProtocolGuid,\r | |
1436aea4 | 263 | (VOID **)&DevicePath,\r |
2af538fb RN |
264 | This->DriverBindingHandle,\r |
265 | Controller,\r | |
266 | EFI_OPEN_PROTOCOL_BY_DRIVER\r | |
267 | );\r | |
268 | if (Status == EFI_ALREADY_STARTED) {\r | |
269 | Status = EFI_SUCCESS;\r | |
270 | }\r | |
1436aea4 | 271 | \r |
2af538fb RN |
272 | if (EFI_ERROR (Status)) {\r |
273 | return Status;\r | |
274 | }\r | |
1436aea4 | 275 | \r |
2af538fb RN |
276 | gBS->CloseProtocol (\r |
277 | Controller,\r | |
278 | &gEfiDevicePathProtocolGuid,\r | |
279 | This->DriverBindingHandle,\r | |
280 | Controller\r | |
281 | );\r | |
282 | \r | |
283 | if ((RemainingDevicePath == NULL) ||\r | |
284 | IsDevicePathEnd (RemainingDevicePath) ||\r | |
1436aea4 MK |
285 | (CompareMem (RemainingDevicePath, &mGraphicsOutputAdrNode, sizeof (mGraphicsOutputAdrNode)) == 0))\r |
286 | {\r | |
2af538fb RN |
287 | return EFI_SUCCESS;\r |
288 | } else {\r | |
289 | return EFI_INVALID_PARAMETER;\r | |
290 | }\r | |
291 | }\r | |
292 | \r | |
293 | /**\r | |
294 | Start the video controller.\r | |
295 | \r | |
296 | @param This Driver Binding protocol instance pointer.\r | |
297 | @param ControllerHandle The PCI controller.\r | |
298 | @param RemainingDevicePath Optional parameter use to pick a specific child\r | |
299 | device to start.\r | |
300 | \r | |
301 | @retval EFI_SUCCESS The driver starts to manage the video device.\r | |
302 | @retval other The driver cannot manage the video device.\r | |
303 | **/\r | |
304 | EFI_STATUS\r | |
305 | EFIAPI\r | |
306 | GraphicsOutputDriverBindingStart (\r | |
1436aea4 MK |
307 | IN EFI_DRIVER_BINDING_PROTOCOL *This,\r |
308 | IN EFI_HANDLE Controller,\r | |
309 | IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath\r | |
2af538fb RN |
310 | )\r |
311 | {\r | |
1436aea4 MK |
312 | EFI_STATUS Status;\r |
313 | RETURN_STATUS ReturnStatus;\r | |
314 | GRAPHICS_OUTPUT_PRIVATE_DATA *Private;\r | |
315 | EFI_PCI_IO_PROTOCOL *PciIo;\r | |
316 | EFI_DEVICE_PATH *PciDevicePath;\r | |
317 | PCI_TYPE00 Pci;\r | |
318 | UINT8 Index;\r | |
319 | EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR *Resources;\r | |
320 | VOID *HobStart;\r | |
321 | EFI_PEI_GRAPHICS_INFO_HOB *GraphicsInfo;\r | |
322 | EFI_PEI_GRAPHICS_DEVICE_INFO_HOB *DeviceInfo;\r | |
323 | EFI_PHYSICAL_ADDRESS FrameBufferBase;\r | |
2af538fb RN |
324 | \r |
325 | FrameBufferBase = 0;\r | |
326 | \r | |
327 | HobStart = GetFirstGuidHob (&gEfiGraphicsInfoHobGuid);\r | |
328 | ASSERT ((HobStart != NULL) && (GET_GUID_HOB_DATA_SIZE (HobStart) == sizeof (EFI_PEI_GRAPHICS_INFO_HOB)));\r | |
1436aea4 | 329 | GraphicsInfo = (EFI_PEI_GRAPHICS_INFO_HOB *)(GET_GUID_HOB_DATA (HobStart));\r |
2af538fb RN |
330 | \r |
331 | HobStart = GetFirstGuidHob (&gEfiGraphicsDeviceInfoHobGuid);\r | |
332 | if ((HobStart == NULL) || (GET_GUID_HOB_DATA_SIZE (HobStart) < sizeof (*DeviceInfo))) {\r | |
333 | //\r | |
334 | // Use default device infomation when the device info HOB doesn't exist\r | |
335 | //\r | |
336 | DeviceInfo = &mDefaultGraphicsDeviceInfo;\r | |
87000d77 | 337 | DEBUG ((DEBUG_INFO, "[%a]: GraphicsDeviceInfo HOB doesn't exist!\n", gEfiCallerBaseName));\r |
2af538fb | 338 | } else {\r |
1436aea4 MK |
339 | DeviceInfo = (EFI_PEI_GRAPHICS_DEVICE_INFO_HOB *)(GET_GUID_HOB_DATA (HobStart));\r |
340 | DEBUG ((\r | |
341 | DEBUG_INFO,\r | |
342 | "[%a]: GraphicsDeviceInfo HOB:\n"\r | |
343 | " VendorId = %04x, DeviceId = %04x,\n"\r | |
344 | " RevisionId = %02x, BarIndex = %x,\n"\r | |
345 | " SubsystemVendorId = %04x, SubsystemId = %04x\n",\r | |
346 | gEfiCallerBaseName,\r | |
347 | DeviceInfo->VendorId,\r | |
348 | DeviceInfo->DeviceId,\r | |
349 | DeviceInfo->RevisionId,\r | |
350 | DeviceInfo->BarIndex,\r | |
351 | DeviceInfo->SubsystemVendorId,\r | |
352 | DeviceInfo->SubsystemId\r | |
353 | ));\r | |
2af538fb RN |
354 | }\r |
355 | \r | |
356 | //\r | |
357 | // Open the PCI I/O Protocol\r | |
358 | //\r | |
359 | Status = gBS->OpenProtocol (\r | |
360 | Controller,\r | |
361 | &gEfiPciIoProtocolGuid,\r | |
1436aea4 | 362 | (VOID **)&PciIo,\r |
2af538fb RN |
363 | This->DriverBindingHandle,\r |
364 | Controller,\r | |
365 | EFI_OPEN_PROTOCOL_BY_DRIVER\r | |
366 | );\r | |
367 | if (Status == EFI_ALREADY_STARTED) {\r | |
368 | Status = EFI_SUCCESS;\r | |
369 | }\r | |
1436aea4 | 370 | \r |
2af538fb RN |
371 | ASSERT_EFI_ERROR (Status);\r |
372 | \r | |
373 | Status = gBS->OpenProtocol (\r | |
374 | Controller,\r | |
375 | &gEfiDevicePathProtocolGuid,\r | |
1436aea4 | 376 | (VOID **)&PciDevicePath,\r |
2af538fb RN |
377 | This->DriverBindingHandle,\r |
378 | Controller,\r | |
379 | EFI_OPEN_PROTOCOL_BY_DRIVER\r | |
380 | );\r | |
381 | if (Status == EFI_ALREADY_STARTED) {\r | |
382 | Status = EFI_SUCCESS;\r | |
383 | }\r | |
1436aea4 | 384 | \r |
2af538fb RN |
385 | ASSERT_EFI_ERROR (Status);\r |
386 | \r | |
387 | //\r | |
388 | // Read the PCI Class Code from the PCI Device\r | |
389 | //\r | |
390 | Status = PciIo->Pci.Read (PciIo, EfiPciIoWidthUint8, 0, sizeof (Pci), &Pci);\r | |
391 | if (!EFI_ERROR (Status)) {\r | |
392 | if (!IS_PCI_DISPLAY (&Pci) || (\r | |
1436aea4 MK |
393 | ((DeviceInfo->VendorId != MAX_UINT16) && (DeviceInfo->VendorId != Pci.Hdr.VendorId)) ||\r |
394 | ((DeviceInfo->DeviceId != MAX_UINT16) && (DeviceInfo->DeviceId != Pci.Hdr.DeviceId)) ||\r | |
395 | ((DeviceInfo->RevisionId != MAX_UINT8) && (DeviceInfo->RevisionId != Pci.Hdr.RevisionID)) ||\r | |
396 | ((DeviceInfo->SubsystemVendorId != MAX_UINT16) && (DeviceInfo->SubsystemVendorId != Pci.Device.SubsystemVendorID)) ||\r | |
397 | ((DeviceInfo->SubsystemId != MAX_UINT16) && (DeviceInfo->SubsystemId != Pci.Device.SubsystemID))\r | |
398 | )\r | |
2af538fb | 399 | )\r |
1436aea4 | 400 | {\r |
2af538fb RN |
401 | //\r |
402 | // It's not a video device, or device infomation doesn't match.\r | |
403 | //\r | |
404 | Status = EFI_UNSUPPORTED;\r | |
405 | } else {\r | |
406 | //\r | |
407 | // If it's a video device and device information matches, use the BarIndex\r | |
408 | // from device information, or any BAR if BarIndex is not specified\r | |
409 | // whose size >= the frame buffer size from GraphicsInfo HOB.\r | |
410 | // Store the new frame buffer base.\r | |
411 | //\r | |
412 | for (Index = 0; Index < MAX_PCI_BAR; Index++) {\r | |
413 | if ((DeviceInfo->BarIndex != MAX_UINT8) && (DeviceInfo->BarIndex != Index)) {\r | |
414 | continue;\r | |
415 | }\r | |
1436aea4 MK |
416 | \r |
417 | Status = PciIo->GetBarAttributes (PciIo, Index, NULL, (VOID **)&Resources);\r | |
2af538fb | 418 | if (!EFI_ERROR (Status)) {\r |
1436aea4 MK |
419 | DEBUG ((\r |
420 | DEBUG_INFO,\r | |
421 | "[%a]: BAR[%d]: Base = %lx, Length = %lx\n",\r | |
422 | gEfiCallerBaseName,\r | |
423 | Index,\r | |
424 | Resources->AddrRangeMin,\r | |
425 | Resources->AddrLen\r | |
426 | ));\r | |
2af538fb | 427 | if ((Resources->Desc == ACPI_ADDRESS_SPACE_DESCRIPTOR) &&\r |
1436aea4 | 428 | (Resources->Len == (UINT16)(sizeof (EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR) - 3)) &&\r |
2af538fb RN |
429 | (Resources->ResType == ACPI_ADDRESS_SPACE_TYPE_MEM) &&\r |
430 | (Resources->AddrLen >= GraphicsInfo->FrameBufferSize)\r | |
1436aea4 MK |
431 | )\r |
432 | {\r | |
2af538fb | 433 | FrameBufferBase = Resources->AddrRangeMin;\r |
87000d77 | 434 | DEBUG ((DEBUG_INFO, "[%a]: ... matched!\n", gEfiCallerBaseName));\r |
2af538fb RN |
435 | break;\r |
436 | }\r | |
437 | }\r | |
438 | }\r | |
1436aea4 | 439 | \r |
2af538fb RN |
440 | if (Index == MAX_PCI_BAR) {\r |
441 | Status = EFI_UNSUPPORTED;\r | |
442 | }\r | |
443 | }\r | |
444 | }\r | |
445 | \r | |
446 | if (EFI_ERROR (Status)) {\r | |
447 | goto CloseProtocols;\r | |
448 | }\r | |
449 | \r | |
450 | if ((RemainingDevicePath != NULL) && IsDevicePathEnd (RemainingDevicePath)) {\r | |
451 | return EFI_SUCCESS;\r | |
452 | }\r | |
453 | \r | |
454 | Private = AllocateCopyPool (sizeof (mGraphicsOutputInstanceTemplate), &mGraphicsOutputInstanceTemplate);\r | |
455 | if (Private == NULL) {\r | |
456 | Status = EFI_OUT_OF_RESOURCES;\r | |
457 | goto CloseProtocols;\r | |
458 | }\r | |
459 | \r | |
460 | Private->GraphicsOutputMode.FrameBufferBase = FrameBufferBase;\r | |
461 | Private->GraphicsOutputMode.FrameBufferSize = GraphicsInfo->FrameBufferSize;\r | |
1436aea4 | 462 | Private->GraphicsOutputMode.Info = &GraphicsInfo->GraphicsMode;\r |
2af538fb RN |
463 | \r |
464 | //\r | |
465 | // Fix up Mode pointer in GraphicsOutput\r | |
466 | //\r | |
467 | Private->GraphicsOutput.Mode = &Private->GraphicsOutputMode;\r | |
468 | \r | |
469 | //\r | |
470 | // Set attributes\r | |
471 | //\r | |
472 | Status = PciIo->Attributes (\r | |
473 | PciIo,\r | |
474 | EfiPciIoAttributeOperationGet,\r | |
475 | 0,\r | |
476 | &Private->PciAttributes\r | |
477 | );\r | |
478 | if (!EFI_ERROR (Status)) {\r | |
479 | Status = PciIo->Attributes (\r | |
480 | PciIo,\r | |
481 | EfiPciIoAttributeOperationEnable,\r | |
482 | EFI_PCI_DEVICE_ENABLE,\r | |
483 | NULL\r | |
484 | );\r | |
485 | }\r | |
486 | \r | |
487 | if (EFI_ERROR (Status)) {\r | |
488 | goto FreeMemory;\r | |
489 | }\r | |
490 | \r | |
491 | //\r | |
492 | // Create the FrameBufferBltLib configuration.\r | |
493 | //\r | |
494 | ReturnStatus = FrameBufferBltConfigure (\r | |
1436aea4 | 495 | (VOID *)(UINTN)Private->GraphicsOutput.Mode->FrameBufferBase,\r |
2af538fb RN |
496 | Private->GraphicsOutput.Mode->Info,\r |
497 | Private->FrameBufferBltLibConfigure,\r | |
498 | &Private->FrameBufferBltLibConfigureSize\r | |
499 | );\r | |
500 | if (ReturnStatus == RETURN_BUFFER_TOO_SMALL) {\r | |
501 | Private->FrameBufferBltLibConfigure = AllocatePool (Private->FrameBufferBltLibConfigureSize);\r | |
502 | if (Private->FrameBufferBltLibConfigure != NULL) {\r | |
503 | ReturnStatus = FrameBufferBltConfigure (\r | |
1436aea4 | 504 | (VOID *)(UINTN)Private->GraphicsOutput.Mode->FrameBufferBase,\r |
2af538fb RN |
505 | Private->GraphicsOutput.Mode->Info,\r |
506 | Private->FrameBufferBltLibConfigure,\r | |
507 | &Private->FrameBufferBltLibConfigureSize\r | |
508 | );\r | |
509 | }\r | |
510 | }\r | |
1436aea4 | 511 | \r |
2af538fb RN |
512 | if (RETURN_ERROR (ReturnStatus)) {\r |
513 | Status = EFI_OUT_OF_RESOURCES;\r | |
514 | goto RestorePciAttributes;\r | |
515 | }\r | |
516 | \r | |
1436aea4 | 517 | Private->DevicePath = AppendDevicePathNode (PciDevicePath, (EFI_DEVICE_PATH_PROTOCOL *)&mGraphicsOutputAdrNode);\r |
2af538fb RN |
518 | if (Private->DevicePath == NULL) {\r |
519 | Status = EFI_OUT_OF_RESOURCES;\r | |
520 | goto RestorePciAttributes;\r | |
521 | }\r | |
522 | \r | |
523 | Status = gBS->InstallMultipleProtocolInterfaces (\r | |
524 | &Private->GraphicsOutputHandle,\r | |
1436aea4 MK |
525 | &gEfiGraphicsOutputProtocolGuid,\r |
526 | &Private->GraphicsOutput,\r | |
527 | &gEfiDevicePathProtocolGuid,\r | |
528 | Private->DevicePath,\r | |
2af538fb RN |
529 | NULL\r |
530 | );\r | |
531 | \r | |
532 | if (!EFI_ERROR (Status)) {\r | |
533 | Status = gBS->OpenProtocol (\r | |
534 | Controller,\r | |
535 | &gEfiPciIoProtocolGuid,\r | |
1436aea4 | 536 | (VOID **)&Private->PciIo,\r |
2af538fb RN |
537 | This->DriverBindingHandle,\r |
538 | Private->GraphicsOutputHandle,\r | |
539 | EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER\r | |
540 | );\r | |
541 | if (!EFI_ERROR (Status)) {\r | |
542 | mDriverStarted = TRUE;\r | |
543 | } else {\r | |
544 | gBS->UninstallMultipleProtocolInterfaces (\r | |
545 | Private->GraphicsOutputHandle,\r | |
1436aea4 MK |
546 | &gEfiGraphicsOutputProtocolGuid,\r |
547 | &Private->GraphicsOutput,\r | |
548 | &gEfiDevicePathProtocolGuid,\r | |
549 | Private->DevicePath,\r | |
2af538fb RN |
550 | NULL\r |
551 | );\r | |
552 | }\r | |
553 | }\r | |
554 | \r | |
555 | RestorePciAttributes:\r | |
556 | if (EFI_ERROR (Status)) {\r | |
557 | //\r | |
558 | // Restore original PCI attributes\r | |
559 | //\r | |
560 | PciIo->Attributes (\r | |
561 | PciIo,\r | |
562 | EfiPciIoAttributeOperationSet,\r | |
563 | Private->PciAttributes,\r | |
564 | NULL\r | |
565 | );\r | |
566 | }\r | |
567 | \r | |
568 | FreeMemory:\r | |
569 | if (EFI_ERROR (Status)) {\r | |
570 | if (Private != NULL) {\r | |
571 | if (Private->DevicePath != NULL) {\r | |
572 | FreePool (Private->DevicePath);\r | |
573 | }\r | |
1436aea4 | 574 | \r |
2af538fb RN |
575 | if (Private->FrameBufferBltLibConfigure != NULL) {\r |
576 | FreePool (Private->FrameBufferBltLibConfigure);\r | |
577 | }\r | |
1436aea4 | 578 | \r |
2af538fb RN |
579 | FreePool (Private);\r |
580 | }\r | |
581 | }\r | |
582 | \r | |
583 | CloseProtocols:\r | |
584 | if (EFI_ERROR (Status)) {\r | |
585 | //\r | |
586 | // Close the PCI I/O Protocol\r | |
587 | //\r | |
588 | gBS->CloseProtocol (\r | |
589 | Controller,\r | |
590 | &gEfiDevicePathProtocolGuid,\r | |
591 | This->DriverBindingHandle,\r | |
592 | Controller\r | |
593 | );\r | |
594 | \r | |
595 | //\r | |
596 | // Close the PCI I/O Protocol\r | |
597 | //\r | |
598 | gBS->CloseProtocol (\r | |
599 | Controller,\r | |
600 | &gEfiPciIoProtocolGuid,\r | |
601 | This->DriverBindingHandle,\r | |
602 | Controller\r | |
603 | );\r | |
604 | }\r | |
1436aea4 | 605 | \r |
2af538fb RN |
606 | return Status;\r |
607 | }\r | |
608 | \r | |
609 | /**\r | |
610 | Stop the video controller.\r | |
611 | \r | |
612 | @param This Driver Binding protocol instance pointer.\r | |
613 | @param Controller The PCI controller.\r | |
614 | @param NumberOfChildren The number of child device handles in ChildHandleBuffer.\r | |
615 | @param ChildHandleBuffer An array of child handles to be freed. May be NULL\r | |
616 | if NumberOfChildren is 0.\r | |
617 | \r | |
618 | @retval EFI_SUCCESS The device was stopped.\r | |
619 | @retval EFI_DEVICE_ERROR The device could not be stopped due to a device error.\r | |
620 | **/\r | |
621 | EFI_STATUS\r | |
622 | EFIAPI\r | |
623 | GraphicsOutputDriverBindingStop (\r | |
1436aea4 MK |
624 | IN EFI_DRIVER_BINDING_PROTOCOL *This,\r |
625 | IN EFI_HANDLE Controller,\r | |
626 | IN UINTN NumberOfChildren,\r | |
627 | IN EFI_HANDLE *ChildHandleBuffer\r | |
2af538fb RN |
628 | )\r |
629 | {\r | |
1436aea4 MK |
630 | EFI_STATUS Status;\r |
631 | EFI_GRAPHICS_OUTPUT_PROTOCOL *Gop;\r | |
632 | GRAPHICS_OUTPUT_PRIVATE_DATA *Private;\r | |
2af538fb RN |
633 | \r |
634 | if (NumberOfChildren == 0) {\r | |
2af538fb RN |
635 | //\r |
636 | // Close the PCI I/O Protocol\r | |
637 | //\r | |
638 | Status = gBS->CloseProtocol (\r | |
639 | Controller,\r | |
640 | &gEfiPciIoProtocolGuid,\r | |
641 | This->DriverBindingHandle,\r | |
642 | Controller\r | |
643 | );\r | |
644 | ASSERT_EFI_ERROR (Status);\r | |
645 | \r | |
646 | Status = gBS->CloseProtocol (\r | |
647 | Controller,\r | |
648 | &gEfiDevicePathProtocolGuid,\r | |
649 | This->DriverBindingHandle,\r | |
650 | Controller\r | |
651 | );\r | |
652 | ASSERT_EFI_ERROR (Status);\r | |
653 | return EFI_SUCCESS;\r | |
654 | }\r | |
655 | \r | |
656 | ASSERT (NumberOfChildren == 1);\r | |
657 | Status = gBS->OpenProtocol (\r | |
658 | ChildHandleBuffer[0],\r | |
659 | &gEfiGraphicsOutputProtocolGuid,\r | |
1436aea4 | 660 | (VOID **)&Gop,\r |
2af538fb RN |
661 | This->DriverBindingHandle,\r |
662 | ChildHandleBuffer[0],\r | |
663 | EFI_OPEN_PROTOCOL_GET_PROTOCOL\r | |
664 | );\r | |
665 | if (EFI_ERROR (Status)) {\r | |
666 | return Status;\r | |
667 | }\r | |
668 | \r | |
669 | Private = GRAPHICS_OUTPUT_PRIVATE_FROM_THIS (Gop);\r | |
670 | \r | |
671 | Status = gBS->CloseProtocol (\r | |
672 | Controller,\r | |
673 | &gEfiPciIoProtocolGuid,\r | |
674 | This->DriverBindingHandle,\r | |
675 | Private->GraphicsOutputHandle\r | |
676 | );\r | |
677 | ASSERT_EFI_ERROR (Status);\r | |
678 | //\r | |
679 | // Remove the GOP protocol interface from the system\r | |
680 | //\r | |
681 | Status = gBS->UninstallMultipleProtocolInterfaces (\r | |
682 | Private->GraphicsOutputHandle,\r | |
1436aea4 MK |
683 | &gEfiGraphicsOutputProtocolGuid,\r |
684 | &Private->GraphicsOutput,\r | |
685 | &gEfiDevicePathProtocolGuid,\r | |
686 | Private->DevicePath,\r | |
2af538fb RN |
687 | NULL\r |
688 | );\r | |
689 | if (!EFI_ERROR (Status)) {\r | |
690 | //\r | |
691 | // Restore original PCI attributes\r | |
692 | //\r | |
693 | Status = Private->PciIo->Attributes (\r | |
694 | Private->PciIo,\r | |
695 | EfiPciIoAttributeOperationSet,\r | |
696 | Private->PciAttributes,\r | |
697 | NULL\r | |
698 | );\r | |
699 | ASSERT_EFI_ERROR (Status);\r | |
700 | \r | |
701 | FreePool (Private->DevicePath);\r | |
702 | FreePool (Private->FrameBufferBltLibConfigure);\r | |
703 | mDriverStarted = FALSE;\r | |
704 | } else {\r | |
705 | Status = gBS->OpenProtocol (\r | |
706 | Controller,\r | |
707 | &gEfiPciIoProtocolGuid,\r | |
1436aea4 | 708 | (VOID **)&Private->PciIo,\r |
2af538fb RN |
709 | This->DriverBindingHandle,\r |
710 | Private->GraphicsOutputHandle,\r | |
711 | EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER\r | |
712 | );\r | |
713 | ASSERT_EFI_ERROR (Status);\r | |
714 | }\r | |
1436aea4 | 715 | \r |
2af538fb RN |
716 | return Status;\r |
717 | }\r | |
718 | \r | |
1436aea4 | 719 | EFI_DRIVER_BINDING_PROTOCOL mGraphicsOutputDriverBinding = {\r |
2af538fb RN |
720 | GraphicsOutputDriverBindingSupported,\r |
721 | GraphicsOutputDriverBindingStart,\r | |
722 | GraphicsOutputDriverBindingStop,\r | |
723 | 0x10,\r | |
724 | NULL,\r | |
725 | NULL\r | |
726 | };\r | |
727 | \r | |
728 | /**\r | |
729 | The Entry Point for GraphicsOutput driver.\r | |
730 | \r | |
731 | It installs DriverBinding, ComponentName and ComponentName2 protocol if there is\r | |
732 | GraphicsInfo HOB passed from Graphics PEIM.\r | |
733 | \r | |
734 | @param[in] ImageHandle The firmware allocated handle for the EFI image.\r | |
735 | @param[in] SystemTable A pointer to the EFI System Table.\r | |
736 | \r | |
737 | @retval EFI_SUCCESS The entry point is executed successfully.\r | |
738 | @retval other Some error occurs when executing this entry point.\r | |
739 | \r | |
740 | **/\r | |
741 | EFI_STATUS\r | |
742 | EFIAPI\r | |
743 | InitializeGraphicsOutput (\r | |
1436aea4 MK |
744 | IN EFI_HANDLE ImageHandle,\r |
745 | IN EFI_SYSTEM_TABLE *SystemTable\r | |
2af538fb RN |
746 | )\r |
747 | {\r | |
1436aea4 MK |
748 | EFI_STATUS Status;\r |
749 | VOID *HobStart;\r | |
2af538fb RN |
750 | \r |
751 | HobStart = GetFirstGuidHob (&gEfiGraphicsInfoHobGuid);\r | |
752 | \r | |
753 | if ((HobStart == NULL) || (GET_GUID_HOB_DATA_SIZE (HobStart) < sizeof (EFI_PEI_GRAPHICS_INFO_HOB))) {\r | |
754 | return EFI_NOT_FOUND;\r | |
755 | }\r | |
756 | \r | |
757 | Status = EfiLibInstallDriverBindingComponentName2 (\r | |
758 | ImageHandle,\r | |
759 | SystemTable,\r | |
760 | &mGraphicsOutputDriverBinding,\r | |
761 | ImageHandle,\r | |
762 | &mGraphicsOutputComponentName,\r | |
763 | &mGraphicsOutputComponentName2\r | |
764 | );\r | |
765 | ASSERT_EFI_ERROR (Status);\r | |
766 | \r | |
767 | return Status;\r | |
768 | }\r |