2 * Copyright (C) 2014 Google, Inc
4 * From coreboot, originally based on the Linux kernel (drivers/pci/pci.c).
7 * Copyright (C) 2003-2004 Linux Networx
8 * (Written by Eric Biederman <ebiederman@lnxi.com> for Linux Networx)
9 * Copyright (C) 2003-2006 Ronald G. Minnich <rminnich@gmail.com>
10 * Copyright (C) 2004-2005 Li-Ta Lo <ollie@lanl.gov>
11 * Copyright (C) 2005-2006 Tyan
12 * (Written by Yinghai Lu <yhlu@tyan.com> for Tyan)
13 * Copyright (C) 2005-2009 coresystems GmbH
14 * (Written by Stefan Reinauer <stepan@coresystems.de> for coresystems GmbH)
16 * PCI Bus Services, see include/linux/pci.h for further explanation.
18 * Copyright 1993 -- 1997 Drew Eckhardt, Frederic Potter,
19 * David Mosberger-Tang
21 * Copyright 1997 -- 1999 Martin Mares <mj@atrey.karlin.mff.cuni.cz>
23 * SPDX-License-Identifier: GPL-2.0
27 #include <bios_emul.h>
36 #include <linux/screen_info.h>
39 #include <asm/acpi_s3.h>
40 DECLARE_GLOBAL_DATA_PTR
;
43 __weak
bool board_should_run_oprom(struct udevice
*dev
)
45 #if defined(CONFIG_X86) && defined(CONFIG_HAVE_ACPI_RESUME)
46 if (gd
->arch
.prev_sleep_state
== ACPI_S3
) {
47 if (IS_ENABLED(CONFIG_S3_VGA_ROM_RUN
))
57 __weak
bool board_should_load_oprom(struct udevice
*dev
)
62 __weak
uint32_t board_map_oprom_vendev(uint32_t vendev
)
67 static int pci_rom_probe(struct udevice
*dev
, struct pci_rom_header
**hdrp
)
69 struct pci_child_platdata
*pplat
= dev_get_parent_platdata(dev
);
70 struct pci_rom_header
*rom_header
;
71 struct pci_rom_data
*rom_data
;
72 u16 rom_vendor
, rom_device
;
78 vendev
= pplat
->vendor
<< 16 | pplat
->device
;
79 mapped_vendev
= board_map_oprom_vendev(vendev
);
80 if (vendev
!= mapped_vendev
)
81 debug("Device ID mapped to %#08x\n", mapped_vendev
);
83 #ifdef CONFIG_VGA_BIOS_ADDR
84 rom_address
= CONFIG_VGA_BIOS_ADDR
;
87 dm_pci_read_config32(dev
, PCI_ROM_ADDRESS
, &rom_address
);
88 if (rom_address
== 0x00000000 || rom_address
== 0xffffffff) {
89 debug("%s: rom_address=%x\n", __func__
, rom_address
);
93 /* Enable expansion ROM address decoding. */
94 dm_pci_write_config32(dev
, PCI_ROM_ADDRESS
,
95 rom_address
| PCI_ROM_ADDRESS_ENABLE
);
97 debug("Option ROM address %x\n", rom_address
);
98 rom_header
= (struct pci_rom_header
*)(unsigned long)rom_address
;
100 debug("PCI expansion ROM, signature %#04x, INIT size %#04x, data ptr %#04x\n",
101 le16_to_cpu(rom_header
->signature
),
102 rom_header
->size
* 512, le16_to_cpu(rom_header
->data
));
104 if (le16_to_cpu(rom_header
->signature
) != PCI_ROM_HDR
) {
105 printf("Incorrect expansion ROM header signature %04x\n",
106 le16_to_cpu(rom_header
->signature
));
107 #ifndef CONFIG_VGA_BIOS_ADDR
108 /* Disable expansion ROM address decoding */
109 dm_pci_write_config32(dev
, PCI_ROM_ADDRESS
, rom_address
);
114 rom_data
= (((void *)rom_header
) + le16_to_cpu(rom_header
->data
));
115 rom_vendor
= le16_to_cpu(rom_data
->vendor
);
116 rom_device
= le16_to_cpu(rom_data
->device
);
118 debug("PCI ROM image, vendor ID %04x, device ID %04x,\n",
119 rom_vendor
, rom_device
);
121 /* If the device id is mapped, a mismatch is expected */
122 if ((pplat
->vendor
!= rom_vendor
|| pplat
->device
!= rom_device
) &&
123 (vendev
== mapped_vendev
)) {
124 printf("ID mismatch: vendor ID %04x, device ID %04x\n",
125 rom_vendor
, rom_device
);
126 /* Continue anyway */
129 rom_class
= (le16_to_cpu(rom_data
->class_hi
) << 8) | rom_data
->class_lo
;
130 debug("PCI ROM image, Class Code %06x, Code Type %02x\n",
131 rom_class
, rom_data
->type
);
133 if (pplat
->class != rom_class
) {
134 debug("Class Code mismatch ROM %06x, dev %06x\n",
135 rom_class
, pplat
->class);
143 * pci_rom_load() - Load a ROM image and return a pointer to it
145 * @rom_header: Pointer to ROM image
146 * @ram_headerp: Returns a pointer to the image in RAM
147 * @allocedp: Returns true if @ram_headerp was allocated and needs
149 * @return 0 if OK, -ve on error. Note that @allocedp is set up regardless of
150 * the error state. Even if this function returns an error, it may have
153 static int pci_rom_load(struct pci_rom_header
*rom_header
,
154 struct pci_rom_header
**ram_headerp
, bool *allocedp
)
156 struct pci_rom_data
*rom_data
;
157 unsigned int rom_size
;
158 unsigned int image_size
= 0;
163 /* Get next image, until we see an x86 version */
164 rom_header
= (struct pci_rom_header
*)((void *)rom_header
+
167 rom_data
= (struct pci_rom_data
*)((void *)rom_header
+
168 le16_to_cpu(rom_header
->data
));
170 image_size
= le16_to_cpu(rom_data
->ilen
) * 512;
171 } while ((rom_data
->type
!= 0) && (rom_data
->indicator
== 0));
173 if (rom_data
->type
!= 0)
176 rom_size
= rom_header
->size
* 512;
178 #ifdef PCI_VGA_RAM_IMAGE_START
179 target
= (void *)PCI_VGA_RAM_IMAGE_START
;
181 target
= (void *)malloc(rom_size
);
186 if (target
!= rom_header
) {
187 ulong start
= get_timer(0);
189 debug("Copying VGA ROM Image from %p to %p, 0x%x bytes\n",
190 rom_header
, target
, rom_size
);
191 memcpy(target
, rom_header
, rom_size
);
192 if (memcmp(target
, rom_header
, rom_size
)) {
193 printf("VGA ROM copy failed\n");
196 debug("Copy took %lums\n", get_timer(start
));
198 *ram_headerp
= target
;
203 struct vbe_mode_info mode_info
;
205 int vbe_get_video_info(struct graphic_device
*gdev
)
207 #ifdef CONFIG_FRAMEBUFFER_SET_VESA_MODE
208 struct vesa_mode_info
*vesa
= &mode_info
.vesa
;
210 gdev
->winSizeX
= vesa
->x_resolution
;
211 gdev
->winSizeY
= vesa
->y_resolution
;
213 gdev
->plnSizeX
= vesa
->x_resolution
;
214 gdev
->plnSizeY
= vesa
->y_resolution
;
216 gdev
->gdfBytesPP
= vesa
->bits_per_pixel
/ 8;
218 switch (vesa
->bits_per_pixel
) {
221 gdev
->gdfIndex
= GDF_32BIT_X888RGB
;
224 gdev
->gdfIndex
= GDF_16BIT_565RGB
;
227 gdev
->gdfIndex
= GDF__8BIT_INDEX
;
231 gdev
->isaBase
= CONFIG_SYS_ISA_IO_BASE_ADDRESS
;
232 gdev
->pciBase
= vesa
->phys_base_ptr
;
234 gdev
->frameAdrs
= vesa
->phys_base_ptr
;
235 gdev
->memSize
= vesa
->bytes_per_scanline
* vesa
->y_resolution
;
237 gdev
->vprBase
= vesa
->phys_base_ptr
;
238 gdev
->cprBase
= vesa
->phys_base_ptr
;
240 return gdev
->winSizeX
? 0 : -ENOSYS
;
246 void setup_video(struct screen_info
*screen_info
)
248 struct vesa_mode_info
*vesa
= &mode_info
.vesa
;
250 /* Sanity test on VESA parameters */
251 if (!vesa
->x_resolution
|| !vesa
->y_resolution
)
254 screen_info
->orig_video_isVGA
= VIDEO_TYPE_VLFB
;
256 screen_info
->lfb_width
= vesa
->x_resolution
;
257 screen_info
->lfb_height
= vesa
->y_resolution
;
258 screen_info
->lfb_depth
= vesa
->bits_per_pixel
;
259 screen_info
->lfb_linelength
= vesa
->bytes_per_scanline
;
260 screen_info
->lfb_base
= vesa
->phys_base_ptr
;
261 screen_info
->lfb_size
=
262 ALIGN(screen_info
->lfb_linelength
* screen_info
->lfb_height
,
264 screen_info
->lfb_size
>>= 16;
265 screen_info
->red_size
= vesa
->red_mask_size
;
266 screen_info
->red_pos
= vesa
->red_mask_pos
;
267 screen_info
->green_size
= vesa
->green_mask_size
;
268 screen_info
->green_pos
= vesa
->green_mask_pos
;
269 screen_info
->blue_size
= vesa
->blue_mask_size
;
270 screen_info
->blue_pos
= vesa
->blue_mask_pos
;
271 screen_info
->rsvd_size
= vesa
->reserved_mask_size
;
272 screen_info
->rsvd_pos
= vesa
->reserved_mask_pos
;
275 int dm_pci_run_vga_bios(struct udevice
*dev
, int (*int15_handler
)(void),
278 struct pci_child_platdata
*pplat
= dev_get_parent_platdata(dev
);
279 struct pci_rom_header
*rom
= NULL
, *ram
= NULL
;
281 bool emulate
, alloced
;
284 /* Only execute VGA ROMs */
285 if (((pplat
->class >> 8) ^ PCI_CLASS_DISPLAY_VGA
) & 0xff00) {
286 debug("%s: Class %#x, should be %#x\n", __func__
, pplat
->class,
287 PCI_CLASS_DISPLAY_VGA
);
291 if (!board_should_load_oprom(dev
))
294 ret
= pci_rom_probe(dev
, &rom
);
298 ret
= pci_rom_load(rom
, &ram
, &alloced
);
302 if (!board_should_run_oprom(dev
)) {
307 #if defined(CONFIG_FRAMEBUFFER_SET_VESA_MODE) && \
308 defined(CONFIG_FRAMEBUFFER_VESA_MODE)
309 vesa_mode
= CONFIG_FRAMEBUFFER_VESA_MODE
;
311 debug("Selected vesa mode %#x\n", vesa_mode
);
313 if (exec_method
& PCI_ROM_USE_NATIVE
) {
317 if (!(exec_method
& PCI_ROM_ALLOW_FALLBACK
)) {
318 printf("BIOS native execution is only available on x86\n");
325 #ifdef CONFIG_BIOSEMU
328 if (!(exec_method
& PCI_ROM_ALLOW_FALLBACK
)) {
329 printf("BIOS emulation not available - see CONFIG_BIOSEMU\n");
338 #ifdef CONFIG_BIOSEMU
341 ret
= biosemu_setup(dev
, &info
);
344 biosemu_set_interrupt_handler(0x15, int15_handler
);
345 ret
= biosemu_run(dev
, (uchar
*)ram
, 1 << 16, info
,
346 true, vesa_mode
, &mode_info
);
351 #if defined(CONFIG_X86) && CONFIG_IS_ENABLED(X86_32BIT_INIT)
352 bios_set_interrupt_handler(0x15, int15_handler
);
354 bios_run_on_x86(dev
, (unsigned long)ram
, vesa_mode
,
358 debug("Final vesa mode %#x\n", mode_info
.video_mode
);
367 #ifdef CONFIG_DM_VIDEO
368 int vbe_setup_video_priv(struct vesa_mode_info
*vesa
,
369 struct video_priv
*uc_priv
,
370 struct video_uc_platdata
*plat
)
372 if (!vesa
->x_resolution
)
374 uc_priv
->xsize
= vesa
->x_resolution
;
375 uc_priv
->ysize
= vesa
->y_resolution
;
376 switch (vesa
->bits_per_pixel
) {
379 uc_priv
->bpix
= VIDEO_BPP32
;
382 uc_priv
->bpix
= VIDEO_BPP16
;
385 return -EPROTONOSUPPORT
;
387 plat
->base
= vesa
->phys_base_ptr
;
388 plat
->size
= vesa
->bytes_per_scanline
* vesa
->y_resolution
;
393 int vbe_setup_video(struct udevice
*dev
, int (*int15_handler
)(void))
395 struct video_uc_platdata
*plat
= dev_get_uclass_platdata(dev
);
396 struct video_priv
*uc_priv
= dev_get_uclass_priv(dev
);
401 /* If we are running from EFI or coreboot, this can't work */
402 if (!ll_boot_init()) {
403 printf("Not available (previous bootloader prevents it)\n");
406 bootstage_start(BOOTSTAGE_ID_ACCUM_LCD
, "vesa display");
407 ret
= dm_pci_run_vga_bios(dev
, int15_handler
, PCI_ROM_USE_NATIVE
|
408 PCI_ROM_ALLOW_FALLBACK
);
409 bootstage_accum(BOOTSTAGE_ID_ACCUM_LCD
);
411 debug("failed to run video BIOS: %d\n", ret
);
415 ret
= vbe_setup_video_priv(&mode_info
.vesa
, uc_priv
, plat
);
417 debug("No video mode configured\n");
421 printf("%dx%dx%d\n", uc_priv
->xsize
, uc_priv
->ysize
,
422 mode_info
.vesa
.bits_per_pixel
);