summaryrefslogtreecommitdiff
path: root/src/drivers/intel/gma/vbt.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/drivers/intel/gma/vbt.c')
-rw-r--r--src/drivers/intel/gma/vbt.c83
1 files changed, 40 insertions, 43 deletions
diff --git a/src/drivers/intel/gma/vbt.c b/src/drivers/intel/gma/vbt.c
index 430aa9bc39..0d76afee48 100644
--- a/src/drivers/intel/gma/vbt.c
+++ b/src/drivers/intel/gma/vbt.c
@@ -19,42 +19,41 @@
#include <delay.h>
#include <device/device.h>
#include <string.h>
-#include <device/pci_rom.h>
+#include <device/pci.h>
#include "i915.h"
#include "intel_bios.h"
-static size_t generate_vbt(const struct i915_gpu_controller_info *conf,
- void *vbt, const char *idstr)
+static size_t generate_vbt(const struct i915_gpu_controller_info *const conf,
+ struct vbt_header *const head,
+ const char *const idstr)
{
- struct vbt_header *head = vbt;
- struct bdb_header *bdb_head;
- struct bdb_general_features *genfeat;
u8 *ptr;
memset(head, 0, sizeof (*head));
- memset(head->signature, ' ', sizeof(head->signature));
- memcpy(head->signature, idstr, MIN(strlen(idstr),
- sizeof(head->signature)));
+ memset(head->signature, ' ', sizeof (head->signature));
+ memcpy(head->signature, idstr,
+ MIN(strlen(idstr), sizeof (head->signature)));
head->version = 100;
head->header_size = sizeof (*head);
head->bdb_offset = sizeof (*head);
- bdb_head = (struct bdb_header *) (head + 1);
+ struct bdb_header *const bdb_head = (struct bdb_header *)(head + 1);
memset(bdb_head, 0, sizeof (*bdb_head));
memcpy(bdb_head->signature, "BIOS_DATA_BLOCK ", 16);
bdb_head->version = 0xa8;
bdb_head->header_size = sizeof (*bdb_head);
- ptr = (u8 *) (bdb_head + 1);
+ ptr = (u8 *)(bdb_head + 1);
ptr[0] = BDB_GENERAL_FEATURES;
- ptr[1] = sizeof (*genfeat);
- ptr[2] = sizeof (*genfeat) >> 8;
+ ptr[1] = sizeof (struct bdb_general_features);
+ ptr[2] = sizeof (struct bdb_general_features) >> 8;
ptr += 3;
- genfeat = (struct bdb_general_features *) ptr;
+ struct bdb_general_features *const genfeat =
+ (struct bdb_general_features *)ptr;
memset(genfeat, 0, sizeof (*genfeat));
genfeat->panel_fitting = 3;
genfeat->flexaim = 1;
@@ -75,34 +74,32 @@ static size_t generate_vbt(const struct i915_gpu_controller_info *conf,
}
void
-generate_fake_intel_oprom(const struct i915_gpu_controller_info *conf,
- struct device *dev, const char *idstr)
+generate_fake_intel_oprom(const struct i915_gpu_controller_info *const conf,
+ struct device *const dev, const char *const idstr)
{
- optionrom_header_t *oh = (void *)PCI_VGA_RAM_IMAGE_START;
- optionrom_pcir_t *pcir;
- size_t vbt_size;
- size_t fake_oprom_size;
-
- memset(oh, 0, 8192);
-
- oh->signature = PCI_ROM_HDR;
- oh->pcir_offset = 0x40;
- oh->vbt_offset = 0x80;
-
- pcir = (void *)(PCI_VGA_RAM_IMAGE_START + 0x40);
- pcir->signature = 0x52494350; // PCIR
- pcir->vendor = dev->vendor;
- pcir->device = dev->device;
- pcir->length = sizeof(*pcir);
- pcir->revision = dev->class;
- pcir->classcode[0] = dev->class;
- pcir->classcode[1] = dev->class >> 8;
- pcir->classcode[2] = dev->class >> 16;
- pcir->indicator = 0x80;
-
- vbt_size = generate_vbt (conf, (void *)(PCI_VGA_RAM_IMAGE_START + 0x80), idstr);
- fake_oprom_size = (0x80 + vbt_size + 511) / 512;
- oh->size = fake_oprom_size;
- pcir->imagelength = fake_oprom_size;
-
+ optionrom_header_t *const oh = (void *)PCI_VGA_RAM_IMAGE_START;
+
+ memset(oh, 0, 8192);
+
+ oh->signature = PCI_ROM_HDR;
+ oh->pcir_offset = 0x40;
+ oh->vbt_offset = 0x80;
+
+ optionrom_pcir_t *const pcir = (void *)((u8 *)oh + oh->pcir_offset);
+ pcir->signature = 0x52494350; // PCIR
+ pcir->vendor = dev->vendor;
+ pcir->device = dev->device;
+ pcir->length = sizeof(*pcir);
+ pcir->revision = pci_read_config8(dev, PCI_CLASS_REVISION);
+ pcir->classcode[0] = dev->class;
+ pcir->classcode[1] = dev->class >> 8;
+ pcir->classcode[2] = dev->class >> 16;
+ pcir->indicator = 0x80;
+
+ const size_t vbt_size =
+ generate_vbt(conf, (void *)((u8 *)oh + oh->vbt_offset), idstr);
+ const size_t fake_oprom_size =
+ DIV_ROUND_UP(oh->vbt_offset + vbt_size, 512);
+ oh->size = fake_oprom_size;
+ pcir->imagelength = fake_oprom_size;
}