]> git.proxmox.com Git - mirror_edk2.git/blame - OptionRomPkg/CirrusLogic5430Dxe/CirrusLogic5430.c
Adding a segment code to make sure that the EHCI controller get attached to the EHCI...
[mirror_edk2.git] / OptionRomPkg / CirrusLogic5430Dxe / CirrusLogic5430.c
CommitLineData
87f8ccbe 1/** @file\r
2 Cirrus Logic 5430 Controller Driver.\r
3 This driver is a sample implementation of the UGA Draw and Graphics Output\r
4 Protocols for the Cirrus Logic 5430 family of PCI video controllers.\r
5 This driver is only usable in the EFI pre-boot environment.\r
6 This sample is intended to show how the UGA Draw and Graphics output Protocol\r
94b73c24 7 is able to function.\r
87f8ccbe 8 The UGA I/O Protocol is not implemented in this sample.\r
9 A fully compliant EFI UGA driver requires both\r
10 the UGA Draw and the UGA I/O Protocol. Please refer to Microsoft's\r
11 documentation on UGA for details on how to write a UGA driver that is able\r
12 to function both in the EFI pre-boot environment and from the OS runtime.\r
13\r
94b73c24 14 Copyright (c) 2006, Intel Corporation\r
15 All rights reserved. This program and the accompanying materials\r
16 are licensed and made available under the terms and conditions of the BSD License\r
17 which accompanies this distribution. The full text of the license may be found at\r
18 http://opensource.org/licenses/bsd-license.php\r
87f8ccbe 19\r
94b73c24 20 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
21 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
87f8ccbe 22\r
23**/\r
24\r
25//\r
26// Cirrus Logic 5430 Controller Driver\r
27//\r
28#include "CirrusLogic5430.h"\r
29\r
30EFI_DRIVER_BINDING_PROTOCOL gCirrusLogic5430DriverBinding = {\r
31 CirrusLogic5430ControllerDriverSupported,\r
32 CirrusLogic5430ControllerDriverStart,\r
33 CirrusLogic5430ControllerDriverStop,\r
34 0x10,\r
35 NULL,\r
36 NULL\r
37};\r
38\r
39///\r
40/// Generic Attribute Controller Register Settings\r
41///\r
42UINT8 AttributeController[21] = {\r
94b73c24 43 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,\r
44 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,\r
87f8ccbe 45 0x41, 0x00, 0x0F, 0x00, 0x00\r
46};\r
47\r
48///\r
49/// Generic Graphics Controller Register Settings\r
50///\r
51UINT8 GraphicsController[9] = {\r
52 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F, 0xFF\r
53};\r
54\r
55//\r
56// 640 x 480 x 256 color @ 60 Hertz\r
57//\r
58UINT8 Crtc_640_480_256_60[28] = {\r
59 0x5d, 0x4f, 0x50, 0x82, 0x53, 0x9f, 0x00, 0x3e,\r
94b73c24 60 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,\r
87f8ccbe 61 0xe1, 0x83, 0xdf, 0x50, 0x00, 0xe7, 0x04, 0xe3,\r
62 0xff, 0x00, 0x00, 0x22\r
63};\r
64\r
65UINT16 Seq_640_480_256_60[15] = {\r
94b73c24 66 0x0100, 0x0101, 0x0f02, 0x0003, 0x0e04, 0x1107, 0x0008, 0x4a0b,\r
87f8ccbe 67 0x5b0c, 0x450d, 0x7e0e, 0x2b1b, 0x2f1c, 0x301d, 0x331e\r
68};\r
69\r
70//\r
71// 800 x 600 x 256 color @ 60 Hertz\r
72//\r
73UINT8 Crtc_800_600_256_60[28] = {\r
94b73c24 74 0x7F, 0x63, 0x64, 0x80, 0x6B, 0x1B, 0x72, 0xF0,\r
75 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,\r
87f8ccbe 76 0x58, 0x8C, 0x57, 0x64, 0x00, 0x5F, 0x91, 0xE3,\r
77 0xFF, 0x00, 0x00, 0x22\r
78};\r
79\r
80UINT16 Seq_800_600_256_60[15] = {\r
94b73c24 81 0x0100, 0x0101, 0x0f02, 0x0003, 0x0e04, 0x1107, 0x0008, 0x4a0b,\r
87f8ccbe 82 0x5b0c, 0x450d, 0x510e, 0x2b1b, 0x2f1c, 0x301d, 0x3a1e\r
83};\r
84\r
85//\r
86// 1024 x 768 x 256 color @ 60 Hertz\r
87//\r
88UINT8 Crtc_1024_768_256_60[28] = {\r
94b73c24 89 0xA3, 0x7F, 0x80, 0x86, 0x85, 0x96, 0x24, 0xFD,\r
90 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,\r
87f8ccbe 91 0x02, 0x88, 0xFF, 0x80, 0x00, 0x00, 0x24, 0xE3,\r
92 0xFF, 0x4A, 0x00, 0x22\r
93};\r
94\r
95UINT16 Seq_1024_768_256_60[15] = {\r
94b73c24 96 0x0100, 0x0101, 0x0f02, 0x0003, 0x0e04, 0x1107, 0x0008, 0x4a0b,\r
87f8ccbe 97 0x5b0c, 0x450d, 0x760e, 0x2b1b, 0x2f1c, 0x301d, 0x341e\r
98};\r
99\r
100///\r
101/// Table of supported video modes\r
102///\r
103CIRRUS_LOGIC_5430_VIDEO_MODES CirrusLogic5430VideoModes[] = {\r
104 { 640, 480, 8, 60, Crtc_640_480_256_60, Seq_640_480_256_60, 0xe3 },\r
94b73c24 105 { 800, 600, 8, 60, Crtc_800_600_256_60, Seq_800_600_256_60, 0xef },\r
106 { 1024, 768, 8, 60, Crtc_1024_768_256_60, Seq_1024_768_256_60, 0xef }\r
87f8ccbe 107};\r
108\r
31f9e631 109\r
87f8ccbe 110/**\r
111 CirrusLogic5430ControllerDriverSupported\r
112\r
113 TODO: This - add argument and description to function comment\r
114 TODO: Controller - add argument and description to function comment\r
115 TODO: RemainingDevicePath - add argument and description to function comment\r
116**/\r
117EFI_STATUS\r
118EFIAPI\r
119CirrusLogic5430ControllerDriverSupported (\r
120 IN EFI_DRIVER_BINDING_PROTOCOL *This,\r
121 IN EFI_HANDLE Controller,\r
122 IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath\r
123 )\r
124{\r
125 EFI_STATUS Status;\r
126 EFI_PCI_IO_PROTOCOL *PciIo;\r
127 PCI_TYPE00 Pci;\r
128\r
129 //\r
130 // Open the PCI I/O Protocol\r
131 //\r
132 Status = gBS->OpenProtocol (\r
133 Controller,\r
134 &gEfiPciIoProtocolGuid,\r
135 (VOID **) &PciIo,\r
136 This->DriverBindingHandle,\r
137 Controller,\r
138 EFI_OPEN_PROTOCOL_BY_DRIVER\r
139 );\r
140 if (EFI_ERROR (Status)) {\r
141 return Status;\r
142 }\r
143\r
144 //\r
145 // Read the PCI Configuration Header from the PCI Device\r
146 //\r
147 Status = PciIo->Pci.Read (\r
148 PciIo,\r
149 EfiPciIoWidthUint32,\r
150 0,\r
151 sizeof (Pci) / sizeof (UINT32),\r
152 &Pci\r
153 );\r
154 if (EFI_ERROR (Status)) {\r
155 goto Done;\r
156 }\r
157\r
158 Status = EFI_UNSUPPORTED;\r
159 //\r
160 // See if the I/O enable is on. Most systems only allow one VGA device to be turned on\r
161 // at a time, so see if this is one that is turned on.\r
162 //\r
163 // if (((Pci.Hdr.Command & 0x01) == 0x01)) {\r
164 //\r
165 // See if this is a Cirrus Logic PCI controller\r
166 //\r
167 if (Pci.Hdr.VendorId == CIRRUS_LOGIC_VENDOR_ID) {\r
168 //\r
169 // See if this is a 5430 or a 5446 PCI controller\r
170 //\r
171 if (Pci.Hdr.DeviceId == CIRRUS_LOGIC_5430_DEVICE_ID) {\r
172 Status = EFI_SUCCESS;\r
173 }\r
174\r
175 if (Pci.Hdr.DeviceId == CIRRUS_LOGIC_5430_ALTERNATE_DEVICE_ID) {\r
176 Status = EFI_SUCCESS;\r
177 }\r
178\r
179 if (Pci.Hdr.DeviceId == CIRRUS_LOGIC_5446_DEVICE_ID) {\r
180 Status = EFI_SUCCESS;\r
181 }\r
182 }\r
183\r
184Done:\r
185 //\r
186 // Close the PCI I/O Protocol\r
187 //\r
188 gBS->CloseProtocol (\r
189 Controller,\r
190 &gEfiPciIoProtocolGuid,\r
191 This->DriverBindingHandle,\r
192 Controller\r
193 );\r
194\r
195 return Status;\r
196}\r
197\r
198/**\r
199 CirrusLogic5430ControllerDriverStart\r
200\r
201 TODO: This - add argument and description to function comment\r
202 TODO: Controller - add argument and description to function comment\r
203 TODO: RemainingDevicePath - add argument and description to function comment\r
204**/\r
205EFI_STATUS\r
206EFIAPI\r
207CirrusLogic5430ControllerDriverStart (\r
208 IN EFI_DRIVER_BINDING_PROTOCOL *This,\r
209 IN EFI_HANDLE Controller,\r
210 IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath\r
211 )\r
212{\r
213 EFI_STATUS Status;\r
214 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private;\r
6a6d955c 215 BOOLEAN PciAttributesSaved;\r
31f9e631 216 EFI_DEVICE_PATH_PROTOCOL *ParentDevicePath;\r
217 ACPI_ADR_DEVICE_PATH AcpiDeviceNode;\r
87f8ccbe 218\r
6a6d955c 219 PciAttributesSaved = FALSE;\r
87f8ccbe 220 //\r
221 // Allocate Private context data for UGA Draw inteface.\r
222 //\r
223 Private = AllocateZeroPool (sizeof (CIRRUS_LOGIC_5430_PRIVATE_DATA));\r
224 if (Private == NULL) {\r
225 Status = EFI_OUT_OF_RESOURCES;\r
226 goto Error;\r
227 }\r
228\r
229 //\r
230 // Set up context record\r
231 //\r
232 Private->Signature = CIRRUS_LOGIC_5430_PRIVATE_DATA_SIGNATURE;\r
31f9e631 233 Private->Handle = NULL;\r
87f8ccbe 234\r
235 //\r
236 // Open PCI I/O Protocol\r
237 //\r
238 Status = gBS->OpenProtocol (\r
d52be0e2 239 Controller,\r
87f8ccbe 240 &gEfiPciIoProtocolGuid,\r
241 (VOID **) &Private->PciIo,\r
242 This->DriverBindingHandle,\r
d52be0e2 243 Controller,\r
87f8ccbe 244 EFI_OPEN_PROTOCOL_BY_DRIVER\r
245 );\r
246 if (EFI_ERROR (Status)) {\r
247 goto Error;\r
248 }\r
249\r
94b73c24 250 //\r
251 // Save original PCI attributes\r
252 //\r
253 Status = Private->PciIo->Attributes (\r
254 Private->PciIo,\r
255 EfiPciIoAttributeOperationGet,\r
256 0,\r
257 &Private->OriginalPciAttributes\r
258 );\r
259\r
260 if (EFI_ERROR (Status)) {\r
261 goto Error;\r
262 }\r
6a6d955c 263 PciAttributesSaved = TRUE;\r
94b73c24 264\r
87f8ccbe 265 Status = Private->PciIo->Attributes (\r
266 Private->PciIo,\r
267 EfiPciIoAttributeOperationEnable,\r
268 EFI_PCI_DEVICE_ENABLE | EFI_PCI_IO_ATTRIBUTE_VGA_MEMORY | EFI_PCI_IO_ATTRIBUTE_VGA_IO,\r
269 NULL\r
270 );\r
271 if (EFI_ERROR (Status)) {\r
272 goto Error;\r
273 }\r
274\r
31f9e631 275 //\r
276 // Get ParentDevicePath\r
277 //\r
278 Status = gBS->HandleProtocol (\r
279 Controller,\r
280 &gEfiDevicePathProtocolGuid,\r
281 (VOID **) &ParentDevicePath\r
282 );\r
283 if (EFI_ERROR (Status)) {\r
284 goto Error;\r
285 }\r
286\r
287 if (FeaturePcdGet (PcdSupportGop)) {\r
288 //\r
289 // Set Gop Device Path\r
290 //\r
291 if (RemainingDevicePath == NULL) {\r
292 ZeroMem (&AcpiDeviceNode, sizeof (ACPI_ADR_DEVICE_PATH));\r
293 AcpiDeviceNode.Header.Type = ACPI_DEVICE_PATH;\r
294 AcpiDeviceNode.Header.SubType = ACPI_ADR_DP;\r
295 AcpiDeviceNode.ADR = ACPI_DISPLAY_ADR (1, 0, 0, 1, 0, ACPI_ADR_DISPLAY_TYPE_VGA, 0, 0);\r
296 SetDevicePathNodeLength (&AcpiDeviceNode.Header, sizeof (ACPI_ADR_DEVICE_PATH));\r
297\r
298 Private->GopDevicePath = AppendDevicePathNode (\r
299 ParentDevicePath,\r
300 (EFI_DEVICE_PATH_PROTOCOL *) &AcpiDeviceNode\r
301 );\r
302 } else {\r
303 Private->GopDevicePath = AppendDevicePathNode (ParentDevicePath, RemainingDevicePath);\r
304 }\r
305\r
306 //\r
307 // Creat child handle and device path protocol firstly\r
308 //\r
309 Private->Handle = NULL;\r
310 Status = gBS->InstallMultipleProtocolInterfaces (\r
311 &Private->Handle,\r
312 &gEfiDevicePathProtocolGuid,\r
313 Private->GopDevicePath,\r
314 NULL\r
315 );\r
316 }\r
317\r
318 //\r
319 // Construct video mode buffer\r
320 //\r
321 Status = CirrusLogic5430VideoModeSetup (Private);\r
322 if (EFI_ERROR (Status)) {\r
323 goto Error;\r
324 }\r
325\r
87f8ccbe 326 if (FeaturePcdGet (PcdSupportUga)) {\r
327 //\r
328 // Start the UGA Draw software stack.\r
329 //\r
330 Status = CirrusLogic5430UgaDrawConstructor (Private);\r
331 ASSERT_EFI_ERROR (Status);\r
87f8ccbe 332\r
31f9e631 333 Private->UgaDevicePath = ParentDevicePath;\r
334 Status = gBS->InstallMultipleProtocolInterfaces (\r
335 &Controller,\r
336 &gEfiUgaDrawProtocolGuid,\r
337 &Private->UgaDraw,\r
338 &gEfiDevicePathProtocolGuid,\r
339 Private->UgaDevicePath,\r
340 NULL\r
341 );\r
87f8ccbe 342\r
31f9e631 343 } else if (FeaturePcdGet (PcdSupportGop)) {\r
344 //\r
345 // Start the GOP software stack.\r
346 //\r
347 Status = CirrusLogic5430GraphicsOutputConstructor (Private);\r
348 ASSERT_EFI_ERROR (Status);\r
94b73c24 349\r
31f9e631 350 Status = gBS->InstallMultipleProtocolInterfaces (\r
351 &Private->Handle,\r
352 &gEfiGraphicsOutputProtocolGuid,\r
353 &Private->GraphicsOutput,\r
354 &gEfiEdidDiscoveredProtocolGuid,\r
355 &Private->EdidDiscovered,\r
356 &gEfiEdidActiveProtocolGuid,\r
357 &Private->EdidActive,\r
358 NULL\r
359 );\r
360\r
361 } else {\r
362 //\r
363 // This driver must support eithor GOP or UGA or both.\r
364 //\r
365 ASSERT (FALSE);\r
366 Status = EFI_UNSUPPORTED;\r
87f8ccbe 367 }\r
94b73c24 368\r
87f8ccbe 369\r
370Error:\r
371 if (EFI_ERROR (Status)) {\r
372 if (Private) {\r
373 if (Private->PciIo) {\r
6a6d955c 374 if (PciAttributesSaved == TRUE) {\r
375 //\r
376 // Restore original PCI attributes\r
377 //\r
378 Private->PciIo->Attributes (\r
379 Private->PciIo,\r
380 EfiPciIoAttributeOperationSet,\r
381 Private->OriginalPciAttributes,\r
382 NULL\r
383 );\r
384 }\r
94b73c24 385 //\r
386 // Close the PCI I/O Protocol\r
387 //\r
388 gBS->CloseProtocol (\r
389 Private->Handle,\r
390 &gEfiPciIoProtocolGuid,\r
391 This->DriverBindingHandle,\r
392 Private->Handle\r
393 );\r
87f8ccbe 394 }\r
87f8ccbe 395\r
87f8ccbe 396 gBS->FreePool (Private);\r
397 }\r
398 }\r
399\r
400 return Status;\r
401}\r
402\r
403/**\r
404 CirrusLogic5430ControllerDriverStop\r
405\r
406 TODO: This - add argument and description to function comment\r
407 TODO: Controller - add argument and description to function comment\r
408 TODO: NumberOfChildren - add argument and description to function comment\r
409 TODO: ChildHandleBuffer - add argument and description to function comment\r
410 TODO: EFI_SUCCESS - add return value to function comment\r
411**/\r
412EFI_STATUS\r
413EFIAPI\r
414CirrusLogic5430ControllerDriverStop (\r
415 IN EFI_DRIVER_BINDING_PROTOCOL *This,\r
416 IN EFI_HANDLE Controller,\r
417 IN UINTN NumberOfChildren,\r
418 IN EFI_HANDLE *ChildHandleBuffer\r
419 )\r
420{\r
421 EFI_UGA_DRAW_PROTOCOL *UgaDraw;\r
422 EFI_GRAPHICS_OUTPUT_PROTOCOL *GraphicsOutput;\r
423\r
424 EFI_STATUS Status;\r
425 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private;\r
426\r
427 if (FeaturePcdGet (PcdSupportUga)) {\r
428 Status = gBS->OpenProtocol (\r
429 Controller,\r
430 &gEfiUgaDrawProtocolGuid,\r
431 (VOID **) &UgaDraw,\r
432 This->DriverBindingHandle,\r
433 Controller,\r
434 EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
435 );\r
436 if (EFI_ERROR (Status)) {\r
437 return Status;\r
438 }\r
439 //\r
440 // Get our private context information\r
441 //\r
442 Private = CIRRUS_LOGIC_5430_PRIVATE_DATA_FROM_UGA_DRAW_THIS (UgaDraw);\r
443 CirrusLogic5430UgaDrawDestructor (Private);\r
444\r
445 if (FeaturePcdGet (PcdSupportGop)) {\r
446 CirrusLogic5430GraphicsOutputDestructor (Private);\r
447 //\r
448 // Remove the UGA and GOP protocol interface from the system\r
449 //\r
450 Status = gBS->UninstallMultipleProtocolInterfaces (\r
451 Private->Handle,\r
452 &gEfiUgaDrawProtocolGuid,\r
453 &Private->UgaDraw,\r
454 &gEfiGraphicsOutputProtocolGuid,\r
455 &Private->GraphicsOutput,\r
456 NULL\r
457 );\r
458 } else {\r
459 //\r
460 // Remove the UGA Draw interface from the system\r
461 //\r
462 Status = gBS->UninstallMultipleProtocolInterfaces (\r
463 Private->Handle,\r
464 &gEfiUgaDrawProtocolGuid,\r
465 &Private->UgaDraw,\r
466 NULL\r
467 );\r
468 }\r
469 } else {\r
470 Status = gBS->OpenProtocol (\r
471 Controller,\r
472 &gEfiGraphicsOutputProtocolGuid,\r
473 (VOID **) &GraphicsOutput,\r
474 This->DriverBindingHandle,\r
475 Controller,\r
476 EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
477 );\r
478 if (EFI_ERROR (Status)) {\r
479 return Status;\r
480 }\r
481\r
482 //\r
483 // Get our private context information\r
484 //\r
485 Private = CIRRUS_LOGIC_5430_PRIVATE_DATA_FROM_GRAPHICS_OUTPUT_THIS (GraphicsOutput);\r
486\r
487 CirrusLogic5430GraphicsOutputDestructor (Private);\r
488 //\r
489 // Remove the GOP protocol interface from the system\r
490 //\r
491 Status = gBS->UninstallMultipleProtocolInterfaces (\r
492 Private->Handle,\r
493 &gEfiUgaDrawProtocolGuid,\r
494 &Private->UgaDraw,\r
495 &gEfiGraphicsOutputProtocolGuid,\r
496 &Private->GraphicsOutput,\r
497 NULL\r
498 );\r
499 }\r
500\r
501 if (EFI_ERROR (Status)) {\r
502 return Status;\r
503 }\r
504\r
87f8ccbe 505 //\r
94b73c24 506 // Restore original PCI attributes\r
87f8ccbe 507 //\r
508 Private->PciIo->Attributes (\r
94b73c24 509 Private->PciIo,\r
510 EfiPciIoAttributeOperationSet,\r
511 Private->OriginalPciAttributes,\r
512 NULL\r
513 );\r
87f8ccbe 514\r
515 //\r
516 // Close the PCI I/O Protocol\r
517 //\r
518 gBS->CloseProtocol (\r
519 Controller,\r
520 &gEfiPciIoProtocolGuid,\r
521 This->DriverBindingHandle,\r
522 Controller\r
523 );\r
524\r
525 //\r
526 // Free our instance data\r
527 //\r
528 gBS->FreePool (Private);\r
529\r
530 return EFI_SUCCESS;\r
531}\r
532\r
533/**\r
534 CirrusLogic5430UgaDrawDestructor\r
535\r
536 TODO: Private - add argument and description to function comment\r
537 TODO: EFI_SUCCESS - add return value to function comment\r
538**/\r
539EFI_STATUS\r
540CirrusLogic5430UgaDrawDestructor (\r
541 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r
542 )\r
543{\r
544 return EFI_SUCCESS;\r
545}\r
546\r
547/**\r
548 TODO: Add function description\r
549\r
550 @param Private TODO: add argument description\r
551 @param Address TODO: add argument description\r
552 @param Data TODO: add argument description\r
553\r
554 TODO: add return values\r
555\r
556**/\r
557VOID\r
558outb (\r
559 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r
560 UINTN Address,\r
561 UINT8 Data\r
562 )\r
563{\r
564 Private->PciIo->Io.Write (\r
565 Private->PciIo,\r
566 EfiPciIoWidthUint8,\r
567 EFI_PCI_IO_PASS_THROUGH_BAR,\r
568 Address,\r
569 1,\r
570 &Data\r
571 );\r
572}\r
573\r
574/**\r
575 TODO: Add function description\r
576\r
577 @param Private TODO: add argument description\r
578 @param Address TODO: add argument description\r
579 @param Data TODO: add argument description\r
580\r
581 TODO: add return values\r
582\r
583**/\r
584VOID\r
585outw (\r
586 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r
587 UINTN Address,\r
588 UINT16 Data\r
589 )\r
590{\r
591 Private->PciIo->Io.Write (\r
592 Private->PciIo,\r
593 EfiPciIoWidthUint16,\r
594 EFI_PCI_IO_PASS_THROUGH_BAR,\r
595 Address,\r
596 1,\r
597 &Data\r
598 );\r
599}\r
600\r
601/**\r
602 TODO: Add function description\r
603\r
604 @param Private TODO: add argument description\r
605 @param Address TODO: add argument description\r
606\r
607 TODO: add return values\r
608\r
609**/\r
610UINT8\r
611inb (\r
612 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r
613 UINTN Address\r
614 )\r
615{\r
616 UINT8 Data;\r
617\r
618 Private->PciIo->Io.Read (\r
619 Private->PciIo,\r
620 EfiPciIoWidthUint8,\r
621 EFI_PCI_IO_PASS_THROUGH_BAR,\r
622 Address,\r
623 1,\r
624 &Data\r
625 );\r
626 return Data;\r
627}\r
628\r
629/**\r
630 TODO: Add function description\r
631\r
632 @param Private TODO: add argument description\r
633 @param Address TODO: add argument description\r
634\r
635 TODO: add return values\r
636\r
637**/\r
638UINT16\r
639inw (\r
640 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r
641 UINTN Address\r
642 )\r
643{\r
644 UINT16 Data;\r
645\r
646 Private->PciIo->Io.Read (\r
647 Private->PciIo,\r
648 EfiPciIoWidthUint16,\r
649 EFI_PCI_IO_PASS_THROUGH_BAR,\r
650 Address,\r
651 1,\r
652 &Data\r
653 );\r
654 return Data;\r
655}\r
656\r
657/**\r
658 TODO: Add function description\r
659\r
660 @param Private TODO: add argument description\r
661 @param Index TODO: add argument description\r
662 @param Red TODO: add argument description\r
663 @param Green TODO: add argument description\r
664 @param Blue TODO: add argument description\r
665\r
666 TODO: add return values\r
667\r
668**/\r
669VOID\r
670SetPaletteColor (\r
671 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r
672 UINTN Index,\r
673 UINT8 Red,\r
674 UINT8 Green,\r
675 UINT8 Blue\r
676 )\r
677{\r
678 outb (Private, PALETTE_INDEX_REGISTER, (UINT8) Index);\r
679 outb (Private, PALETTE_DATA_REGISTER, (UINT8) (Red >> 2));\r
680 outb (Private, PALETTE_DATA_REGISTER, (UINT8) (Green >> 2));\r
681 outb (Private, PALETTE_DATA_REGISTER, (UINT8) (Blue >> 2));\r
682}\r
683\r
684/**\r
685 TODO: Add function description\r
686\r
687 @param Private TODO: add argument description\r
688\r
689 TODO: add return values\r
690\r
691**/\r
692VOID\r
693SetDefaultPalette (\r
694 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r
695 )\r
696{\r
697 UINTN Index;\r
698 UINTN RedIndex;\r
699 UINTN GreenIndex;\r
700 UINTN BlueIndex;\r
701\r
702 Index = 0;\r
703 for (RedIndex = 0; RedIndex < 8; RedIndex++) {\r
704 for (GreenIndex = 0; GreenIndex < 8; GreenIndex++) {\r
705 for (BlueIndex = 0; BlueIndex < 4; BlueIndex++) {\r
706 SetPaletteColor (Private, Index, (UINT8) (RedIndex << 5), (UINT8) (GreenIndex << 5), (UINT8) (BlueIndex << 6));\r
707 Index++;\r
708 }\r
709 }\r
710 }\r
711}\r
712\r
713/**\r
714 TODO: Add function description\r
715\r
716 @param Private TODO: add argument description\r
717\r
718 TODO: add return values\r
719\r
720**/\r
87f8ccbe 721VOID\r
722ClearScreen (\r
723 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r
724 )\r
725{\r
726 UINT32 Color;\r
727\r
728 Color = 0;\r
729 Private->PciIo->Mem.Write (\r
730 Private->PciIo,\r
731 EfiPciIoWidthFillUint32,\r
732 0,\r
733 0,\r
734 0x100000 >> 2,\r
735 &Color\r
736 );\r
737}\r
738\r
739/**\r
740 TODO: Add function description\r
741\r
742 @param Private TODO: add argument description\r
743\r
744 TODO: add return values\r
745\r
746**/\r
747VOID\r
748DrawLogo (\r
749 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r
750 UINTN ScreenWidth,\r
751 UINTN ScreenHeight\r
752 )\r
753{\r
87f8ccbe 754}\r
755\r
756/**\r
757 TODO: Add function description\r
758\r
759 @param Private TODO: add argument description\r
760 @param ModeData TODO: add argument description\r
761\r
762 TODO: add return values\r
763\r
764**/\r
765VOID\r
766InitializeGraphicsMode (\r
767 CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r
768 CIRRUS_LOGIC_5430_VIDEO_MODES *ModeData\r
769 )\r
770{\r
771 UINT8 Byte;\r
772 UINTN Index;\r
85f8bc32 773 UINT16 DeviceId;\r
c4536608
LG
774 EFI_STATUS Status;\r
775\r
776 Status = Private->PciIo->Pci.Read (\r
777 Private->PciIo,\r
778 EfiPciIoWidthUint16,\r
779 PCI_DEVICE_ID_OFFSET,\r
780 1,\r
781 &DeviceId\r
782 );\r
85f8bc32 783 //\r
784 // Read the PCI Configuration Header from the PCI Device\r
785 //\r
c4536608 786 ASSERT_EFI_ERROR (Status);\r
87f8ccbe 787\r
788 outw (Private, SEQ_ADDRESS_REGISTER, 0x1206);\r
789 outw (Private, SEQ_ADDRESS_REGISTER, 0x0012);\r
790\r
791 for (Index = 0; Index < 15; Index++) {\r
792 outw (Private, SEQ_ADDRESS_REGISTER, ModeData->SeqSettings[Index]);\r
793 }\r
794\r
85f8bc32 795 if (DeviceId != CIRRUS_LOGIC_5446_DEVICE_ID) {\r
796 outb (Private, SEQ_ADDRESS_REGISTER, 0x0f);\r
797 Byte = (UINT8) ((inb (Private, SEQ_DATA_REGISTER) & 0xc7) ^ 0x30);\r
798 outb (Private, SEQ_DATA_REGISTER, Byte);\r
799 }\r
87f8ccbe 800\r
801 outb (Private, MISC_OUTPUT_REGISTER, ModeData->MiscSetting);\r
802 outw (Private, GRAPH_ADDRESS_REGISTER, 0x0506);\r
803 outw (Private, SEQ_ADDRESS_REGISTER, 0x0300);\r
804 outw (Private, CRTC_ADDRESS_REGISTER, 0x2011);\r
805\r
806 for (Index = 0; Index < 28; Index++) {\r
807 outw (Private, CRTC_ADDRESS_REGISTER, (UINT16) ((ModeData->CrtcSettings[Index] << 8) | Index));\r
808 }\r
809\r
810 for (Index = 0; Index < 9; Index++) {\r
811 outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((GraphicsController[Index] << 8) | Index));\r
812 }\r
813\r
814 inb (Private, INPUT_STATUS_1_REGISTER);\r
815\r
816 for (Index = 0; Index < 21; Index++) {\r
817 outb (Private, ATT_ADDRESS_REGISTER, (UINT8) Index);\r
818 outb (Private, ATT_ADDRESS_REGISTER, AttributeController[Index]);\r
819 }\r
820\r
821 outb (Private, ATT_ADDRESS_REGISTER, 0x20);\r
822\r
823 outw (Private, GRAPH_ADDRESS_REGISTER, 0x0009);\r
824 outw (Private, GRAPH_ADDRESS_REGISTER, 0x000a);\r
825 outw (Private, GRAPH_ADDRESS_REGISTER, 0x000b);\r
826 outb (Private, DAC_PIXEL_MASK_REGISTER, 0xff);\r
827\r
828 SetDefaultPalette (Private);\r
829 ClearScreen (Private);\r
830}\r
831\r
832EFI_STATUS\r
833EFIAPI\r
834InitializeCirrusLogic5430 (\r
835 IN EFI_HANDLE ImageHandle,\r
836 IN EFI_SYSTEM_TABLE *SystemTable\r
837 )\r
838{\r
839 EFI_STATUS Status;\r
840\r
841 Status = EfiLibInstallDriverBindingComponentName2 (\r
842 ImageHandle,\r
843 SystemTable,\r
844 &gCirrusLogic5430DriverBinding,\r
845 ImageHandle,\r
846 &gCirrusLogic5430ComponentName,\r
847 &gCirrusLogic5430ComponentName2\r
848 );\r
849 ASSERT_EFI_ERROR (Status);\r
850\r
851 //\r
94b73c24 852 // Install EFI Driver Supported EFI Version Protocol required for\r
87f8ccbe 853 // EFI drivers that are on PCI and other plug in cards.\r
854 //\r
855 gCirrusLogic5430DriverSupportedEfiVersion.FirmwareVersion = PcdGet32 (PcdDriverSupportedEfiVersion);\r
856 Status = gBS->InstallMultipleProtocolInterfaces (\r
857 &ImageHandle,\r
858 &gEfiDriverSupportedEfiVersionProtocolGuid,\r
859 &gCirrusLogic5430DriverSupportedEfiVersion,\r
860 NULL\r
861 );\r
862 ASSERT_EFI_ERROR (Status);\r
863\r
864 return Status;\r
865}\r