summaryrefslogtreecommitdiff
path: root/payloads/libpayload/drivers
diff options
context:
space:
mode:
authorPatrick Georgi <patrick.georgi@secunet.com>2011-11-22 13:07:45 +0100
committerPatrick Georgi <patrick@georgi-clan.de>2011-12-13 23:22:26 +0100
commitdbde80955845177d15bce31943e22546a8ca399b (patch)
tree3e62eab2b62d60491a30a697dc397dc40b76993b /payloads/libpayload/drivers
parenta27561c3c9c465ac336fafe1b6ca24d2aabc95e9 (diff)
downloadcoreboot-dbde80955845177d15bce31943e22546a8ca399b.tar.xz
libpayload: add set_option() function
It allows to change CMOS values from payloads Change-Id: I4872fc27476923adafe13504126235b92b30de85 Signed-off-by: Patrick Georgi <patrick.georgi@secunet.com> Reviewed-on: http://review.coreboot.org/445 Tested-by: build bot (Jenkins) Reviewed-by: Stefan Reinauer <stefan.reinauer@coreboot.org>
Diffstat (limited to 'payloads/libpayload/drivers')
-rw-r--r--payloads/libpayload/drivers/options.c57
1 files changed, 54 insertions, 3 deletions
diff --git a/payloads/libpayload/drivers/options.c b/payloads/libpayload/drivers/options.c
index 394c7920ec..e3f084778c 100644
--- a/payloads/libpayload/drivers/options.c
+++ b/payloads/libpayload/drivers/options.c
@@ -91,7 +91,36 @@ static int get_cmos_value(u32 bitnum, u32 len, void *valptr)
return 0;
}
-int get_option_from(struct cb_cmos_option_table *option_table, void *dest, char *name)
+static int set_cmos_value(u32 bitnum, u32 len, void *valptr)
+{
+ u8 *value = (u8 *)valptr;
+ int offs = 0;
+ u32 addr, bit;
+ u8 reg8;
+
+ /* Convert to byte borders */
+ addr=(bitnum / 8);
+ bit=(bitnum % 8);
+
+ /* Handle single byte or less */
+ if (len <= 8) {
+ reg8 = nvram_read(addr);
+ reg8 &= ~(((1 << len) - 1) << bit);
+ reg8 |= (value[0] & ((1 << len) - 1)) << bit;
+ nvram_write(reg8, addr);
+ return 0;
+ }
+
+ /* When handling more than a byte, copy whole bytes */
+ while (len > 0) {
+ len -= 8;
+ nvram_write(value[offs++], addr++);
+ }
+
+ return 0;
+}
+
+static struct cb_cmos_entries *lookup_cmos_entry(struct cb_cmos_option_table *option_table, char *name)
{
struct cb_cmos_entries *cmos_entry;
int len = strnlen(name, CMOS_MAX_NAME_LENGTH);
@@ -103,6 +132,17 @@ int get_option_from(struct cb_cmos_option_table *option_table, void *dest, char
cmos_entry = (struct cb_cmos_entries*)((unsigned char *)cmos_entry + cmos_entry->size)) {
if (memcmp((const char*)cmos_entry->name, name, len))
continue;
+ return cmos_entry;
+ }
+
+ printf("ERROR: No such CMOS option (%s)\n", name);
+ return NULL;
+}
+
+int get_option_from(struct cb_cmos_option_table *option_table, void *dest, char *name)
+{
+ struct cb_cmos_entries *cmos_entry = lookup_cmos_entry(option_table, name);
+ if (cmos_entry) {
if(get_cmos_value(cmos_entry->bit, cmos_entry->length, dest))
return 1;
@@ -111,8 +151,6 @@ int get_option_from(struct cb_cmos_option_table *option_table, void *dest, char
return 0;
}
-
- printf("ERROR: No such CMOS option (%s)\n", name);
return 1;
}
@@ -121,3 +159,16 @@ int get_option(void *dest, char *name)
struct cb_cmos_option_table *option_table = phys_to_virt(lib_sysinfo.option_table);
return get_option_from(option_table, dest, name);
}
+
+int set_option(void *value, char *name)
+{
+ struct cb_cmos_option_table *option_table = phys_to_virt(lib_sysinfo.option_table);
+ struct cb_cmos_entries *cmos_entry = lookup_cmos_entry(option_table, name);
+ if (cmos_entry) {
+ set_cmos_value(cmos_entry->bit, cmos_entry->length, value);
+ fix_options_checksum();
+ return 0;
+ }
+ return 1;
+}
+