]>
Commit | Line | Data |
---|---|---|
1d25ff51 GH |
1 | /** @file\r |
2 | This driver is a implementation of the Graphics Output Protocol\r | |
3 | for the QEMU ramfb device.\r | |
4 | \r | |
5 | Copyright (c) 2018, Red Hat Inc.\r | |
6 | \r | |
7 | This program and the accompanying materials are licensed and made\r | |
8 | available under the terms and conditions of the BSD License which\r | |
9 | accompanies this distribution. The full text of the license may be\r | |
10 | found at http://opensource.org/licenses/bsd-license.php\r | |
11 | \r | |
12 | THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS"\r | |
13 | BASIS, WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER\r | |
14 | EXPRESS OR IMPLIED.\r | |
15 | \r | |
16 | **/\r | |
17 | \r | |
18 | #include <Protocol/GraphicsOutput.h>\r | |
19 | \r | |
20 | #include <Library/BaseLib.h>\r | |
21 | #include <Library/BaseMemoryLib.h>\r | |
22 | #include <Library/DebugLib.h>\r | |
23 | #include <Library/DevicePathLib.h>\r | |
24 | #include <Library/FrameBufferBltLib.h>\r | |
25 | #include <Library/MemoryAllocationLib.h>\r | |
26 | #include <Library/UefiBootServicesTableLib.h>\r | |
27 | #include <Library/QemuFwCfgLib.h>\r | |
28 | \r | |
29 | #include <Guid/QemuRamfb.h>\r | |
30 | \r | |
31 | #define RAMFB_FORMAT 0x34325258 /* DRM_FORMAT_XRGB8888 */\r | |
32 | #define RAMFB_BPP 4\r | |
33 | \r | |
34 | #pragma pack (1)\r | |
35 | typedef struct RAMFB_CONFIG {\r | |
36 | UINT64 Address;\r | |
37 | UINT32 FourCC;\r | |
38 | UINT32 Flags;\r | |
39 | UINT32 Width;\r | |
40 | UINT32 Height;\r | |
41 | UINT32 Stride;\r | |
42 | } RAMFB_CONFIG;\r | |
43 | #pragma pack ()\r | |
44 | \r | |
45 | STATIC EFI_HANDLE mRamfbHandle;\r | |
46 | STATIC EFI_HANDLE mGopHandle;\r | |
47 | STATIC FRAME_BUFFER_CONFIGURE *mQemuRamfbFrameBufferBltConfigure;\r | |
48 | STATIC UINTN mQemuRamfbFrameBufferBltConfigureSize;\r | |
49 | STATIC FIRMWARE_CONFIG_ITEM mRamfbFwCfgItem;\r | |
50 | \r | |
51 | STATIC EFI_GRAPHICS_OUTPUT_MODE_INFORMATION mQemuRamfbModeInfo[] = {\r | |
52 | {\r | |
53 | 0, // Version\r | |
54 | 640, // HorizontalResolution\r | |
55 | 480, // VerticalResolution\r | |
56 | },{\r | |
57 | 0, // Version\r | |
58 | 800, // HorizontalResolution\r | |
59 | 600, // VerticalResolution\r | |
60 | },{\r | |
61 | 0, // Version\r | |
62 | 1024, // HorizontalResolution\r | |
63 | 768, // VerticalResolution\r | |
64 | }\r | |
65 | };\r | |
66 | \r | |
67 | STATIC EFI_GRAPHICS_OUTPUT_PROTOCOL_MODE mQemuRamfbMode = {\r | |
68 | ARRAY_SIZE (mQemuRamfbModeInfo), // MaxMode\r | |
69 | 0, // Mode\r | |
70 | mQemuRamfbModeInfo, // Info\r | |
71 | sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION), // SizeOfInfo\r | |
72 | };\r | |
73 | \r | |
74 | STATIC\r | |
75 | EFI_STATUS\r | |
76 | EFIAPI\r | |
77 | QemuRamfbGraphicsOutputQueryMode (\r | |
78 | IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r | |
79 | IN UINT32 ModeNumber,\r | |
80 | OUT UINTN *SizeOfInfo,\r | |
81 | OUT EFI_GRAPHICS_OUTPUT_MODE_INFORMATION **Info\r | |
82 | )\r | |
83 | {\r | |
84 | EFI_GRAPHICS_OUTPUT_MODE_INFORMATION *ModeInfo;\r | |
85 | \r | |
86 | if (Info == NULL || SizeOfInfo == NULL ||\r | |
87 | ModeNumber >= mQemuRamfbMode.MaxMode) {\r | |
88 | return EFI_INVALID_PARAMETER;\r | |
89 | }\r | |
90 | ModeInfo = &mQemuRamfbModeInfo[ModeNumber];\r | |
91 | \r | |
92 | *Info = AllocateCopyPool (sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION),\r | |
93 | ModeInfo);\r | |
94 | if (*Info == NULL) {\r | |
95 | return EFI_OUT_OF_RESOURCES;\r | |
96 | }\r | |
97 | *SizeOfInfo = sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION);\r | |
98 | \r | |
99 | return EFI_SUCCESS;\r | |
100 | }\r | |
101 | \r | |
102 | STATIC\r | |
103 | EFI_STATUS\r | |
104 | EFIAPI\r | |
105 | QemuRamfbGraphicsOutputSetMode (\r | |
106 | IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r | |
107 | IN UINT32 ModeNumber\r | |
108 | )\r | |
109 | {\r | |
110 | EFI_GRAPHICS_OUTPUT_MODE_INFORMATION *ModeInfo;\r | |
111 | RAMFB_CONFIG Config;\r | |
112 | EFI_GRAPHICS_OUTPUT_BLT_PIXEL Black;\r | |
113 | RETURN_STATUS Status;\r | |
114 | \r | |
115 | if (ModeNumber >= mQemuRamfbMode.MaxMode) {\r | |
116 | return EFI_UNSUPPORTED;\r | |
117 | }\r | |
118 | ModeInfo = &mQemuRamfbModeInfo[ModeNumber];\r | |
119 | \r | |
120 | DEBUG ((DEBUG_INFO, "Ramfb: SetMode %u (%ux%u)\n", ModeNumber,\r | |
121 | ModeInfo->HorizontalResolution, ModeInfo->VerticalResolution));\r | |
122 | \r | |
123 | Config.Address = SwapBytes64 (mQemuRamfbMode.FrameBufferBase);\r | |
124 | Config.FourCC = SwapBytes32 (RAMFB_FORMAT);\r | |
125 | Config.Flags = SwapBytes32 (0);\r | |
126 | Config.Width = SwapBytes32 (ModeInfo->HorizontalResolution);\r | |
127 | Config.Height = SwapBytes32 (ModeInfo->VerticalResolution);\r | |
128 | Config.Stride = SwapBytes32 (ModeInfo->HorizontalResolution * RAMFB_BPP);\r | |
129 | \r | |
130 | Status = FrameBufferBltConfigure (\r | |
131 | (VOID*)(UINTN)mQemuRamfbMode.FrameBufferBase,\r | |
132 | ModeInfo,\r | |
133 | mQemuRamfbFrameBufferBltConfigure,\r | |
134 | &mQemuRamfbFrameBufferBltConfigureSize\r | |
135 | );\r | |
136 | \r | |
137 | if (Status == RETURN_BUFFER_TOO_SMALL) {\r | |
138 | if (mQemuRamfbFrameBufferBltConfigure != NULL) {\r | |
139 | FreePool (mQemuRamfbFrameBufferBltConfigure);\r | |
140 | }\r | |
141 | mQemuRamfbFrameBufferBltConfigure =\r | |
142 | AllocatePool (mQemuRamfbFrameBufferBltConfigureSize);\r | |
143 | if (mQemuRamfbFrameBufferBltConfigure == NULL) {\r | |
144 | mQemuRamfbFrameBufferBltConfigureSize = 0;\r | |
145 | return EFI_OUT_OF_RESOURCES;\r | |
146 | }\r | |
147 | \r | |
148 | Status = FrameBufferBltConfigure (\r | |
149 | (VOID*)(UINTN)mQemuRamfbMode.FrameBufferBase,\r | |
150 | ModeInfo,\r | |
151 | mQemuRamfbFrameBufferBltConfigure,\r | |
152 | &mQemuRamfbFrameBufferBltConfigureSize\r | |
153 | );\r | |
154 | }\r | |
155 | if (RETURN_ERROR (Status)) {\r | |
156 | ASSERT (Status == RETURN_UNSUPPORTED);\r | |
157 | return Status;\r | |
158 | }\r | |
159 | \r | |
160 | mQemuRamfbMode.Mode = ModeNumber;\r | |
161 | mQemuRamfbMode.Info = ModeInfo;\r | |
162 | \r | |
163 | QemuFwCfgSelectItem (mRamfbFwCfgItem);\r | |
164 | QemuFwCfgWriteBytes (sizeof (Config), &Config);\r | |
165 | \r | |
166 | //\r | |
167 | // clear screen\r | |
168 | //\r | |
169 | ZeroMem (&Black, sizeof (Black));\r | |
170 | Status = FrameBufferBlt (\r | |
171 | mQemuRamfbFrameBufferBltConfigure,\r | |
172 | &Black,\r | |
173 | EfiBltVideoFill,\r | |
174 | 0, // SourceX -- ignored\r | |
175 | 0, // SourceY -- ignored\r | |
176 | 0, // DestinationX\r | |
177 | 0, // DestinationY\r | |
178 | ModeInfo->HorizontalResolution, // Width\r | |
179 | ModeInfo->VerticalResolution, // Height\r | |
180 | 0 // Delta -- ignored\r | |
181 | );\r | |
182 | if (RETURN_ERROR (Status)) {\r | |
183 | DEBUG ((DEBUG_WARN, "%a: clearing the screen failed: %r\n",\r | |
184 | __FUNCTION__, Status));\r | |
185 | }\r | |
186 | \r | |
187 | return EFI_SUCCESS;\r | |
188 | }\r | |
189 | \r | |
190 | STATIC\r | |
191 | EFI_STATUS\r | |
192 | EFIAPI\r | |
193 | QemuRamfbGraphicsOutputBlt (\r | |
194 | IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r | |
195 | IN EFI_GRAPHICS_OUTPUT_BLT_PIXEL *BltBuffer, OPTIONAL\r | |
196 | IN EFI_GRAPHICS_OUTPUT_BLT_OPERATION BltOperation,\r | |
197 | IN UINTN SourceX,\r | |
198 | IN UINTN SourceY,\r | |
199 | IN UINTN DestinationX,\r | |
200 | IN UINTN DestinationY,\r | |
201 | IN UINTN Width,\r | |
202 | IN UINTN Height,\r | |
203 | IN UINTN Delta\r | |
204 | )\r | |
205 | {\r | |
206 | return FrameBufferBlt (\r | |
207 | mQemuRamfbFrameBufferBltConfigure,\r | |
208 | BltBuffer,\r | |
209 | BltOperation,\r | |
210 | SourceX,\r | |
211 | SourceY,\r | |
212 | DestinationX,\r | |
213 | DestinationY,\r | |
214 | Width,\r | |
215 | Height,\r | |
216 | Delta\r | |
217 | );\r | |
218 | }\r | |
219 | \r | |
220 | STATIC EFI_GRAPHICS_OUTPUT_PROTOCOL mQemuRamfbGraphicsOutput = {\r | |
221 | QemuRamfbGraphicsOutputQueryMode,\r | |
222 | QemuRamfbGraphicsOutputSetMode,\r | |
223 | QemuRamfbGraphicsOutputBlt,\r | |
224 | &mQemuRamfbMode,\r | |
225 | };\r | |
226 | \r | |
227 | EFI_STATUS\r | |
228 | EFIAPI\r | |
229 | InitializeQemuRamfb (\r | |
230 | IN EFI_HANDLE ImageHandle,\r | |
231 | IN EFI_SYSTEM_TABLE *SystemTable\r | |
232 | )\r | |
233 | {\r | |
234 | EFI_DEVICE_PATH_PROTOCOL *RamfbDevicePath;\r | |
235 | EFI_DEVICE_PATH_PROTOCOL *GopDevicePath;\r | |
236 | VOID *DevicePath;\r | |
237 | VENDOR_DEVICE_PATH VendorDeviceNode;\r | |
238 | ACPI_ADR_DEVICE_PATH AcpiDeviceNode;\r | |
239 | EFI_STATUS Status;\r | |
240 | EFI_PHYSICAL_ADDRESS FbBase;\r | |
241 | UINTN FbSize, MaxFbSize, Pages;\r | |
242 | UINTN FwCfgSize;\r | |
243 | UINTN Index;\r | |
244 | \r | |
245 | if (!QemuFwCfgIsAvailable ()) {\r | |
246 | DEBUG ((DEBUG_INFO, "Ramfb: no FwCfg\n"));\r | |
247 | return EFI_NOT_FOUND;\r | |
248 | }\r | |
249 | \r | |
250 | Status = QemuFwCfgFindFile ("etc/ramfb", &mRamfbFwCfgItem, &FwCfgSize);\r | |
251 | if (EFI_ERROR (Status)) {\r | |
252 | return EFI_NOT_FOUND;\r | |
253 | }\r | |
254 | if (FwCfgSize != sizeof (RAMFB_CONFIG)) {\r | |
255 | DEBUG ((DEBUG_ERROR, "Ramfb: FwCfg size mismatch (expected %lu, got %lu)\n",\r | |
256 | (UINT64)sizeof (RAMFB_CONFIG), (UINT64)FwCfgSize));\r | |
257 | return EFI_PROTOCOL_ERROR;\r | |
258 | }\r | |
259 | \r | |
260 | MaxFbSize = 0;\r | |
261 | for (Index = 0; Index < ARRAY_SIZE (mQemuRamfbModeInfo); Index++) {\r | |
262 | mQemuRamfbModeInfo[Index].PixelsPerScanLine =\r | |
263 | mQemuRamfbModeInfo[Index].HorizontalResolution;\r | |
264 | mQemuRamfbModeInfo[Index].PixelFormat =\r | |
265 | PixelBlueGreenRedReserved8BitPerColor;\r | |
266 | FbSize = RAMFB_BPP *\r | |
267 | mQemuRamfbModeInfo[Index].HorizontalResolution *\r | |
268 | mQemuRamfbModeInfo[Index].VerticalResolution;\r | |
269 | if (MaxFbSize < FbSize) {\r | |
270 | MaxFbSize = FbSize;\r | |
271 | }\r | |
272 | DEBUG ((DEBUG_INFO, "Ramfb: Mode %lu: %ux%u, %lu kB\n", (UINT64)Index,\r | |
273 | mQemuRamfbModeInfo[Index].HorizontalResolution,\r | |
274 | mQemuRamfbModeInfo[Index].VerticalResolution,\r | |
275 | (UINT64)(FbSize / 1024)));\r | |
276 | }\r | |
277 | \r | |
278 | Pages = EFI_SIZE_TO_PAGES (MaxFbSize);\r | |
279 | MaxFbSize = EFI_PAGES_TO_SIZE (Pages);\r | |
280 | FbBase = (EFI_PHYSICAL_ADDRESS)(UINTN)AllocateReservedPages (Pages);\r | |
281 | if (FbBase == 0) {\r | |
282 | DEBUG ((DEBUG_ERROR, "Ramfb: memory allocation failed\n"));\r | |
283 | return EFI_OUT_OF_RESOURCES;\r | |
284 | }\r | |
285 | DEBUG ((DEBUG_INFO, "Ramfb: Framebuffer at 0x%lx, %lu kB, %lu pages\n",\r | |
286 | (UINT64)FbBase, (UINT64)(MaxFbSize / 1024), (UINT64)Pages));\r | |
287 | mQemuRamfbMode.FrameBufferSize = MaxFbSize;\r | |
288 | mQemuRamfbMode.FrameBufferBase = FbBase;\r | |
289 | \r | |
290 | //\r | |
291 | // 800 x 600\r | |
292 | //\r | |
293 | QemuRamfbGraphicsOutputSetMode (&mQemuRamfbGraphicsOutput, 1);\r | |
294 | \r | |
295 | //\r | |
296 | // ramfb vendor devpath\r | |
297 | //\r | |
298 | VendorDeviceNode.Header.Type = HARDWARE_DEVICE_PATH;\r | |
299 | VendorDeviceNode.Header.SubType = HW_VENDOR_DP;\r | |
300 | CopyGuid (&VendorDeviceNode.Guid, &gQemuRamfbGuid);\r | |
301 | SetDevicePathNodeLength (&VendorDeviceNode.Header,\r | |
302 | sizeof (VENDOR_DEVICE_PATH));\r | |
303 | \r | |
304 | RamfbDevicePath = AppendDevicePathNode (NULL,\r | |
305 | (EFI_DEVICE_PATH_PROTOCOL *) &VendorDeviceNode);\r | |
306 | if (RamfbDevicePath == NULL) {\r | |
307 | Status = EFI_OUT_OF_RESOURCES;\r | |
308 | goto FreeFramebuffer;\r | |
309 | }\r | |
310 | \r | |
311 | Status = gBS->InstallMultipleProtocolInterfaces (\r | |
312 | &mRamfbHandle,\r | |
313 | &gEfiDevicePathProtocolGuid,\r | |
314 | RamfbDevicePath,\r | |
315 | NULL\r | |
316 | );\r | |
317 | if (EFI_ERROR (Status)) {\r | |
318 | DEBUG ((DEBUG_ERROR, "Ramfb: install Ramfb Vendor DevicePath failed: %r\n",\r | |
319 | Status));\r | |
320 | goto FreeRamfbDevicePath;\r | |
321 | }\r | |
322 | \r | |
323 | //\r | |
324 | // gop devpath + protocol\r | |
325 | //\r | |
326 | AcpiDeviceNode.Header.Type = ACPI_DEVICE_PATH;\r | |
327 | AcpiDeviceNode.Header.SubType = ACPI_ADR_DP;\r | |
328 | AcpiDeviceNode.ADR = ACPI_DISPLAY_ADR (\r | |
329 | 1, // DeviceIdScheme\r | |
330 | 0, // HeadId\r | |
331 | 0, // NonVgaOutput\r | |
332 | 1, // BiosCanDetect\r | |
333 | 0, // VendorInfo\r | |
334 | ACPI_ADR_DISPLAY_TYPE_EXTERNAL_DIGITAL, // Type\r | |
335 | 0, // Port\r | |
336 | 0 // Index\r | |
337 | );\r | |
338 | SetDevicePathNodeLength (&AcpiDeviceNode.Header,\r | |
339 | sizeof (ACPI_ADR_DEVICE_PATH));\r | |
340 | \r | |
341 | GopDevicePath = AppendDevicePathNode (RamfbDevicePath,\r | |
342 | (EFI_DEVICE_PATH_PROTOCOL *) &AcpiDeviceNode);\r | |
343 | if (GopDevicePath == NULL) {\r | |
344 | Status = EFI_OUT_OF_RESOURCES;\r | |
345 | goto FreeRamfbHandle;\r | |
346 | }\r | |
347 | \r | |
348 | Status = gBS->InstallMultipleProtocolInterfaces (\r | |
349 | &mGopHandle,\r | |
350 | &gEfiDevicePathProtocolGuid,\r | |
351 | GopDevicePath,\r | |
352 | &gEfiGraphicsOutputProtocolGuid,\r | |
353 | &mQemuRamfbGraphicsOutput,\r | |
354 | NULL\r | |
355 | );\r | |
356 | if (EFI_ERROR (Status)) {\r | |
357 | DEBUG ((DEBUG_ERROR, "Ramfb: install GOP DevicePath failed: %r\n",\r | |
358 | Status));\r | |
359 | goto FreeGopDevicePath;\r | |
360 | }\r | |
361 | \r | |
362 | Status = gBS->OpenProtocol (\r | |
363 | mRamfbHandle,\r | |
364 | &gEfiDevicePathProtocolGuid,\r | |
365 | &DevicePath,\r | |
366 | gImageHandle,\r | |
367 | mGopHandle,\r | |
368 | EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER\r | |
369 | );\r | |
370 | if (EFI_ERROR (Status)) {\r | |
371 | DEBUG ((DEBUG_ERROR, "Ramfb: OpenProtocol failed: %r\n", Status));\r | |
372 | goto FreeGopHandle;\r | |
373 | }\r | |
374 | \r | |
375 | return EFI_SUCCESS;\r | |
376 | \r | |
377 | FreeGopHandle:\r | |
378 | gBS->UninstallMultipleProtocolInterfaces (\r | |
379 | mGopHandle,\r | |
380 | &gEfiDevicePathProtocolGuid,\r | |
381 | GopDevicePath,\r | |
382 | &gEfiGraphicsOutputProtocolGuid,\r | |
383 | &mQemuRamfbGraphicsOutput,\r | |
384 | NULL\r | |
385 | );\r | |
386 | FreeGopDevicePath:\r | |
387 | FreePool (GopDevicePath);\r | |
388 | FreeRamfbHandle:\r | |
389 | gBS->UninstallMultipleProtocolInterfaces (\r | |
390 | mRamfbHandle,\r | |
391 | &gEfiDevicePathProtocolGuid,\r | |
392 | RamfbDevicePath,\r | |
393 | NULL\r | |
394 | );\r | |
395 | FreeRamfbDevicePath:\r | |
396 | FreePool (RamfbDevicePath);\r | |
397 | FreeFramebuffer:\r | |
398 | FreePages ((VOID*)(UINTN)mQemuRamfbMode.FrameBufferBase, Pages);\r | |
399 | return Status;\r | |
400 | }\r |