Fix checksum calculation both in romstage and ramstage.

[coreboot.git] / src / pc80 / mc146818rtc_early.c

diff --git a/src/pc80/mc146818rtc_early.c b/src/pc80/mc146818rtc_early.c
index 87fc3f0a61b7d6d8e9678f27ac6b9f6a8506a9d0..0652f27c47ff5967eb4a270e8fc37de4b2775b22 100644 (file)
--- a/src/pc80/mc146818rtc_early.c
+++ b/src/pc80/mc146818rtc_early.c
@@ -1,7 +1,8 @@
+#include <stdint.h>
 #include <pc80/mc146818rtc.h>
 #include <fallback.h>
-#if CONFIG_HAVE_OPTION_TABLE
-#include <option_table.h>
+#if CONFIG_USE_OPTION_TABLE
+#include "option_table.h"
 #endif
 
 #ifndef CONFIG_MAX_REBOOT_CNT
@@ -11,28 +12,6 @@
 #error "CONFIG_MAX_REBOOT_CNT too high"
 #endif
 
-static unsigned char cmos_read(unsigned char addr)
-{
-       int offs = 0;
-       if (addr >= 128) {
-               offs = 2;
-               addr -= 128;
-       }
-       outb(addr, RTC_BASE_PORT + offs + 0);
-       return inb(RTC_BASE_PORT + offs + 1);
-}
-
-static void cmos_write(unsigned char val, unsigned char addr)
-{
-       int offs = 0;
-       if (addr >= 128) {
-               offs = 2;
-               addr -= 128;
-       }
-       outb(addr, RTC_BASE_PORT + offs + 0);
-       outb(val, RTC_BASE_PORT + offs + 1);
-}
-
 static int cmos_error(void)
 {
        unsigned char reg_d;
@@ -43,15 +22,14 @@ static int cmos_error(void)
 
 static int cmos_chksum_valid(void)
 {
-#if CONFIG_HAVE_OPTION_TABLE == 1
+#if CONFIG_USE_OPTION_TABLE
        unsigned char addr;
-       unsigned long sum, old_sum;
+       u16 sum, old_sum;
        sum = 0;
-       /* Comput the cmos checksum */
+       /* Compute the cmos checksum */
        for(addr = LB_CKS_RANGE_START; addr <= LB_CKS_RANGE_END; addr++) {
                sum += cmos_read(addr);
        }
-       sum = (sum & 0xffff) ^ 0xffff;
 
        /* Read the stored checksum */
        old_sum = cmos_read(LB_CKS_LOC) << 8;
@@ -88,7 +66,7 @@ static inline int do_normal_boot(void)
 
        /* The RTC_BOOT_BYTE is now o.k. see where to go. */
        byte = cmos_read(RTC_BOOT_BYTE);
-       
+
        /* Are we in normal mode? */
        if (byte & 1) {
                byte &= 0x0f; /* yes, clear the boot count */
@@ -114,9 +92,9 @@ static inline int do_normal_boot(void)
        return (byte & (1<<1));
 }
 
-static inline unsigned read_option(unsigned start, unsigned size, unsigned def)
+unsigned read_option_lowlevel(unsigned start, unsigned size, unsigned def)
 {
-#if CONFIG_USE_OPTION_TABLE == 1
+#if CONFIG_USE_OPTION_TABLE
        unsigned byte;
        byte = cmos_read(start/8);
        return (byte >> (start & 7U)) & ((1U << size) - 1U);