sravan/system76-coreboot
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Use i2ec to enable camera toggle

Browse Source
This commit is contained in:
Jeremy Soller 2019-09-23 12:58:12 -06:00
parent d99ff72fa9
commit 9d22c72d15
No known key found for this signature in database
GPG Key ID: E988B49EE78A7FB1
1 changed files with 39 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

53
src/mainboard/system76/whl-u/ramstage.c
View File

@ -26,27 +26,52 @@ void mainboard_silicon_init_params(FSP_S_CONFIG *params) {
cnl_configure_pads(gpio_table, ARRAY_SIZE(gpio_table)); cnl_configure_pads(gpio_table, ARRAY_SIZE(gpio_table));
} }
static int ec_cmd(u8 data) { static u8 superio_read(u8 reg) {
int i = 1000000; outb(reg, 0x2E);
while ((inb(0x66) & 2) == 2 && i > 0) { return inb(0x2F);
i -= 1; }
}
if (i == 0) { static void superio_write(u8 reg, u8 value) {
return 1; outb(reg, 0x2E);
} else { outb(value, 0x2F);
outb(data, 0x66); }
return 0;
} static u8 d2_read(u8 reg) {
superio_write(0x2E, reg);
return superio_read(0x2F);
}
static void d2_write(u8 reg, u8 value) {
superio_write(0x2E, reg);
superio_write(0x2F, value);
}
static u8 i2ec_read(u16 addr) {
d2_write(0x11, (u8)(addr >> 8));
d2_write(0x10, (u8)addr);
return d2_read(0x12);
}
static void i2ec_write(u16 addr, u8 value) {
d2_write(0x11, (u8)(addr >> 8));
d2_write(0x10, (u8)addr);
d2_write(0x12, value);
} }
static void mainboard_init(struct device *dev) { static void mainboard_init(struct device *dev) {
printk(BIOS_INFO, "system76: keyboard init\n"); printk(BIOS_INFO, "system76: keyboard init\n");
pc_keyboard_init(NO_AUX_DEVICE); pc_keyboard_init(NO_AUX_DEVICE);
// Rescan for EC devices - fixes camera toggle
printk(BIOS_INFO, "system76: EC init\n"); printk(BIOS_INFO, "system76: EC init\n");
if (ec_cmd(0xA8)) {
printk(BIOS_ERR, "system76: failed to send EC command 0xA8\n"); // Black magic - force enable camera toggle
u16 addr = 0x01CA;
u8 value = i2ec_read(addr);
if ((value & (1 << 2)) == 0) {
printk(BIOS_INFO, "system76: enabling camera toggle\n");
i2ec_write(addr, value | (1 << 2));
} else {
printk(BIOS_INFO, "system76: camera toggle already enabled\n");
} }
} }