ed72955c |
1 | /** @file\r |
878ddf1f |
2 | This file produces the graphics abstration of UGA Draw. It is called by \r |
3 | CirrusLogic5430.c file which deals with the EFI 1.1 driver model. \r |
4 | This file just does graphics.\r |
5 | \r |
ed72955c |
6 | Copyright (c) 2006, Intel Corporation \r |
7 | All rights reserved. This program and the accompanying materials \r |
8 | are licensed and made available under the terms and conditions of the BSD License \r |
9 | which accompanies this distribution. The full text of the license may be found at \r |
10 | http://opensource.org/licenses/bsd-license.php \r |
11 | \r |
12 | THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, \r |
13 | WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. \r |
14 | \r |
15 | **/\r |
878ddf1f |
16 | \r |
17 | #include "CirrusLogic5430.h"\r |
18 | \r |
ed72955c |
19 | ///\r |
20 | /// Video Mode structure\r |
21 | ///\r |
878ddf1f |
22 | typedef struct {\r |
23 | UINT32 Width;\r |
24 | UINT32 Height;\r |
25 | UINT32 ColorDepth;\r |
26 | UINT32 RefreshRate;\r |
27 | UINT8 *CrtcSettings;\r |
28 | UINT16 *SeqSettings;\r |
29 | UINT8 MiscSetting;\r |
30 | } CIRRUS_LOGIC_5430_VIDEO_MODES;\r |
31 | \r |
ed72955c |
32 | ///\r |
33 | /// Generic Attribute Controller Register Settings\r |
34 | ///\r |
878ddf1f |
35 | static UINT8 AttributeController[21] = {\r |
36 | 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, \r |
37 | 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, \r |
38 | 0x41, 0x00, 0x0F, 0x00, 0x00\r |
39 | };\r |
40 | \r |
ed72955c |
41 | ///\r |
42 | /// Generic Graphics Controller Register Settings\r |
43 | ///\r |
878ddf1f |
44 | static UINT8 GraphicsController[9] = {\r |
45 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F, 0xFF\r |
46 | };\r |
47 | \r |
48 | //\r |
49 | // 640 x 480 x 256 color @ 60 Hertz\r |
50 | //\r |
51 | static UINT8 Crtc_640_480_256_60[28] = {\r |
52 | 0x5d, 0x4f, 0x50, 0x82, 0x53, 0x9f, 0x00, 0x3e,\r |
53 | 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, \r |
54 | 0xe1, 0x83, 0xdf, 0x50, 0x00, 0xe7, 0x04, 0xe3,\r |
55 | 0xff, 0x00, 0x00, 0x22\r |
56 | };\r |
57 | \r |
58 | static UINT16 Seq_640_480_256_60[15] = {\r |
59 | 0x0100, 0x0101, 0x0f02, 0x0003, 0x0e04, 0x1107, 0x0008, 0x4a0b, \r |
60 | 0x5b0c, 0x450d, 0x7e0e, 0x2b1b, 0x2f1c, 0x301d, 0x331e\r |
61 | };\r |
62 | \r |
63 | //\r |
64 | // 800 x 600 x 256 color @ 60 Hertz\r |
65 | //\r |
66 | static UINT8 Crtc_800_600_256_60[28] = {\r |
67 | 0x7F, 0x63, 0x64, 0x80, 0x6B, 0x1B, 0x72, 0xF0, \r |
68 | 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, \r |
69 | 0x58, 0x8C, 0x57, 0x64, 0x00, 0x5F, 0x91, 0xE3,\r |
70 | 0xFF, 0x00, 0x00, 0x22\r |
71 | };\r |
72 | \r |
73 | static UINT16 Seq_800_600_256_60[15] = {\r |
74 | 0x0100, 0x0101, 0x0f02, 0x0003, 0x0e04, 0x1107, 0x0008, 0x4a0b, \r |
75 | 0x5b0c, 0x450d, 0x510e, 0x2b1b, 0x2f1c, 0x301d, 0x3a1e\r |
76 | };\r |
77 | \r |
78 | //\r |
79 | // 1024 x 768 x 256 color @ 60 Hertz\r |
80 | //\r |
81 | static UINT8 Crtc_1024_768_256_60[28] = {\r |
82 | 0xA3, 0x7F, 0x80, 0x86, 0x85, 0x96, 0x24, 0xFD, \r |
83 | 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, \r |
84 | 0x02, 0x88, 0xFF, 0x80, 0x00, 0x00, 0x24, 0xE3,\r |
85 | 0xFF, 0x4A, 0x00, 0x22\r |
86 | };\r |
87 | \r |
88 | static UINT16 Seq_1024_768_256_60[15] = {\r |
89 | 0x0100, 0x0101, 0x0f02, 0x0003, 0x0e04, 0x1107, 0x0008, 0x4a0b, \r |
90 | 0x5b0c, 0x450d, 0x760e, 0x2b1b, 0x2f1c, 0x301d, 0x341e\r |
91 | };\r |
92 | \r |
ed72955c |
93 | ///\r |
94 | /// Table of supported video modes\r |
95 | ///\r |
878ddf1f |
96 | static CIRRUS_LOGIC_5430_VIDEO_MODES CirrusLogic5430VideoModes[] = {\r |
97 | { 640, 480, 8, 60, Crtc_640_480_256_60, Seq_640_480_256_60, 0xe3 },\r |
98 | { 800, 600, 8, 60, Crtc_800_600_256_60, Seq_800_600_256_60, 0xef }, \r |
99 | { 1024, 768, 8, 60, Crtc_1024_768_256_60, Seq_1024_768_256_60, 0xef } \r |
100 | };\r |
101 | \r |
102 | //\r |
103 | // Local Function Prototypes\r |
104 | //\r |
105 | VOID\r |
106 | InitializeGraphicsMode (\r |
107 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
108 | CIRRUS_LOGIC_5430_VIDEO_MODES *ModeData\r |
109 | );\r |
110 | \r |
111 | VOID\r |
112 | SetPaletteColor (\r |
113 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
114 | UINTN Index,\r |
115 | UINT8 Red,\r |
116 | UINT8 Green,\r |
117 | UINT8 Blue\r |
118 | );\r |
119 | \r |
120 | VOID\r |
121 | SetDefaultPalette (\r |
122 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r |
123 | );\r |
124 | \r |
125 | STATIC\r |
126 | VOID\r |
127 | ClearScreen (\r |
128 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r |
129 | );\r |
130 | \r |
131 | VOID\r |
132 | DrawLogo (\r |
133 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r |
134 | );\r |
135 | \r |
136 | VOID\r |
137 | outb (\r |
138 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
139 | UINTN Address,\r |
140 | UINT8 Data\r |
141 | );\r |
142 | \r |
143 | VOID\r |
144 | outw (\r |
145 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
146 | UINTN Address,\r |
147 | UINT16 Data\r |
148 | );\r |
149 | \r |
150 | UINT8\r |
151 | inb (\r |
152 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
153 | UINTN Address\r |
154 | );\r |
155 | \r |
156 | UINT16\r |
157 | inw (\r |
158 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
159 | UINTN Address\r |
160 | );\r |
161 | \r |
162 | //\r |
163 | // UGA Draw Protocol Member Functions\r |
164 | //\r |
ed72955c |
165 | /**\r |
166 | TODO: Add function description\r |
167 | \r |
168 | @param This TODO: add argument description\r |
169 | @param HorizontalResolution TODO: add argument description\r |
170 | @param VerticalResolution TODO: add argument description\r |
171 | @param ColorDepth TODO: add argument description\r |
172 | @param RefreshRate TODO: add argument description\r |
173 | \r |
174 | @retval EFI_NOT_STARTED TODO: Add description for return value\r |
175 | @retval EFI_INVALID_PARAMETER TODO: Add description for return value\r |
176 | @retval EFI_SUCCESS TODO: Add description for return value\r |
177 | \r |
178 | **/\r |
878ddf1f |
179 | EFI_STATUS\r |
180 | EFIAPI\r |
181 | CirrusLogic5430UgaDrawGetMode (\r |
182 | IN EFI_UGA_DRAW_PROTOCOL *This,\r |
183 | OUT UINT32 *HorizontalResolution,\r |
184 | OUT UINT32 *VerticalResolution,\r |
185 | OUT UINT32 *ColorDepth,\r |
186 | OUT UINT32 *RefreshRate\r |
187 | )\r |
878ddf1f |
188 | {\r |
189 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private;\r |
190 | \r |
191 | Private = CIRRUS_LOGIC_5430_PRIVATE_DATA_FROM_UGA_DRAW_THIS (This);\r |
192 | \r |
193 | if (Private->HardwareNeedsStarting) {\r |
194 | return EFI_NOT_STARTED;\r |
195 | }\r |
196 | \r |
197 | if ((HorizontalResolution == NULL) ||\r |
198 | (VerticalResolution == NULL) ||\r |
199 | (ColorDepth == NULL) ||\r |
200 | (RefreshRate == NULL)) {\r |
201 | return EFI_INVALID_PARAMETER;\r |
202 | }\r |
203 | \r |
204 | *HorizontalResolution = Private->ModeData[Private->CurrentMode].HorizontalResolution;\r |
205 | *VerticalResolution = Private->ModeData[Private->CurrentMode].VerticalResolution;\r |
206 | *ColorDepth = Private->ModeData[Private->CurrentMode].ColorDepth;\r |
207 | *RefreshRate = Private->ModeData[Private->CurrentMode].RefreshRate;\r |
208 | \r |
209 | return EFI_SUCCESS;\r |
210 | }\r |
211 | \r |
ed72955c |
212 | /**\r |
213 | TODO: Add function description\r |
214 | \r |
215 | @param This TODO: add argument description\r |
216 | @param HorizontalResolution TODO: add argument description\r |
217 | @param VerticalResolution TODO: add argument description\r |
218 | @param ColorDepth TODO: add argument description\r |
219 | @param RefreshRate TODO: add argument description\r |
220 | \r |
221 | @retval EFI_OUT_OF_RESOURCES TODO: Add description for return value\r |
222 | @retval EFI_SUCCESS TODO: Add description for return value\r |
223 | @retval EFI_NOT_FOUND TODO: Add description for return value\r |
224 | \r |
225 | **/\r |
878ddf1f |
226 | EFI_STATUS\r |
227 | EFIAPI\r |
228 | CirrusLogic5430UgaDrawSetMode (\r |
229 | IN EFI_UGA_DRAW_PROTOCOL *This,\r |
230 | IN UINT32 HorizontalResolution,\r |
231 | IN UINT32 VerticalResolution,\r |
232 | IN UINT32 ColorDepth,\r |
233 | IN UINT32 RefreshRate\r |
234 | )\r |
878ddf1f |
235 | {\r |
236 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private;\r |
237 | UINTN Index;\r |
238 | \r |
239 | Private = CIRRUS_LOGIC_5430_PRIVATE_DATA_FROM_UGA_DRAW_THIS (This);\r |
240 | \r |
241 | for (Index = 0; Index < Private->MaxMode; Index++) {\r |
242 | \r |
243 | if (HorizontalResolution != Private->ModeData[Index].HorizontalResolution) {\r |
244 | continue;\r |
245 | }\r |
246 | \r |
247 | if (VerticalResolution != Private->ModeData[Index].VerticalResolution) {\r |
248 | continue;\r |
249 | }\r |
250 | \r |
251 | if (ColorDepth != Private->ModeData[Index].ColorDepth) {\r |
252 | continue;\r |
253 | }\r |
254 | \r |
255 | if (RefreshRate != Private->ModeData[Index].RefreshRate) {\r |
256 | continue;\r |
257 | }\r |
258 | \r |
259 | if (Private->LineBuffer) {\r |
260 | gBS->FreePool (Private->LineBuffer);\r |
261 | }\r |
262 | \r |
263 | Private->LineBuffer = NULL;\r |
264 | Private->LineBuffer = AllocatePool (HorizontalResolution);\r |
265 | if (Private->LineBuffer == NULL) {\r |
266 | return EFI_OUT_OF_RESOURCES;\r |
267 | }\r |
268 | \r |
269 | InitializeGraphicsMode (Private, &CirrusLogic5430VideoModes[Index]);\r |
270 | \r |
271 | Private->CurrentMode = Index;\r |
272 | \r |
273 | Private->HardwareNeedsStarting = FALSE;\r |
274 | \r |
275 | return EFI_SUCCESS;\r |
276 | }\r |
277 | \r |
278 | return EFI_NOT_FOUND;\r |
279 | }\r |
280 | \r |
ed72955c |
281 | /**\r |
282 | TODO: Add function description\r |
283 | \r |
284 | @param This TODO: add argument description\r |
285 | @param BltBuffer TODO: add argument description\r |
286 | @param BltOperation TODO: add argument description\r |
287 | @param SourceX TODO: add argument description\r |
288 | @param SourceY TODO: add argument description\r |
289 | @param DestinationX TODO: add argument description\r |
290 | @param DestinationY TODO: add argument description\r |
291 | @param Width TODO: add argument description\r |
292 | @param Height TODO: add argument description\r |
293 | @param Delta TODO: add argument description\r |
294 | \r |
295 | @retval EFI_INVALID_PARAMETER TODO: Add description for return value\r |
296 | @retval EFI_INVALID_PARAMETER TODO: Add description for return value\r |
297 | @retval EFI_INVALID_PARAMETER TODO: Add description for return value\r |
298 | @retval EFI_INVALID_PARAMETER TODO: Add description for return value\r |
299 | @retval EFI_INVALID_PARAMETER TODO: Add description for return value\r |
300 | @retval EFI_INVALID_PARAMETER TODO: Add description for return value\r |
301 | @retval EFI_SUCCESS TODO: Add description for return value\r |
302 | \r |
303 | **/\r |
878ddf1f |
304 | EFI_STATUS\r |
305 | EFIAPI\r |
306 | CirrusLogic5430UgaDrawBlt (\r |
307 | IN EFI_UGA_DRAW_PROTOCOL *This,\r |
308 | IN EFI_UGA_PIXEL *BltBuffer, OPTIONAL\r |
309 | IN EFI_UGA_BLT_OPERATION BltOperation,\r |
310 | IN UINTN SourceX,\r |
311 | IN UINTN SourceY,\r |
312 | IN UINTN DestinationX,\r |
313 | IN UINTN DestinationY,\r |
314 | IN UINTN Width,\r |
315 | IN UINTN Height,\r |
316 | IN UINTN Delta\r |
317 | )\r |
878ddf1f |
318 | {\r |
319 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private;\r |
320 | EFI_TPL OriginalTPL;\r |
321 | UINTN DstY;\r |
322 | UINTN SrcY;\r |
323 | EFI_UGA_PIXEL *Blt;\r |
324 | UINTN X;\r |
325 | UINT8 Pixel;\r |
326 | UINT32 WidePixel;\r |
327 | UINTN ScreenWidth;\r |
328 | UINTN Offset;\r |
329 | UINTN SourceOffset;\r |
330 | \r |
331 | Private = CIRRUS_LOGIC_5430_PRIVATE_DATA_FROM_UGA_DRAW_THIS (This);\r |
332 | \r |
333 | if ((BltOperation < 0) || (BltOperation >= EfiUgaBltMax)) {\r |
334 | return EFI_INVALID_PARAMETER;\r |
335 | }\r |
336 | \r |
337 | if (Width == 0 || Height == 0) {\r |
338 | return EFI_INVALID_PARAMETER;\r |
339 | }\r |
340 | \r |
341 | //\r |
342 | // If Delta is zero, then the entire BltBuffer is being used, so Delta\r |
343 | // is the number of bytes in each row of BltBuffer. Since BltBuffer is Width pixels size,\r |
344 | // the number of bytes in each row can be computed.\r |
345 | //\r |
346 | if (Delta == 0) {\r |
347 | Delta = Width * sizeof (EFI_UGA_PIXEL);\r |
348 | }\r |
349 | \r |
350 | //\r |
351 | // We need to fill the Virtual Screen buffer with the blt data.\r |
352 | // The virtual screen is upside down, as the first row is the bootom row of\r |
353 | // the image.\r |
354 | //\r |
355 | \r |
356 | //\r |
357 | // Make sure the SourceX, SourceY, DestinationX, DestinationY, Width, and Height parameters\r |
358 | // are valid for the operation and the current screen geometry.\r |
359 | //\r |
360 | if (BltOperation == EfiUgaVideoToBltBuffer) {\r |
361 | //\r |
362 | // Video to BltBuffer: Source is Video, destination is BltBuffer\r |
363 | //\r |
364 | if (SourceY + Height > Private->ModeData[Private->CurrentMode].VerticalResolution) {\r |
365 | return EFI_INVALID_PARAMETER;\r |
366 | }\r |
367 | \r |
368 | if (SourceX + Width > Private->ModeData[Private->CurrentMode].HorizontalResolution) {\r |
369 | return EFI_INVALID_PARAMETER;\r |
370 | }\r |
371 | } else {\r |
372 | //\r |
373 | // BltBuffer to Video: Source is BltBuffer, destination is Video\r |
374 | //\r |
375 | if (DestinationY + Height > Private->ModeData[Private->CurrentMode].VerticalResolution) {\r |
376 | return EFI_INVALID_PARAMETER;\r |
377 | }\r |
378 | \r |
379 | if (DestinationX + Width > Private->ModeData[Private->CurrentMode].HorizontalResolution) {\r |
380 | return EFI_INVALID_PARAMETER;\r |
381 | }\r |
382 | }\r |
383 | //\r |
384 | // We have to raise to TPL Notify, so we make an atomic write the frame buffer.\r |
385 | // We would not want a timer based event (Cursor, ...) to come in while we are\r |
386 | // doing this operation.\r |
387 | //\r |
388 | OriginalTPL = gBS->RaiseTPL (EFI_TPL_NOTIFY);\r |
389 | \r |
390 | switch (BltOperation) {\r |
391 | case EfiUgaVideoToBltBuffer:\r |
392 | //\r |
393 | // Video to BltBuffer: Source is Video, destination is BltBuffer\r |
394 | //\r |
395 | for (SrcY = SourceY, DstY = DestinationY; DstY < (Height + DestinationY); SrcY++, DstY++) {\r |
396 | \r |
397 | Offset = (SrcY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + SourceX;\r |
398 | if (((Offset & 0x03) == 0) && ((Width & 0x03) == 0)) {\r |
399 | Private->PciIo->Mem.Read (\r |
400 | Private->PciIo,\r |
401 | EfiPciIoWidthUint32,\r |
402 | 0,\r |
403 | Offset,\r |
404 | Width >> 2,\r |
405 | Private->LineBuffer\r |
406 | );\r |
407 | } else {\r |
408 | Private->PciIo->Mem.Read (\r |
409 | Private->PciIo,\r |
410 | EfiPciIoWidthUint8,\r |
411 | 0,\r |
412 | Offset,\r |
413 | Width,\r |
414 | Private->LineBuffer\r |
415 | );\r |
416 | }\r |
417 | \r |
418 | for (X = 0; X < Width; X++) {\r |
419 | Blt = (EFI_UGA_PIXEL *) ((UINT8 *) BltBuffer + (DstY * Delta) + (DestinationX + X) * sizeof (EFI_UGA_PIXEL));\r |
420 | \r |
421 | Blt->Red = (UINT8) (Private->LineBuffer[X] & 0xe0);\r |
422 | Blt->Green = (UINT8) ((Private->LineBuffer[X] & 0x1c) << 3);\r |
423 | Blt->Blue = (UINT8) ((Private->LineBuffer[X] & 0x03) << 6);\r |
424 | }\r |
425 | }\r |
426 | break;\r |
427 | \r |
428 | case EfiUgaVideoToVideo:\r |
429 | //\r |
430 | // Perform hardware acceleration for Video to Video operations\r |
431 | //\r |
432 | ScreenWidth = Private->ModeData[Private->CurrentMode].HorizontalResolution;\r |
433 | SourceOffset = (SourceY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + (SourceX);\r |
434 | Offset = (DestinationY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + (DestinationX);\r |
435 | \r |
436 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0000);\r |
437 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0010);\r |
438 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0012);\r |
439 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0014);\r |
440 | \r |
441 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0001);\r |
442 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0011);\r |
443 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0013);\r |
444 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0015);\r |
445 | \r |
446 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) (((Width << 8) & 0xff00) | 0x20));\r |
447 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((Width & 0xff00) | 0x21));\r |
448 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) (((Height << 8) & 0xff00) | 0x22));\r |
449 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((Height & 0xff00) | 0x23));\r |
450 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) (((ScreenWidth << 8) & 0xff00) | 0x24));\r |
451 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((ScreenWidth & 0xff00) | 0x25));\r |
452 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) (((ScreenWidth << 8) & 0xff00) | 0x26));\r |
453 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((ScreenWidth & 0xff00) | 0x27));\r |
454 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((Offset) << 8) & 0xff00) | 0x28));\r |
455 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((Offset) >> 0) & 0xff00) | 0x29));\r |
456 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((Offset) >> 8) & 0xff00) | 0x2a));\r |
457 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((SourceOffset) << 8) & 0xff00) | 0x2c));\r |
458 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((SourceOffset) >> 0) & 0xff00) | 0x2d));\r |
459 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((SourceOffset) >> 8) & 0xff00) | 0x2e));\r |
460 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x002f);\r |
461 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0030);\r |
462 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0d32);\r |
463 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0033);\r |
464 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0034);\r |
465 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0035);\r |
466 | \r |
467 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0231);\r |
468 | \r |
469 | outb (Private, GRAPH_ADDRESS_REGISTER, 0x31);\r |
470 | while ((inb (Private, GRAPH_DATA_REGISTER) & 0x01) == 0x01)\r |
471 | ;\r |
472 | break;\r |
473 | \r |
474 | case EfiUgaVideoFill:\r |
475 | Blt = BltBuffer;\r |
476 | Pixel = (UINT8) ((Blt->Red & 0xe0) | ((Blt->Green >> 3) & 0x1c) | ((Blt->Blue >> 6) & 0x03));\r |
477 | WidePixel = (Pixel << 8) | Pixel;\r |
478 | WidePixel = (WidePixel << 16) | WidePixel;\r |
479 | \r |
480 | if (DestinationX == 0 && Width == Private->ModeData[Private->CurrentMode].HorizontalResolution) {\r |
481 | Offset = DestinationY * Private->ModeData[Private->CurrentMode].HorizontalResolution;\r |
482 | if (((Offset & 0x03) == 0) && (((Width * Height) & 0x03) == 0)) {\r |
483 | Private->PciIo->Mem.Write (\r |
484 | Private->PciIo,\r |
485 | EfiPciIoWidthFillUint32,\r |
486 | 0,\r |
487 | Offset,\r |
488 | (Width * Height) >> 2,\r |
489 | &WidePixel\r |
490 | );\r |
491 | } else {\r |
492 | Private->PciIo->Mem.Write (\r |
493 | Private->PciIo,\r |
494 | EfiPciIoWidthFillUint8,\r |
495 | 0,\r |
496 | Offset,\r |
497 | Width * Height,\r |
498 | &Pixel\r |
499 | );\r |
500 | }\r |
501 | } else {\r |
502 | for (SrcY = SourceY, DstY = DestinationY; SrcY < (Height + SourceY); SrcY++, DstY++) {\r |
503 | Offset = (DstY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + DestinationX;\r |
504 | if (((Offset & 0x03) == 0) && ((Width & 0x03) == 0)) {\r |
505 | Private->PciIo->Mem.Write (\r |
506 | Private->PciIo,\r |
507 | EfiPciIoWidthFillUint32,\r |
508 | 0,\r |
509 | Offset,\r |
510 | Width >> 2,\r |
511 | &WidePixel\r |
512 | );\r |
513 | } else {\r |
514 | Private->PciIo->Mem.Write (\r |
515 | Private->PciIo,\r |
516 | EfiPciIoWidthFillUint8,\r |
517 | 0,\r |
518 | Offset,\r |
519 | Width,\r |
520 | &Pixel\r |
521 | );\r |
522 | }\r |
523 | }\r |
524 | }\r |
525 | break;\r |
526 | \r |
527 | case EfiUgaBltBufferToVideo:\r |
528 | for (SrcY = SourceY, DstY = DestinationY; SrcY < (Height + SourceY); SrcY++, DstY++) {\r |
529 | \r |
530 | for (X = 0; X < Width; X++) {\r |
531 | Blt = (EFI_UGA_PIXEL *) ((UINT8 *) BltBuffer + (SrcY * Delta) + (SourceX + X) * sizeof (EFI_UGA_PIXEL));\r |
532 | Private->LineBuffer[X] = (UINT8) ((Blt->Red & 0xe0) | ((Blt->Green >> 3) & 0x1c) | ((Blt->Blue >> 6) & 0x03));\r |
533 | }\r |
534 | \r |
535 | Offset = (DstY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + DestinationX;\r |
536 | \r |
537 | if (((Offset & 0x03) == 0) && ((Width & 0x03) == 0)) {\r |
538 | Private->PciIo->Mem.Write (\r |
539 | Private->PciIo,\r |
540 | EfiPciIoWidthUint32,\r |
541 | 0,\r |
542 | Offset,\r |
543 | Width >> 2,\r |
544 | Private->LineBuffer\r |
545 | );\r |
546 | } else {\r |
547 | Private->PciIo->Mem.Write (\r |
548 | Private->PciIo,\r |
549 | EfiPciIoWidthUint8,\r |
550 | 0,\r |
551 | Offset,\r |
552 | Width,\r |
553 | Private->LineBuffer\r |
554 | );\r |
555 | }\r |
556 | }\r |
557 | break;\r |
558 | \r |
559 | default:\r |
560 | break;\r |
561 | }\r |
562 | \r |
563 | gBS->RestoreTPL (OriginalTPL);\r |
564 | \r |
565 | return EFI_SUCCESS;\r |
566 | }\r |
567 | \r |
568 | //\r |
569 | // Construction and Destruction functions\r |
570 | //\r |
571 | \r |
ed72955c |
572 | /**\r |
573 | CirrusLogic5430UgaDrawConstructor\r |
574 | \r |
575 | TODO: Private - add argument and description to function comment\r |
576 | TODO: EFI_SUCCESS - add return value to function comment\r |
577 | **/\r |
878ddf1f |
578 | EFI_STATUS\r |
579 | CirrusLogic5430UgaDrawConstructor (\r |
580 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r |
581 | )\r |
878ddf1f |
582 | {\r |
583 | EFI_UGA_DRAW_PROTOCOL *UgaDraw;\r |
584 | UINTN Index;\r |
585 | \r |
586 | //\r |
587 | // Fill in Private->UgaDraw protocol\r |
588 | //\r |
589 | UgaDraw = &Private->UgaDraw;\r |
590 | \r |
591 | UgaDraw->GetMode = CirrusLogic5430UgaDrawGetMode;\r |
592 | UgaDraw->SetMode = CirrusLogic5430UgaDrawSetMode;\r |
593 | UgaDraw->Blt = CirrusLogic5430UgaDrawBlt;\r |
594 | \r |
595 | //\r |
596 | // Initialize the private data\r |
597 | //\r |
598 | Private->MaxMode = CIRRUS_LOGIC_5430_UGA_DRAW_MODE_COUNT;\r |
599 | Private->CurrentMode = 0;\r |
600 | for (Index = 0; Index < Private->MaxMode; Index++) {\r |
601 | Private->ModeData[Index].HorizontalResolution = CirrusLogic5430VideoModes[Index].Width;\r |
602 | Private->ModeData[Index].VerticalResolution = CirrusLogic5430VideoModes[Index].Height;\r |
603 | Private->ModeData[Index].ColorDepth = 32;\r |
604 | Private->ModeData[Index].RefreshRate = CirrusLogic5430VideoModes[Index].RefreshRate;\r |
605 | }\r |
606 | \r |
607 | Private->HardwareNeedsStarting = TRUE;\r |
608 | Private->LineBuffer = NULL;\r |
609 | \r |
610 | //\r |
611 | // Initialize the hardware\r |
612 | //\r |
613 | UgaDraw->SetMode (\r |
614 | UgaDraw,\r |
615 | Private->ModeData[Private->CurrentMode].HorizontalResolution,\r |
616 | Private->ModeData[Private->CurrentMode].VerticalResolution,\r |
617 | Private->ModeData[Private->CurrentMode].ColorDepth,\r |
618 | Private->ModeData[Private->CurrentMode].RefreshRate\r |
619 | );\r |
620 | DrawLogo (Private);\r |
621 | \r |
622 | return EFI_SUCCESS;\r |
623 | }\r |
624 | \r |
ed72955c |
625 | /**\r |
626 | CirrusLogic5430UgaDrawDestructor\r |
627 | \r |
628 | TODO: Private - add argument and description to function comment\r |
629 | TODO: EFI_SUCCESS - add return value to function comment\r |
630 | **/\r |
878ddf1f |
631 | EFI_STATUS\r |
632 | CirrusLogic5430UgaDrawDestructor (\r |
633 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r |
634 | )\r |
878ddf1f |
635 | {\r |
636 | return EFI_SUCCESS;\r |
637 | }\r |
638 | \r |
ed72955c |
639 | /**\r |
640 | TODO: Add function description\r |
641 | \r |
642 | @param Private TODO: add argument description\r |
643 | @param Address TODO: add argument description\r |
644 | @param Data TODO: add argument description\r |
645 | \r |
646 | TODO: add return values\r |
647 | \r |
648 | **/\r |
878ddf1f |
649 | VOID\r |
650 | outb (\r |
651 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
652 | UINTN Address,\r |
653 | UINT8 Data\r |
654 | )\r |
878ddf1f |
655 | {\r |
656 | Private->PciIo->Io.Write (\r |
657 | Private->PciIo,\r |
658 | EfiPciIoWidthUint8,\r |
659 | EFI_PCI_IO_PASS_THROUGH_BAR,\r |
660 | Address,\r |
661 | 1,\r |
662 | &Data\r |
663 | );\r |
664 | }\r |
665 | \r |
ed72955c |
666 | /**\r |
667 | TODO: Add function description\r |
668 | \r |
669 | @param Private TODO: add argument description\r |
670 | @param Address TODO: add argument description\r |
671 | @param Data TODO: add argument description\r |
672 | \r |
673 | TODO: add return values\r |
674 | \r |
675 | **/\r |
878ddf1f |
676 | VOID\r |
677 | outw (\r |
678 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
679 | UINTN Address,\r |
680 | UINT16 Data\r |
681 | )\r |
878ddf1f |
682 | {\r |
683 | Private->PciIo->Io.Write (\r |
684 | Private->PciIo,\r |
685 | EfiPciIoWidthUint16,\r |
686 | EFI_PCI_IO_PASS_THROUGH_BAR,\r |
687 | Address,\r |
688 | 1,\r |
689 | &Data\r |
690 | );\r |
691 | }\r |
692 | \r |
ed72955c |
693 | /**\r |
878ddf1f |
694 | TODO: Add function description\r |
695 | \r |
ed72955c |
696 | @param Private TODO: add argument description\r |
697 | @param Address TODO: add argument description\r |
878ddf1f |
698 | \r |
699 | TODO: add return values\r |
700 | \r |
ed72955c |
701 | **/\r |
702 | UINT8\r |
703 | inb (\r |
704 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
705 | UINTN Address\r |
706 | )\r |
878ddf1f |
707 | {\r |
708 | UINT8 Data;\r |
709 | \r |
710 | Private->PciIo->Io.Read (\r |
711 | Private->PciIo,\r |
712 | EfiPciIoWidthUint8,\r |
713 | EFI_PCI_IO_PASS_THROUGH_BAR,\r |
714 | Address,\r |
715 | 1,\r |
716 | &Data\r |
717 | );\r |
718 | return Data;\r |
719 | }\r |
720 | \r |
ed72955c |
721 | /**\r |
878ddf1f |
722 | TODO: Add function description\r |
723 | \r |
ed72955c |
724 | @param Private TODO: add argument description\r |
725 | @param Address TODO: add argument description\r |
878ddf1f |
726 | \r |
727 | TODO: add return values\r |
728 | \r |
ed72955c |
729 | **/\r |
730 | UINT16\r |
731 | inw (\r |
732 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
733 | UINTN Address\r |
734 | )\r |
878ddf1f |
735 | {\r |
736 | UINT16 Data;\r |
737 | \r |
738 | Private->PciIo->Io.Read (\r |
739 | Private->PciIo,\r |
740 | EfiPciIoWidthUint16,\r |
741 | EFI_PCI_IO_PASS_THROUGH_BAR,\r |
742 | Address,\r |
743 | 1,\r |
744 | &Data\r |
745 | );\r |
746 | return Data;\r |
747 | }\r |
748 | \r |
ed72955c |
749 | /**\r |
750 | TODO: Add function description\r |
751 | \r |
752 | @param Private TODO: add argument description\r |
753 | @param Index TODO: add argument description\r |
754 | @param Red TODO: add argument description\r |
755 | @param Green TODO: add argument description\r |
756 | @param Blue TODO: add argument description\r |
757 | \r |
758 | TODO: add return values\r |
759 | \r |
760 | **/\r |
878ddf1f |
761 | VOID\r |
762 | SetPaletteColor (\r |
763 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
764 | UINTN Index,\r |
765 | UINT8 Red,\r |
766 | UINT8 Green,\r |
767 | UINT8 Blue\r |
768 | )\r |
878ddf1f |
769 | {\r |
770 | outb (Private, PALETTE_INDEX_REGISTER, (UINT8) Index);\r |
771 | outb (Private, PALETTE_DATA_REGISTER, (UINT8) (Red >> 2));\r |
772 | outb (Private, PALETTE_DATA_REGISTER, (UINT8) (Green >> 2));\r |
773 | outb (Private, PALETTE_DATA_REGISTER, (UINT8) (Blue >> 2));\r |
774 | }\r |
775 | \r |
ed72955c |
776 | /**\r |
878ddf1f |
777 | TODO: Add function description\r |
778 | \r |
ed72955c |
779 | @param Private TODO: add argument description\r |
878ddf1f |
780 | \r |
781 | TODO: add return values\r |
782 | \r |
ed72955c |
783 | **/\r |
784 | VOID\r |
785 | SetDefaultPalette (\r |
786 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r |
787 | )\r |
878ddf1f |
788 | {\r |
789 | UINTN Index;\r |
790 | UINTN RedIndex;\r |
791 | UINTN GreenIndex;\r |
792 | UINTN BlueIndex;\r |
793 | \r |
794 | Index = 0;\r |
795 | for (RedIndex = 0; RedIndex < 8; RedIndex++) {\r |
796 | for (GreenIndex = 0; GreenIndex < 8; GreenIndex++) {\r |
797 | for (BlueIndex = 0; BlueIndex < 4; BlueIndex++) {\r |
798 | SetPaletteColor (Private, Index, (UINT8) (RedIndex << 5), (UINT8) (GreenIndex << 5), (UINT8) (BlueIndex << 6));\r |
799 | Index++;\r |
800 | }\r |
801 | }\r |
802 | }\r |
803 | }\r |
804 | \r |
ed72955c |
805 | /**\r |
878ddf1f |
806 | TODO: Add function description\r |
807 | \r |
ed72955c |
808 | @param Private TODO: add argument description\r |
878ddf1f |
809 | \r |
810 | TODO: add return values\r |
811 | \r |
ed72955c |
812 | **/\r |
813 | STATIC\r |
814 | VOID\r |
815 | ClearScreen (\r |
816 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r |
817 | )\r |
878ddf1f |
818 | {\r |
819 | UINT32 Color;\r |
820 | \r |
821 | Color = 0;\r |
822 | Private->PciIo->Mem.Write (\r |
823 | Private->PciIo,\r |
824 | EfiPciIoWidthFillUint32,\r |
825 | 0,\r |
826 | 0,\r |
827 | 0x100000 >> 2,\r |
828 | &Color\r |
829 | );\r |
830 | }\r |
831 | \r |
ed72955c |
832 | /**\r |
878ddf1f |
833 | TODO: Add function description\r |
834 | \r |
ed72955c |
835 | @param Private TODO: add argument description\r |
878ddf1f |
836 | \r |
837 | TODO: add return values\r |
838 | \r |
ed72955c |
839 | **/\r |
840 | VOID\r |
841 | DrawLogo (\r |
842 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private\r |
843 | )\r |
878ddf1f |
844 | {\r |
845 | UINTN Offset;\r |
846 | UINTN X;\r |
847 | UINTN Y;\r |
848 | UINTN ScreenWidth;\r |
849 | UINTN ScreenHeight;\r |
850 | UINT8 Color;\r |
851 | \r |
852 | ScreenWidth = Private->ModeData[Private->CurrentMode].HorizontalResolution;\r |
853 | ScreenHeight = Private->ModeData[Private->CurrentMode].VerticalResolution;\r |
854 | \r |
855 | Offset = 0;\r |
856 | for (Y = 0; Y < ScreenHeight; Y++) {\r |
857 | for (X = 0; X < ScreenWidth; X++) {\r |
858 | Color = (UINT8) (256 * (X + Y) / (ScreenWidth + ScreenHeight));\r |
859 | Private->LineBuffer[X] = Color;\r |
860 | }\r |
861 | \r |
862 | Private->PciIo->Mem.Write (\r |
863 | Private->PciIo,\r |
864 | EfiPciIoWidthUint32,\r |
865 | 0,\r |
866 | Offset + (Y * ScreenWidth),\r |
867 | ScreenWidth >> 2,\r |
868 | Private->LineBuffer\r |
869 | );\r |
870 | }\r |
871 | }\r |
872 | \r |
ed72955c |
873 | /**\r |
878ddf1f |
874 | TODO: Add function description\r |
875 | \r |
ed72955c |
876 | @param Private TODO: add argument description\r |
877 | @param ModeData TODO: add argument description\r |
878ddf1f |
878 | \r |
879 | TODO: add return values\r |
880 | \r |
ed72955c |
881 | **/\r |
882 | VOID\r |
883 | InitializeGraphicsMode (\r |
884 | CIRRUS_LOGIC_5430_PRIVATE_DATA *Private,\r |
885 | CIRRUS_LOGIC_5430_VIDEO_MODES *ModeData\r |
886 | )\r |
878ddf1f |
887 | {\r |
888 | UINT8 Byte;\r |
889 | UINTN Index;\r |
890 | \r |
891 | outw (Private, SEQ_ADDRESS_REGISTER, 0x1206);\r |
892 | outw (Private, SEQ_ADDRESS_REGISTER, 0x0012);\r |
893 | \r |
894 | for (Index = 0; Index < 15; Index++) {\r |
895 | outw (Private, SEQ_ADDRESS_REGISTER, ModeData->SeqSettings[Index]);\r |
896 | }\r |
897 | \r |
898 | outb (Private, SEQ_ADDRESS_REGISTER, 0x0f);\r |
899 | Byte = (UINT8) ((inb (Private, SEQ_DATA_REGISTER) & 0xc7) ^ 0x30);\r |
900 | outb (Private, SEQ_DATA_REGISTER, Byte);\r |
901 | \r |
902 | outb (Private, MISC_OUTPUT_REGISTER, ModeData->MiscSetting);\r |
903 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0506);\r |
904 | outw (Private, SEQ_ADDRESS_REGISTER, 0x0300);\r |
905 | outw (Private, CRTC_ADDRESS_REGISTER, 0x2011);\r |
906 | \r |
907 | for (Index = 0; Index < 28; Index++) {\r |
908 | outw (Private, CRTC_ADDRESS_REGISTER, (UINT16) ((ModeData->CrtcSettings[Index] << 8) | Index));\r |
909 | }\r |
910 | \r |
911 | for (Index = 0; Index < 9; Index++) {\r |
912 | outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((GraphicsController[Index] << 8) | Index));\r |
913 | }\r |
914 | \r |
915 | inb (Private, INPUT_STATUS_1_REGISTER);\r |
916 | \r |
917 | for (Index = 0; Index < 21; Index++) {\r |
918 | outb (Private, ATT_ADDRESS_REGISTER, (UINT8) Index);\r |
919 | outb (Private, ATT_ADDRESS_REGISTER, AttributeController[Index]);\r |
920 | }\r |
921 | \r |
922 | outb (Private, ATT_ADDRESS_REGISTER, 0x20);\r |
923 | \r |
924 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x0009);\r |
925 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x000a);\r |
926 | outw (Private, GRAPH_ADDRESS_REGISTER, 0x000b);\r |
927 | outb (Private, DAC_PIXEL_MASK_REGISTER, 0xff);\r |
928 | \r |
929 | SetDefaultPalette (Private);\r |
930 | ClearScreen (Private);\r |
931 | }\r |