diff --git a/payloads/libpayload/drivers/options.c b/payloads/libpayload/drivers/options.c index 5117300427..1c692f46e0 100644 --- a/payloads/libpayload/drivers/options.c +++ b/payloads/libpayload/drivers/options.c @@ -48,6 +48,23 @@ static int options_checksum_valid(void) return (checksum_old == checksum); } +void fix_options_checksum(void) +{ + int i; + int range_start = lib_sysinfo.cmos_range_start / 8; + int range_end = lib_sysinfo.cmos_range_end / 8; + int checksum_location = lib_sysinfo.cmos_checksum_location / 8; + u16 checksum = 0; + + for(i = range_start; i <= range_end; i++) { + checksum += nvram_read(i); + } + checksum = (~checksum)&0xffff; + + nvram_write((checksum >> 8), checksum_location); + nvram_write((checksum & 0xff), checksum_location + 1); +} + static int get_cmos_value(u32 bitnum, u32 len, void *valptr) { u8 *value = (u8 *)valptr; diff --git a/payloads/libpayload/include/libpayload.h b/payloads/libpayload/include/libpayload.h index f3da228933..43e138fd7d 100644 --- a/payloads/libpayload/include/libpayload.h +++ b/payloads/libpayload/include/libpayload.h @@ -194,6 +194,7 @@ void video_console_set_cursor(unsigned int cursorx, unsigned int cursory); /** @} */ /* drivers/option.c */ +void fix_options_checksum(void); int get_option(void *dest, char *name); /**