Stefan Reinauer | ea5c2b6 | 2011-10-27 18:42:53 +0200 | [diff] [blame] | 1 | #include <stdint.h> |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 2 | #include <console/console.h> |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 3 | #include <pc80/mc146818rtc.h> |
Stefan Reinauer | ca374d4 | 2008-01-18 16:16:45 +0000 | [diff] [blame] | 4 | #include <boot/coreboot_tables.h> |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 5 | #include <string.h> |
Stefan Reinauer | 10ec0fe | 2010-09-25 10:40:47 +0000 | [diff] [blame] | 6 | #if CONFIG_USE_OPTION_TABLE |
| 7 | #include "option_table.h" |
Patrick Georgi | 2447937 | 2011-01-18 13:56:36 +0000 | [diff] [blame] | 8 | #include <cbfs.h> |
Stefan Reinauer | 10ec0fe | 2010-09-25 10:40:47 +0000 | [diff] [blame] | 9 | #endif |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 10 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 11 | /* control registers - Moto names |
| 12 | */ |
| 13 | #define RTC_REG_A 10 |
| 14 | #define RTC_REG_B 11 |
| 15 | #define RTC_REG_C 12 |
| 16 | #define RTC_REG_D 13 |
| 17 | |
| 18 | |
| 19 | /********************************************************************** |
| 20 | * register details |
| 21 | **********************************************************************/ |
| 22 | #define RTC_FREQ_SELECT RTC_REG_A |
| 23 | |
| 24 | /* update-in-progress - set to "1" 244 microsecs before RTC goes off the bus, |
| 25 | * reset after update (may take 1.984ms @ 32768Hz RefClock) is complete, |
| 26 | * totalling to a max high interval of 2.228 ms. |
| 27 | */ |
| 28 | # define RTC_UIP 0x80 |
| 29 | # define RTC_DIV_CTL 0x70 |
| 30 | /* divider control: refclock values 4.194 / 1.049 MHz / 32.768 kHz */ |
| 31 | # define RTC_REF_CLCK_4MHZ 0x00 |
| 32 | # define RTC_REF_CLCK_1MHZ 0x10 |
| 33 | # define RTC_REF_CLCK_32KHZ 0x20 |
| 34 | /* 2 values for divider stage reset, others for "testing purposes only" */ |
| 35 | # define RTC_DIV_RESET1 0x60 |
| 36 | # define RTC_DIV_RESET2 0x70 |
| 37 | /* Periodic intr. / Square wave rate select. 0=none, 1=32.8kHz,... 15=2Hz */ |
| 38 | # define RTC_RATE_SELECT 0x0F |
| 39 | # define RTC_RATE_NONE 0x00 |
| 40 | # define RTC_RATE_32786HZ 0x01 |
| 41 | # define RTC_RATE_16384HZ 0x02 |
| 42 | # define RTC_RATE_8192HZ 0x03 |
| 43 | # define RTC_RATE_4096HZ 0x04 |
| 44 | # define RTC_RATE_2048HZ 0x05 |
| 45 | # define RTC_RATE_1024HZ 0x06 |
| 46 | # define RTC_RATE_512HZ 0x07 |
| 47 | # define RTC_RATE_256HZ 0x08 |
| 48 | # define RTC_RATE_128HZ 0x09 |
| 49 | # define RTC_RATE_64HZ 0x0a |
| 50 | # define RTC_RATE_32HZ 0x0b |
| 51 | # define RTC_RATE_16HZ 0x0c |
| 52 | # define RTC_RATE_8HZ 0x0d |
| 53 | # define RTC_RATE_4HZ 0x0e |
| 54 | # define RTC_RATE_2HZ 0x0f |
| 55 | |
| 56 | /**********************************************************************/ |
| 57 | #define RTC_CONTROL RTC_REG_B |
| 58 | # define RTC_SET 0x80 /* disable updates for clock setting */ |
| 59 | # define RTC_PIE 0x40 /* periodic interrupt enable */ |
| 60 | # define RTC_AIE 0x20 /* alarm interrupt enable */ |
| 61 | # define RTC_UIE 0x10 /* update-finished interrupt enable */ |
| 62 | # define RTC_SQWE 0x08 /* enable square-wave output */ |
| 63 | # define RTC_DM_BINARY 0x04 /* all time/date values are BCD if clear */ |
| 64 | # define RTC_24H 0x02 /* 24 hour mode - else hours bit 7 means pm */ |
| 65 | # define RTC_DST_EN 0x01 /* auto switch DST - works f. USA only */ |
| 66 | |
| 67 | /**********************************************************************/ |
| 68 | #define RTC_INTR_FLAGS RTC_REG_C |
| 69 | /* caution - cleared by read */ |
| 70 | # define RTC_IRQF 0x80 /* any of the following 3 is active */ |
| 71 | # define RTC_PF 0x40 |
| 72 | # define RTC_AF 0x20 |
| 73 | # define RTC_UF 0x10 |
| 74 | |
| 75 | /**********************************************************************/ |
| 76 | #define RTC_VALID RTC_REG_D |
| 77 | # define RTC_VRT 0x80 /* valid RAM and time */ |
| 78 | /**********************************************************************/ |
| 79 | |
Edwin Beasant | eb50c7d | 2010-07-06 21:05:04 +0000 | [diff] [blame] | 80 | #if CONFIG_USE_OPTION_TABLE |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 81 | static int rtc_checksum_valid(int range_start, int range_end, int cks_loc) |
| 82 | { |
| 83 | int i; |
Stefan Reinauer | ea5c2b6 | 2011-10-27 18:42:53 +0200 | [diff] [blame] | 84 | u16 sum, old_sum; |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 85 | sum = 0; |
| 86 | for(i = range_start; i <= range_end; i++) { |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 87 | sum += cmos_read(i); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 88 | } |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 89 | old_sum = ((cmos_read(cks_loc)<<8) | cmos_read(cks_loc+1))&0x0ffff; |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 90 | return sum == old_sum; |
| 91 | } |
| 92 | |
| 93 | static void rtc_set_checksum(int range_start, int range_end, int cks_loc) |
| 94 | { |
| 95 | int i; |
Stefan Reinauer | ea5c2b6 | 2011-10-27 18:42:53 +0200 | [diff] [blame] | 96 | u16 sum; |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 97 | sum = 0; |
| 98 | for(i = range_start; i <= range_end; i++) { |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 99 | sum += cmos_read(i); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 100 | } |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 101 | cmos_write(((sum >> 8) & 0x0ff), cks_loc); |
| 102 | cmos_write(((sum >> 0) & 0x0ff), cks_loc+1); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 103 | } |
Stefan Reinauer | 2549d52 | 2010-03-17 03:44:45 +0000 | [diff] [blame] | 104 | #endif |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 105 | |
Stefan Reinauer | 2fbbea0 | 2010-01-16 13:27:39 +0000 | [diff] [blame] | 106 | #if CONFIG_ARCH_X86 |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 107 | #define RTC_CONTROL_DEFAULT (RTC_24H) |
| 108 | #define RTC_FREQ_SELECT_DEFAULT (RTC_REF_CLCK_32KHZ | RTC_RATE_1024HZ) |
Stefan Reinauer | 2fbbea0 | 2010-01-16 13:27:39 +0000 | [diff] [blame] | 109 | #else |
| 110 | #if CONFIG_ARCH_ALPHA |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 111 | #define RTC_CONTROL_DEFAULT (RTC_SQWE | RTC_24H) |
| 112 | #define RTC_FREQ_SELECT_DEFAULT (RTC_REF_CLCK_32KHZ | RTC_RATE_1024HZ) |
| 113 | #endif |
Stefan Reinauer | 2fbbea0 | 2010-01-16 13:27:39 +0000 | [diff] [blame] | 114 | #endif |
Li-Ta Lo | 84a8028 | 2005-01-07 02:42:53 +0000 | [diff] [blame] | 115 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 116 | void rtc_init(int invalid) |
| 117 | { |
Edwin Beasant | eb50c7d | 2010-07-06 21:05:04 +0000 | [diff] [blame] | 118 | #if CONFIG_USE_OPTION_TABLE |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 119 | unsigned char x; |
| 120 | int cmos_invalid, checksum_invalid; |
Maciej Pijanka | ea92185 | 2009-10-27 14:29:29 +0000 | [diff] [blame] | 121 | #endif |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 122 | |
Stefan Reinauer | c02b4fc | 2010-03-22 11:42:32 +0000 | [diff] [blame] | 123 | printk(BIOS_DEBUG, "RTC Init\n"); |
Steven J. Magnani | 8cbc475 | 2005-09-12 18:43:27 +0000 | [diff] [blame] | 124 | |
Edwin Beasant | eb50c7d | 2010-07-06 21:05:04 +0000 | [diff] [blame] | 125 | #if CONFIG_USE_OPTION_TABLE |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 126 | /* See if there has been a CMOS power problem. */ |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 127 | x = cmos_read(RTC_VALID); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 128 | cmos_invalid = !(x & RTC_VRT); |
| 129 | |
| 130 | /* See if there is a CMOS checksum error */ |
| 131 | checksum_invalid = !rtc_checksum_valid(PC_CKS_RANGE_START, |
| 132 | PC_CKS_RANGE_END,PC_CKS_LOC); |
| 133 | |
Stefan Reinauer | 1babddb | 2011-10-14 15:22:52 -0700 | [diff] [blame] | 134 | #define CLEAR_CMOS 0 |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 135 | if (invalid || cmos_invalid || checksum_invalid) { |
Stefan Reinauer | 1babddb | 2011-10-14 15:22:52 -0700 | [diff] [blame] | 136 | printk(BIOS_WARNING, "RTC:%s%s%s%s\n", |
Stefan Reinauer | 14e2277 | 2010-04-27 06:56:47 +0000 | [diff] [blame] | 137 | invalid?" Clear requested":"", |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 138 | cmos_invalid?" Power Problem":"", |
Stefan Reinauer | 1babddb | 2011-10-14 15:22:52 -0700 | [diff] [blame] | 139 | checksum_invalid?" Checksum invalid":"", |
| 140 | CLEAR_CMOS?" zeroing cmos":""); |
| 141 | #if CLEAR_CMOS |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 142 | cmos_write(0, 0x01); |
| 143 | cmos_write(0, 0x03); |
| 144 | cmos_write(0, 0x05); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 145 | for(i = 10; i < 48; i++) { |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 146 | cmos_write(0, i); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 147 | } |
Stefan Reinauer | 14e2277 | 2010-04-27 06:56:47 +0000 | [diff] [blame] | 148 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 149 | if (cmos_invalid) { |
| 150 | /* Now setup a default date of Sat 1 January 2000 */ |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 151 | cmos_write(0, 0x00); /* seconds */ |
| 152 | cmos_write(0, 0x02); /* minutes */ |
| 153 | cmos_write(1, 0x04); /* hours */ |
| 154 | cmos_write(7, 0x06); /* day of week */ |
| 155 | cmos_write(1, 0x07); /* day of month */ |
| 156 | cmos_write(1, 0x08); /* month */ |
| 157 | cmos_write(0, 0x09); /* year */ |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 158 | } |
| 159 | #endif |
| 160 | } |
Steven J. Magnani | 8cbc475 | 2005-09-12 18:43:27 +0000 | [diff] [blame] | 161 | #endif |
| 162 | |
| 163 | /* Setup the real time clock */ |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 164 | cmos_write(RTC_CONTROL_DEFAULT, RTC_CONTROL); |
Steven J. Magnani | 8cbc475 | 2005-09-12 18:43:27 +0000 | [diff] [blame] | 165 | /* Setup the frequency it operates at */ |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 166 | cmos_write(RTC_FREQ_SELECT_DEFAULT, RTC_FREQ_SELECT); |
Steven J. Magnani | 8cbc475 | 2005-09-12 18:43:27 +0000 | [diff] [blame] | 167 | |
Edwin Beasant | eb50c7d | 2010-07-06 21:05:04 +0000 | [diff] [blame] | 168 | #if CONFIG_USE_OPTION_TABLE |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 169 | /* See if there is a LB CMOS checksum error */ |
Stefan Reinauer | b5828d7 | 2010-03-29 17:14:28 +0000 | [diff] [blame] | 170 | checksum_invalid = !rtc_checksum_valid(LB_CKS_RANGE_START, |
| 171 | LB_CKS_RANGE_END,LB_CKS_LOC); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 172 | if(checksum_invalid) |
Stefan Reinauer | 1babddb | 2011-10-14 15:22:52 -0700 | [diff] [blame] | 173 | printk(BIOS_DEBUG, "RTC: coreboot checksum invalid\n"); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 174 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 175 | /* Make certain we have a valid checksum */ |
| 176 | rtc_set_checksum(PC_CKS_RANGE_START, |
| 177 | PC_CKS_RANGE_END,PC_CKS_LOC); |
Steven J. Magnani | 8cbc475 | 2005-09-12 18:43:27 +0000 | [diff] [blame] | 178 | #endif |
| 179 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 180 | /* Clear any pending interrupts */ |
Stefan Reinauer | 73d5daa | 2009-04-22 09:03:08 +0000 | [diff] [blame] | 181 | (void) cmos_read(RTC_INTR_FLAGS); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 182 | } |
| 183 | |
| 184 | |
Edwin Beasant | eb50c7d | 2010-07-06 21:05:04 +0000 | [diff] [blame] | 185 | #if CONFIG_USE_OPTION_TABLE |
Luc Verhaegen | a9c5ea0 | 2009-06-03 14:19:33 +0000 | [diff] [blame] | 186 | /* This routine returns the value of the requested bits |
| 187 | input bit = bit count from the beginning of the cmos image |
| 188 | length = number of bits to include in the value |
| 189 | ret = a character pointer to where the value is to be returned |
| 190 | output the value placed in ret |
| 191 | returns 0 = successful, -1 = an error occurred |
| 192 | */ |
| 193 | static int get_cmos_value(unsigned long bit, unsigned long length, void *vret) |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 194 | { |
Luc Verhaegen | a9c5ea0 | 2009-06-03 14:19:33 +0000 | [diff] [blame] | 195 | unsigned char *ret; |
| 196 | unsigned long byte,byte_bit; |
| 197 | unsigned long i; |
| 198 | unsigned char uchar; |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 199 | |
Stefan Reinauer | 14e2277 | 2010-04-27 06:56:47 +0000 | [diff] [blame] | 200 | /* The table is checked when it is built to ensure all |
Luc Verhaegen | a9c5ea0 | 2009-06-03 14:19:33 +0000 | [diff] [blame] | 201 | values are valid. */ |
| 202 | ret = vret; |
| 203 | byte=bit/8; /* find the byte where the data starts */ |
| 204 | byte_bit=bit%8; /* find the bit in the byte where the data starts */ |
| 205 | if(length<9) { /* one byte or less */ |
| 206 | uchar = cmos_read(byte); /* load the byte */ |
| 207 | uchar >>= byte_bit; /* shift the bits to byte align */ |
| 208 | /* clear unspecified bits */ |
| 209 | ret[0] = uchar & ((1 << length) -1); |
Luc Verhaegen | 9ceae90 | 2009-06-03 10:47:19 +0000 | [diff] [blame] | 210 | } |
Luc Verhaegen | a9c5ea0 | 2009-06-03 14:19:33 +0000 | [diff] [blame] | 211 | else { /* more that one byte so transfer the whole bytes */ |
| 212 | for(i=0;length;i++,length-=8,byte++) { |
| 213 | /* load the byte */ |
| 214 | ret[i]=cmos_read(byte); |
| 215 | } |
| 216 | } |
| 217 | return 0; |
Luc Verhaegen | 9ceae90 | 2009-06-03 10:47:19 +0000 | [diff] [blame] | 218 | } |
| 219 | |
Myles Watson | 3fe6b70 | 2009-10-09 20:13:43 +0000 | [diff] [blame] | 220 | int get_option(void *dest, const char *name) |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 221 | { |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 222 | struct cmos_option_table *ct; |
| 223 | struct cmos_entries *ce; |
| 224 | size_t namelen; |
| 225 | int found=0; |
| 226 | |
| 227 | /* Figure out how long name is */ |
| 228 | namelen = strnlen(name, CMOS_MAX_NAME_LENGTH); |
Stefan Reinauer | 14e2277 | 2010-04-27 06:56:47 +0000 | [diff] [blame] | 229 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 230 | /* find the requested entry record */ |
Patrick Georgi | 5ccbbd9 | 2011-01-21 11:43:06 +0000 | [diff] [blame] | 231 | ct=cbfs_find_file("cmos_layout.bin", CBFS_COMPONENT_CMOS_LAYOUT); |
Patrick Georgi | cef3b89 | 2011-01-18 14:28:45 +0000 | [diff] [blame] | 232 | if (!ct) { |
Stefan Reinauer | 1babddb | 2011-10-14 15:22:52 -0700 | [diff] [blame] | 233 | printk(BIOS_ERR, "RTC: cmos_layout.bin could not be found. " |
| 234 | "Options are disabled\n"); |
Patrick Georgi | cef3b89 | 2011-01-18 14:28:45 +0000 | [diff] [blame] | 235 | return(-2); |
| 236 | } |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 237 | ce=(struct cmos_entries*)((unsigned char *)ct + ct->header_length); |
| 238 | for(;ce->tag==LB_TAG_OPTION; |
| 239 | ce=(struct cmos_entries*)((unsigned char *)ce + ce->size)) { |
| 240 | if (memcmp(ce->name, name, namelen) == 0) { |
| 241 | found=1; |
| 242 | break; |
| 243 | } |
| 244 | } |
| 245 | if(!found) { |
Stefan Reinauer | 8e726b7 | 2010-03-29 23:01:35 +0000 | [diff] [blame] | 246 | printk(BIOS_DEBUG, "WARNING: No CMOS option '%s'.\n", name); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 247 | return(-2); |
| 248 | } |
Stefan Reinauer | 14e2277 | 2010-04-27 06:56:47 +0000 | [diff] [blame] | 249 | |
Luc Verhaegen | a9c5ea0 | 2009-06-03 14:19:33 +0000 | [diff] [blame] | 250 | if(get_cmos_value(ce->bit, ce->length, dest)) |
| 251 | return(-3); |
Stefan Reinauer | b5828d7 | 2010-03-29 17:14:28 +0000 | [diff] [blame] | 252 | if(!rtc_checksum_valid(LB_CKS_RANGE_START, |
| 253 | LB_CKS_RANGE_END,LB_CKS_LOC)) |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 254 | return(-4); |
| 255 | return(0); |
| 256 | } |
Sven Schnelle | d29e5bb | 2011-06-06 15:58:54 +0200 | [diff] [blame] | 257 | |
| 258 | static int set_cmos_value(unsigned long bit, unsigned long length, void *vret) |
| 259 | { |
| 260 | unsigned char *ret; |
| 261 | unsigned long byte,byte_bit; |
| 262 | unsigned long i; |
| 263 | unsigned char uchar, mask; |
| 264 | unsigned int chksum_update_needed = 0; |
| 265 | |
| 266 | ret = vret; |
| 267 | byte = bit / 8; /* find the byte where the data starts */ |
| 268 | byte_bit = bit % 8; /* find the bit in the byte where the data starts */ |
| 269 | if(length <= 8) { /* one byte or less */ |
| 270 | mask = (1 << length) - 1; |
| 271 | mask <<= byte_bit; |
| 272 | |
| 273 | uchar = cmos_read(byte); |
| 274 | uchar &= ~mask; |
| 275 | uchar |= (ret[0] << byte_bit); |
| 276 | cmos_write(uchar, byte); |
| 277 | if (byte >= LB_CKS_RANGE_START && byte <= LB_CKS_RANGE_END) |
| 278 | chksum_update_needed = 1; |
| 279 | } else { /* more that one byte so transfer the whole bytes */ |
| 280 | if (byte_bit || length % 8) |
| 281 | return -1; |
| 282 | |
| 283 | for(i=0; length; i++, length-=8, byte++) |
| 284 | cmos_write(ret[i], byte); |
| 285 | if (byte >= LB_CKS_RANGE_START && byte <= LB_CKS_RANGE_END) |
| 286 | chksum_update_needed = 1; |
| 287 | } |
| 288 | |
| 289 | if (chksum_update_needed) { |
| 290 | rtc_set_checksum(LB_CKS_RANGE_START, |
| 291 | LB_CKS_RANGE_END,LB_CKS_LOC); |
| 292 | } |
| 293 | return 0; |
| 294 | } |
| 295 | |
| 296 | |
| 297 | int set_option(const char *name, void *value) |
| 298 | { |
| 299 | struct cmos_option_table *ct; |
| 300 | struct cmos_entries *ce; |
| 301 | unsigned long length; |
| 302 | size_t namelen; |
| 303 | int found=0; |
| 304 | |
| 305 | /* Figure out how long name is */ |
| 306 | namelen = strnlen(name, CMOS_MAX_NAME_LENGTH); |
| 307 | |
| 308 | /* find the requested entry record */ |
| 309 | ct=cbfs_find_file("cmos_layout.bin", CBFS_COMPONENT_CMOS_LAYOUT); |
| 310 | if (!ct) { |
| 311 | printk(BIOS_ERR, "cmos_layout.bin could not be found. Options are disabled\n"); |
| 312 | return(-2); |
| 313 | } |
| 314 | ce=(struct cmos_entries*)((unsigned char *)ct + ct->header_length); |
| 315 | for(;ce->tag==LB_TAG_OPTION; |
| 316 | ce=(struct cmos_entries*)((unsigned char *)ce + ce->size)) { |
| 317 | if (memcmp(ce->name, name, namelen) == 0) { |
| 318 | found=1; |
| 319 | break; |
| 320 | } |
| 321 | } |
| 322 | if(!found) { |
| 323 | printk(BIOS_DEBUG, "WARNING: No CMOS option '%s'.\n", name); |
| 324 | return(-2); |
| 325 | } |
| 326 | |
| 327 | length = ce->length; |
| 328 | if (ce->config == 's') { |
| 329 | length = MAX(strlen((const char *)value) * 8, ce->length - 8); |
| 330 | /* make sure the string is null terminated */ |
| 331 | if ((set_cmos_value(ce->bit + ce->length - 8, 8, &(u8[]){0}))) |
| 332 | return (-3); |
| 333 | } |
| 334 | |
| 335 | if ((set_cmos_value(ce->bit, length, value))) |
| 336 | return (-3); |
| 337 | |
| 338 | return 0; |
| 339 | } |
Stefan Reinauer | 0867062 | 2009-06-30 15:17:49 +0000 | [diff] [blame] | 340 | #endif /* CONFIG_USE_OPTION_TABLE */ |