libpayload: Add function to fix CMOS checksum.
Signed-off-by: Stefan Reinauer <stepan@coresystems.de>
Acked-by: Myles Watson <mylesgw@gmail.com>
git-svn-id: svn://svn.coreboot.org/coreboot/trunk@5711 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
diff --git a/payloads/libpayload/drivers/options.c b/payloads/libpayload/drivers/options.c
index 5117300..1c692f4 100644
--- a/payloads/libpayload/drivers/options.c
+++ b/payloads/libpayload/drivers/options.c
@@ -48,6 +48,23 @@
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;