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>
34 #include <linux/screen_info.h>
36 __weak
bool board_should_run_oprom(pci_dev_t dev
)
41 static bool should_load_oprom(pci_dev_t dev
)
43 if (IS_ENABLED(CONFIG_ALWAYS_LOAD_OPROM
))
45 if (board_should_run_oprom(dev
))
51 __weak
uint32_t board_map_oprom_vendev(uint32_t vendev
)
56 static int pci_rom_probe(pci_dev_t dev
, uint
class,
57 struct pci_rom_header
**hdrp
)
59 struct pci_rom_header
*rom_header
;
60 struct pci_rom_data
*rom_data
;
62 u16 rom_vendor
, rom_device
;
68 pci_read_config_word(dev
, PCI_VENDOR_ID
, &vendor
);
69 pci_read_config_word(dev
, PCI_DEVICE_ID
, &device
);
70 vendev
= vendor
<< 16 | device
;
71 mapped_vendev
= board_map_oprom_vendev(vendev
);
72 if (vendev
!= mapped_vendev
)
73 debug("Device ID mapped to %#08x\n", mapped_vendev
);
75 #ifdef CONFIG_VGA_BIOS_ADDR
76 rom_address
= CONFIG_VGA_BIOS_ADDR
;
79 pci_read_config_dword(dev
, PCI_ROM_ADDRESS
, &rom_address
);
80 if (rom_address
== 0x00000000 || rom_address
== 0xffffffff) {
81 debug("%s: rom_address=%x\n", __func__
, rom_address
);
85 /* Enable expansion ROM address decoding. */
86 pci_write_config_dword(dev
, PCI_ROM_ADDRESS
,
87 rom_address
| PCI_ROM_ADDRESS_ENABLE
);
89 debug("Option ROM address %x\n", rom_address
);
90 rom_header
= (struct pci_rom_header
*)(unsigned long)rom_address
;
92 debug("PCI expansion ROM, signature %#04x, INIT size %#04x, data ptr %#04x\n",
93 le16_to_cpu(rom_header
->signature
),
94 rom_header
->size
* 512, le16_to_cpu(rom_header
->data
));
96 if (le16_to_cpu(rom_header
->signature
) != PCI_ROM_HDR
) {
97 printf("Incorrect expansion ROM header signature %04x\n",
98 le16_to_cpu(rom_header
->signature
));
99 #ifndef CONFIG_VGA_BIOS_ADDR
100 /* Disable expansion ROM address decoding */
101 pci_write_config_dword(dev
, PCI_ROM_ADDRESS
, rom_address
);
106 rom_data
= (((void *)rom_header
) + le16_to_cpu(rom_header
->data
));
107 rom_vendor
= le16_to_cpu(rom_data
->vendor
);
108 rom_device
= le16_to_cpu(rom_data
->device
);
110 debug("PCI ROM image, vendor ID %04x, device ID %04x,\n",
111 rom_vendor
, rom_device
);
113 /* If the device id is mapped, a mismatch is expected */
114 if ((vendor
!= rom_vendor
|| device
!= rom_device
) &&
115 (vendev
== mapped_vendev
)) {
116 printf("ID mismatch: vendor ID %04x, device ID %04x\n",
117 rom_vendor
, rom_device
);
118 /* Continue anyway */
121 rom_class
= (le16_to_cpu(rom_data
->class_hi
) << 8) | rom_data
->class_lo
;
122 debug("PCI ROM image, Class Code %06x, Code Type %02x\n",
123 rom_class
, rom_data
->type
);
125 if (class != rom_class
) {
126 debug("Class Code mismatch ROM %06x, dev %06x\n",
134 int pci_rom_load(struct pci_rom_header
*rom_header
,
135 struct pci_rom_header
**ram_headerp
)
137 struct pci_rom_data
*rom_data
;
138 unsigned int rom_size
;
139 unsigned int image_size
= 0;
143 /* Get next image, until we see an x86 version */
144 rom_header
= (struct pci_rom_header
*)((void *)rom_header
+
147 rom_data
= (struct pci_rom_data
*)((void *)rom_header
+
148 le16_to_cpu(rom_header
->data
));
150 image_size
= le16_to_cpu(rom_data
->ilen
) * 512;
151 } while ((rom_data
->type
!= 0) && (rom_data
->indicator
== 0));
153 if (rom_data
->type
!= 0)
156 rom_size
= rom_header
->size
* 512;
158 #ifdef PCI_VGA_RAM_IMAGE_START
159 target
= (void *)PCI_VGA_RAM_IMAGE_START
;
161 target
= (void *)malloc(rom_size
);
165 if (target
!= rom_header
) {
166 ulong start
= get_timer(0);
168 debug("Copying VGA ROM Image from %p to %p, 0x%x bytes\n",
169 rom_header
, target
, rom_size
);
170 memcpy(target
, rom_header
, rom_size
);
171 if (memcmp(target
, rom_header
, rom_size
)) {
172 printf("VGA ROM copy failed\n");
175 debug("Copy took %lums\n", get_timer(start
));
177 *ram_headerp
= target
;
182 struct vbe_mode_info mode_info
;
184 int vbe_get_video_info(struct graphic_device
*gdev
)
186 #ifdef CONFIG_FRAMEBUFFER_SET_VESA_MODE
187 struct vesa_mode_info
*vesa
= &mode_info
.vesa
;
189 gdev
->winSizeX
= vesa
->x_resolution
;
190 gdev
->winSizeY
= vesa
->y_resolution
;
192 gdev
->plnSizeX
= vesa
->x_resolution
;
193 gdev
->plnSizeY
= vesa
->y_resolution
;
195 gdev
->gdfBytesPP
= vesa
->bits_per_pixel
/ 8;
197 switch (vesa
->bits_per_pixel
) {
200 gdev
->gdfIndex
= GDF_32BIT_X888RGB
;
203 gdev
->gdfIndex
= GDF_16BIT_565RGB
;
206 gdev
->gdfIndex
= GDF__8BIT_INDEX
;
210 gdev
->isaBase
= CONFIG_SYS_ISA_IO_BASE_ADDRESS
;
211 gdev
->pciBase
= vesa
->phys_base_ptr
;
213 gdev
->frameAdrs
= vesa
->phys_base_ptr
;
214 gdev
->memSize
= vesa
->bytes_per_scanline
* vesa
->y_resolution
;
216 gdev
->vprBase
= vesa
->phys_base_ptr
;
217 gdev
->cprBase
= vesa
->phys_base_ptr
;
219 return gdev
->winSizeX
? 0 : -ENOSYS
;
225 void setup_video(struct screen_info
*screen_info
)
227 struct vesa_mode_info
*vesa
= &mode_info
.vesa
;
229 /* Sanity test on VESA parameters */
230 if (!vesa
->x_resolution
|| !vesa
->y_resolution
)
233 screen_info
->orig_video_isVGA
= VIDEO_TYPE_VLFB
;
235 screen_info
->lfb_width
= vesa
->x_resolution
;
236 screen_info
->lfb_height
= vesa
->y_resolution
;
237 screen_info
->lfb_depth
= vesa
->bits_per_pixel
;
238 screen_info
->lfb_linelength
= vesa
->bytes_per_scanline
;
239 screen_info
->lfb_base
= vesa
->phys_base_ptr
;
240 screen_info
->lfb_size
=
241 ALIGN(screen_info
->lfb_linelength
* screen_info
->lfb_height
,
243 screen_info
->lfb_size
>>= 16;
244 screen_info
->red_size
= vesa
->red_mask_size
;
245 screen_info
->red_pos
= vesa
->red_mask_pos
;
246 screen_info
->green_size
= vesa
->green_mask_size
;
247 screen_info
->green_pos
= vesa
->green_mask_pos
;
248 screen_info
->blue_size
= vesa
->blue_mask_size
;
249 screen_info
->blue_pos
= vesa
->blue_mask_pos
;
250 screen_info
->rsvd_size
= vesa
->reserved_mask_size
;
251 screen_info
->rsvd_pos
= vesa
->reserved_mask_pos
;
254 int pci_run_vga_bios(pci_dev_t dev
, int (*int15_handler
)(void), int exec_method
)
256 struct pci_rom_header
*rom
, *ram
;
262 /* Only execute VGA ROMs */
263 pci_read_config_dword(dev
, PCI_REVISION_ID
, &class);
264 if (((class >> 16) ^ PCI_CLASS_DISPLAY_VGA
) & 0xff00) {
265 debug("%s: Class %#x, should be %#x\n", __func__
, class,
266 PCI_CLASS_DISPLAY_VGA
);
271 if (!should_load_oprom(dev
))
274 ret
= pci_rom_probe(dev
, class, &rom
);
278 ret
= pci_rom_load(rom
, &ram
);
282 if (!board_should_run_oprom(dev
))
285 #if defined(CONFIG_FRAMEBUFFER_SET_VESA_MODE) && \
286 defined(CONFIG_FRAMEBUFFER_VESA_MODE)
287 vesa_mode
= CONFIG_FRAMEBUFFER_VESA_MODE
;
289 debug("Selected vesa mode %#x\n", vesa_mode
);
291 if (exec_method
& PCI_ROM_USE_NATIVE
) {
295 if (!(exec_method
& PCI_ROM_ALLOW_FALLBACK
)) {
296 printf("BIOS native execution is only available on x86\n");
302 #ifdef CONFIG_BIOSEMU
305 if (!(exec_method
& PCI_ROM_ALLOW_FALLBACK
)) {
306 printf("BIOS emulation not available - see CONFIG_BIOSEMU\n");
314 #ifdef CONFIG_BIOSEMU
317 ret
= biosemu_setup(dev
, &info
);
320 biosemu_set_interrupt_handler(0x15, int15_handler
);
321 ret
= biosemu_run(dev
, (uchar
*)ram
, 1 << 16, info
, true,
322 vesa_mode
, &mode_info
);
328 bios_set_interrupt_handler(0x15, int15_handler
);
330 bios_run_on_x86(dev
, (unsigned long)ram
, vesa_mode
,
334 debug("Final vesa mode %#x\n", mode_info
.video_mode
);