ca3a74469a
* grub-core/bus/pci.c (grub_pci_iterate): Add hook_data argument, passed to hook. Update all callers to pass appropriate hook data. * grub-core/bus/emu/pci.c (grub_pci_iterate): Likewise. * include/grub/pci.h (grub_pci_iteratefunc_t): Add data argument. Remove NESTED_FUNC_ATTR from here and from all users. (grub_pci_iterate): Update prototype. * grub-core/bus/cs5536.c (grub_cs5536_find: hook): Make static instead of nested. Rename to ... (grub_cs5536_find_iter): ... this. * grub-core/kern/efi/mm.c (stop_broadcom: find_card): Likewise. * grub-core/kern/mips/loongson/init.c (init_pci: set_card): Likewise. * grub-core/kern/vga_init.c (grub_qemu_init_cirrus: find_card): Likewise. * grub-core/video/bochs.c (grub_video_bochs_setup: find_card): Likewise. * grub-core/video/cirrus.c (grub_video_cirrus_setup: find_card): Likewise. * grub-core/video/efi_uga.c (find_framebuf: find_card): Likewise. * grub-core/video/radeon_fuloong2e.c (grub_video_radeon_fuloong2e_setup: find_card): Likewise. * grub-core/video/sis315pro.c (grub_video_sis315pro_setup: find_card): Likewise. * grub-core/video/sm712.c (grub_video_sm712_setup: find_card): Likewise.
114 lines
2.9 KiB
C
114 lines
2.9 KiB
C
/* fixvideo.c - fix video problem in efi */
|
|
/*
|
|
* GRUB -- GRand Unified Bootloader
|
|
* Copyright (C) 2009 Free Software Foundation, Inc.
|
|
*
|
|
* GRUB is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* GRUB is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <grub/dl.h>
|
|
#include <grub/misc.h>
|
|
#include <grub/file.h>
|
|
#include <grub/pci.h>
|
|
#include <grub/command.h>
|
|
#include <grub/i18n.h>
|
|
#include <grub/mm.h>
|
|
|
|
GRUB_MOD_LICENSE ("GPLv3+");
|
|
|
|
static struct grub_video_patch
|
|
{
|
|
const char *name;
|
|
grub_uint32_t pci_id;
|
|
grub_uint32_t mmio_bar;
|
|
grub_uint32_t mmio_reg;
|
|
grub_uint32_t mmio_old;
|
|
} video_patches[] =
|
|
{
|
|
{"Intel 945GM", 0x27a28086, 0, 0x71184, 0x1000000}, /* DSPBBASE */
|
|
{"Intel 965GM", 0x2a028086, 0, 0x7119C, 0x1000000}, /* DSPBSURF */
|
|
{0, 0, 0, 0, 0}
|
|
};
|
|
|
|
static int
|
|
scan_card (grub_pci_device_t dev, grub_pci_id_t pciid,
|
|
void *data __attribute__ ((unused)))
|
|
{
|
|
grub_pci_address_t addr;
|
|
|
|
addr = grub_pci_make_address (dev, GRUB_PCI_REG_CLASS);
|
|
if (grub_pci_read_byte (addr + 3) == 0x3)
|
|
{
|
|
struct grub_video_patch *p = video_patches;
|
|
|
|
while (p->name)
|
|
{
|
|
if (p->pci_id == pciid)
|
|
{
|
|
grub_addr_t base;
|
|
|
|
grub_dprintf ("fixvideo", "Found graphic card: %s\n", p->name);
|
|
addr += 8 + p->mmio_bar * 4;
|
|
base = grub_pci_read (addr);
|
|
if ((! base) || (base & GRUB_PCI_ADDR_SPACE_IO) ||
|
|
(base & GRUB_PCI_ADDR_MEM_PREFETCH))
|
|
grub_dprintf ("fixvideo", "Invalid MMIO bar %d\n", p->mmio_bar);
|
|
else
|
|
{
|
|
base &= GRUB_PCI_ADDR_MEM_MASK;
|
|
base += p->mmio_reg;
|
|
|
|
if (*((volatile grub_uint32_t *) base) != p->mmio_old)
|
|
grub_dprintf ("fixvideo", "Old value doesn't match\n");
|
|
else
|
|
{
|
|
*((volatile grub_uint32_t *) base) = 0;
|
|
if (*((volatile grub_uint32_t *) base))
|
|
grub_dprintf ("fixvideo", "Setting MMIO fails\n");
|
|
}
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
p++;
|
|
}
|
|
|
|
grub_dprintf ("fixvideo", "Unknown graphic card: %x\n", pciid);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static grub_err_t
|
|
grub_cmd_fixvideo (grub_command_t cmd __attribute__ ((unused)),
|
|
int argc __attribute__ ((unused)),
|
|
char *argv[] __attribute__ ((unused)))
|
|
{
|
|
grub_pci_iterate (scan_card, NULL);
|
|
return 0;
|
|
}
|
|
|
|
static grub_command_t cmd_fixvideo;
|
|
|
|
GRUB_MOD_INIT(fixvideo)
|
|
{
|
|
cmd_fixvideo = grub_register_command ("fix_video", grub_cmd_fixvideo,
|
|
0, N_("Fix video problem."));
|
|
|
|
}
|
|
|
|
GRUB_MOD_FINI(fixvideo)
|
|
{
|
|
grub_unregister_command (cmd_fixvideo);
|
|
}
|