ARM Packages: Fixed missing braces (the warning was disabled by GCC)
[mirror_edk2.git] / Omap35xxPkg / LcdGraphicsOutputDxe / LcdGraphicsOutputDxe.c
1 /** @file
2
3 Copyright (c) 2011-2014, ARM Ltd. All rights reserved.<BR>
4 This program and the accompanying materials
5 are licensed and made available under the terms and conditions of the BSD License
6 which accompanies this distribution. The full text of the license may be found at
7 http://opensource.org/licenses/bsd-license.php
8
9 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
10 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
11
12 **/
13
14 #include "LcdGraphicsOutputDxe.h"
15
16 BOOLEAN mDisplayInitialized = FALSE;
17
18 LCD_MODE LcdModes[] = {
19 {
20 0, 640, 480,
21 9, 4,
22 96, 16, 48,
23 2, 10, 33
24 },
25 {
26 1, 800, 600,
27 11, 2,
28 120, 56, 64,
29 5, 37, 22
30 },
31 {
32 2, 1024, 768,
33 6, 2,
34 96, 16, 48,
35 2, 10, 33
36 },
37 };
38
39 LCD_INSTANCE mLcdTemplate = {
40 LCD_INSTANCE_SIGNATURE,
41 NULL, // Handle
42 { // ModeInfo
43 0, // Version
44 0, // HorizontalResolution
45 0, // VerticalResolution
46 PixelBltOnly, // PixelFormat
47 {
48 0xF800, //RedMask;
49 0x7E0, //GreenMask;
50 0x1F, //BlueMask;
51 0x0//ReservedMask
52 }, // PixelInformation
53 0, // PixelsPerScanLine
54 },
55 { // Mode
56 3, // MaxMode;
57 0, // Mode;
58 NULL, // Info;
59 0, // SizeOfInfo;
60 0, // FrameBufferBase;
61 0 // FrameBufferSize;
62 },
63 { // Gop
64 LcdGraphicsQueryMode, // QueryMode
65 LcdGraphicsSetMode, // SetMode
66 LcdGraphicsBlt, // Blt
67 NULL // *Mode
68 },
69 { // DevicePath
70 {
71 {
72 HARDWARE_DEVICE_PATH, HW_VENDOR_DP,
73 { (UINT8) (sizeof(VENDOR_DEVICE_PATH)), (UINT8) ((sizeof(VENDOR_DEVICE_PATH)) >> 8) },
74 },
75 // Hardware Device Path for Lcd
76 EFI_CALLER_ID_GUID // Use the driver's GUID
77 },
78 {
79 END_DEVICE_PATH_TYPE,
80 END_ENTIRE_DEVICE_PATH_SUBTYPE,
81 { sizeof(EFI_DEVICE_PATH_PROTOCOL), 0}
82 }
83 }
84 };
85
86 EFI_STATUS
87 LcdInstanceContructor (
88 OUT LCD_INSTANCE** NewInstance
89 )
90 {
91 LCD_INSTANCE* Instance;
92
93 Instance = AllocateCopyPool (sizeof(LCD_INSTANCE), &mLcdTemplate);
94 if (Instance == NULL) {
95 return EFI_OUT_OF_RESOURCES;
96 }
97
98 Instance->Gop.Mode = &Instance->Mode;
99 Instance->Mode.Info = &Instance->ModeInfo;
100
101 *NewInstance = Instance;
102 return EFI_SUCCESS;
103 }
104
105 EFI_STATUS
106 LcdPlatformGetVram (
107 OUT EFI_PHYSICAL_ADDRESS* VramBaseAddress,
108 OUT UINTN* VramSize
109 )
110 {
111 EFI_STATUS Status;
112 EFI_CPU_ARCH_PROTOCOL *Cpu;
113 UINTN MaxSize;
114
115 MaxSize = 0x500000;
116 *VramSize = MaxSize;
117
118 // Allocate VRAM from DRAM
119 Status = gBS->AllocatePages (AllocateAnyPages, EfiBootServicesData, EFI_SIZE_TO_PAGES((MaxSize)), VramBaseAddress);
120 if (EFI_ERROR(Status)) {
121 return Status;
122 }
123
124 // Ensure the Cpu architectural protocol is already installed
125 Status = gBS->LocateProtocol (&gEfiCpuArchProtocolGuid, NULL, (VOID **)&Cpu);
126 ASSERT_EFI_ERROR(Status);
127
128 // Mark the VRAM as un-cacheable. The VRAM is inside the DRAM, which is cacheable.
129 Status = Cpu->SetMemoryAttributes (Cpu, *VramBaseAddress, *VramSize, EFI_MEMORY_UC);
130 if (EFI_ERROR(Status)) {
131 gBS->FreePool (VramBaseAddress);
132 return Status;
133 }
134
135 return EFI_SUCCESS;
136 }
137
138 EFI_STATUS
139 DssSetMode (
140 UINT32 VramBaseAddress,
141 UINTN ModeNumber
142 )
143 {
144 // Make sure the interface clock is running
145 MmioWrite32 (CM_ICLKEN_DSS, EN_DSS);
146
147 // Stop the functional clocks
148 MmioAnd32 (CM_FCLKEN_DSS, ~(EN_DSS1 | EN_DSS2 | EN_TV));
149
150 // Program the DSS clock divisor
151 MmioWrite32 (CM_CLKSEL_DSS, 0x1000 | (LcdModes[ModeNumber].DssDivisor));
152
153 // Start the functional clocks
154 MmioOr32 (CM_FCLKEN_DSS, (EN_DSS1 | EN_DSS2 | EN_TV));
155
156 // Wait for DSS to stabilize
157 gBS->Stall(1);
158
159 // Reset the subsystem
160 MmioWrite32(DSS_SYSCONFIG, DSS_SOFTRESET);
161 while (!(MmioRead32 (DSS_SYSSTATUS) & DSS_RESETDONE));
162
163 // Configure LCD parameters
164 MmioWrite32 (DISPC_SIZE_LCD,
165 ((LcdModes[ModeNumber].HorizontalResolution - 1)
166 | ((LcdModes[ModeNumber].VerticalResolution - 1) << 16))
167 );
168 MmioWrite32 (DISPC_TIMING_H,
169 ( (LcdModes[ModeNumber].HSync - 1)
170 | ((LcdModes[ModeNumber].HFrontPorch - 1) << 8)
171 | ((LcdModes[ModeNumber].HBackPorch - 1) << 20))
172 );
173 MmioWrite32 (DISPC_TIMING_V,
174 ( (LcdModes[ModeNumber].VSync - 1)
175 | ((LcdModes[ModeNumber].VFrontPorch - 1) << 8)
176 | ((LcdModes[ModeNumber].VBackPorch - 1) << 20))
177 );
178
179 // Set the framebuffer to only load frames (no gamma tables)
180 MmioAnd32 (DISPC_CONFIG, CLEARLOADMODE);
181 MmioOr32 (DISPC_CONFIG, LOAD_FRAME_ONLY);
182
183 // Divisor for the pixel clock
184 MmioWrite32(DISPC_DIVISOR, ((1 << 16) | LcdModes[ModeNumber].DispcDivisor) );
185
186 // Set up the graphics layer
187 MmioWrite32 (DISPC_GFX_PRELD, 0x2D8);
188 MmioWrite32 (DISPC_GFX_BA0, VramBaseAddress);
189 MmioWrite32 (DISPC_GFX_SIZE,
190 ((LcdModes[ModeNumber].HorizontalResolution - 1)
191 | ((LcdModes[ModeNumber].VerticalResolution - 1) << 16))
192 );
193
194 MmioWrite32(DISPC_GFX_ATTR, (GFXENABLE | RGB16 | BURSTSIZE16));
195
196 // Start it all
197 MmioOr32 (DISPC_CONTROL, (LCDENABLE | ACTIVEMATRIX | DATALINES24 | BYPASS_MODE | LCDENABLESIGNAL));
198 MmioOr32 (DISPC_CONTROL, GOLCD);
199
200 return EFI_SUCCESS;
201 }
202
203 EFI_STATUS
204 HwInitializeDisplay (
205 UINTN VramBaseAddress,
206 UINTN VramSize
207 )
208 {
209 EFI_STATUS Status;
210 UINT8 Data;
211 EFI_TPL OldTpl;
212 EMBEDDED_EXTERNAL_DEVICE *gTPS65950;
213
214 // Enable power lines used by TFP410
215 Status = gBS->LocateProtocol (&gEmbeddedExternalDeviceProtocolGuid, NULL, (VOID **)&gTPS65950);
216 ASSERT_EFI_ERROR (Status);
217
218 OldTpl = gBS->RaiseTPL(TPL_NOTIFY);
219 Data = VAUX_DEV_GRP_P1;
220 Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID4, VPLL2_DEV_GRP), 1, &Data);
221 ASSERT_EFI_ERROR(Status);
222
223 Data = VAUX_DEDICATED_18V;
224 Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID4, VPLL2_DEDICATED), 1, &Data);
225 ASSERT_EFI_ERROR (Status);
226
227 // Power up TFP410 (set GPIO2 on TPS - for BeagleBoard-xM)
228 Status = gTPS65950->Read (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID2, GPIODATADIR1), 1, &Data);
229 ASSERT_EFI_ERROR (Status);
230 Data |= BIT2;
231 Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID2, GPIODATADIR1), 1, &Data);
232 ASSERT_EFI_ERROR (Status);
233
234 Data = BIT2;
235 Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID2, SETGPIODATAOUT1), 1, &Data);
236 ASSERT_EFI_ERROR (Status);
237
238 gBS->RestoreTPL(OldTpl);
239
240 // Power up TFP410 (set GPIO 170 - for older BeagleBoards)
241 MmioAnd32 (GPIO6_BASE + GPIO_OE, ~BIT10);
242 MmioOr32 (GPIO6_BASE + GPIO_SETDATAOUT, BIT10);
243
244 return EFI_SUCCESS;
245 }
246
247 EFI_STATUS
248 InitializeDisplay (
249 IN LCD_INSTANCE* Instance
250 )
251 {
252 EFI_STATUS Status;
253 UINTN VramSize;
254 EFI_PHYSICAL_ADDRESS VramBaseAddress;
255
256 Status = LcdPlatformGetVram (&VramBaseAddress, &VramSize);
257 if (EFI_ERROR (Status)) {
258 return Status;
259 }
260
261 Instance->Mode.FrameBufferBase = VramBaseAddress;
262 Instance->Mode.FrameBufferSize = VramSize;
263
264 Status = HwInitializeDisplay((UINTN)VramBaseAddress, VramSize);
265 if (!EFI_ERROR (Status)) {
266 mDisplayInitialized = TRUE;
267 }
268
269 return Status;
270 }
271
272 EFI_STATUS
273 EFIAPI
274 LcdGraphicsQueryMode (
275 IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,
276 IN UINT32 ModeNumber,
277 OUT UINTN *SizeOfInfo,
278 OUT EFI_GRAPHICS_OUTPUT_MODE_INFORMATION **Info
279 )
280 {
281 LCD_INSTANCE *Instance;
282
283 Instance = LCD_INSTANCE_FROM_GOP_THIS(This);
284
285 if (!mDisplayInitialized) {
286 InitializeDisplay (Instance);
287 }
288
289 // Error checking
290 if ( (This == NULL) || (Info == NULL) || (SizeOfInfo == NULL) || (ModeNumber >= This->Mode->MaxMode) ) {
291 DEBUG((DEBUG_ERROR, "LcdGraphicsQueryMode: ERROR - For mode number %d : Invalid Parameter.\n", ModeNumber ));
292 return EFI_INVALID_PARAMETER;
293 }
294
295 *Info = AllocateCopyPool(sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION), &Instance->ModeInfo);
296 if (*Info == NULL) {
297 return EFI_OUT_OF_RESOURCES;
298 }
299
300 *SizeOfInfo = sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION);
301
302 (*Info)->Version = 0;
303 (*Info)->HorizontalResolution = LcdModes[ModeNumber].HorizontalResolution;
304 (*Info)->VerticalResolution = LcdModes[ModeNumber].VerticalResolution;
305 (*Info)->PixelFormat = PixelBltOnly;
306
307 return EFI_SUCCESS;
308 }
309
310 EFI_STATUS
311 EFIAPI
312 LcdGraphicsSetMode (
313 IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,
314 IN UINT32 ModeNumber
315 )
316 {
317 LCD_INSTANCE *Instance;
318
319 Instance = LCD_INSTANCE_FROM_GOP_THIS(This);
320
321 if (ModeNumber >= Instance->Mode.MaxMode) {
322 return EFI_UNSUPPORTED;
323 }
324
325 if (!mDisplayInitialized) {
326 InitializeDisplay (Instance);
327 }
328
329 DssSetMode((UINT32)Instance->Mode.FrameBufferBase, ModeNumber);
330
331 Instance->Mode.Mode = ModeNumber;
332 Instance->ModeInfo.HorizontalResolution = LcdModes[ModeNumber].HorizontalResolution;
333 Instance->ModeInfo.VerticalResolution = LcdModes[ModeNumber].VerticalResolution;
334
335 return EFI_SUCCESS;
336 }
337
338 EFI_STATUS
339 EFIAPI
340 LcdGraphicsOutputDxeInitialize (
341 IN EFI_HANDLE ImageHandle,
342 IN EFI_SYSTEM_TABLE *SystemTable
343 )
344 {
345 EFI_STATUS Status = EFI_SUCCESS;
346 LCD_INSTANCE* Instance;
347
348 Status = LcdInstanceContructor (&Instance);
349 if (EFI_ERROR(Status)) {
350 goto EXIT;
351 }
352
353 // Install the Graphics Output Protocol and the Device Path
354 Status = gBS->InstallMultipleProtocolInterfaces(
355 &Instance->Handle,
356 &gEfiGraphicsOutputProtocolGuid, &Instance->Gop,
357 &gEfiDevicePathProtocolGuid, &Instance->DevicePath,
358 NULL
359 );
360
361 if (EFI_ERROR(Status)) {
362 DEBUG((DEBUG_ERROR, "GraphicsOutputDxeInitialize: Can not install the protocol. Exit Status=%r\n", Status));
363 goto EXIT;
364 }
365
366 // Register for an ExitBootServicesEvent
367 // When ExitBootServices starts, this function here will make sure that the graphics driver will shut down properly,
368 // i.e. it will free up all allocated memory and perform any necessary hardware re-configuration.
369 /*Status = gBS->CreateEvent (
370 EVT_SIGNAL_EXIT_BOOT_SERVICES,
371 TPL_NOTIFY,
372 LcdGraphicsExitBootServicesEvent, NULL,
373 &Instance->ExitBootServicesEvent
374 );
375
376 if (EFI_ERROR(Status)) {
377 DEBUG((DEBUG_ERROR, "GraphicsOutputDxeInitialize: Can not install the ExitBootServicesEvent handler. Exit Status=%r\n", Status));
378 goto EXIT_ERROR_UNINSTALL_PROTOCOL;
379 }*/
380
381 // To get here, everything must be fine, so just exit
382 goto EXIT;
383
384 //EXIT_ERROR_UNINSTALL_PROTOCOL:
385 /* The following function could return an error message,
386 * however, to get here something must have gone wrong already,
387 * so preserve the original error, i.e. don't change
388 * the Status variable, even it fails to uninstall the protocol.
389 */
390 /* gBS->UninstallMultipleProtocolInterfaces (
391 Instance->Handle,
392 &gEfiGraphicsOutputProtocolGuid, &Instance->Gop, // Uninstall Graphics Output protocol
393 &gEfiDevicePathProtocolGuid, &Instance->DevicePath, // Uninstall device path
394 NULL
395 );*/
396
397 EXIT:
398 return Status;
399
400 }