2 files changed, 60 insertions, 1 deletions

diff --git a/util/nvramtool/cmos_lowlevel.c b/util/nvramtool/cmos_lowlevel.c
index 9f44a0b18a..8e19f515aa 100644
--- a/util/nvramtool/cmos_lowlevel.c
+++ b/util/nvramtool/cmos_lowlevel.c
@@ -37,20 +37,36 @@
 #include "cmos_lowlevel.h"
 
 /* Hardware Abstraction Layer: lowlevel byte-wise write access */
+
 typedef struct {
 	void (*init)(void* data);
 	unsigned char (*read)(unsigned addr);
 	void (*write)(unsigned addr, unsigned char value);
+	void (*set_iopl)(int level);
 } cmos_access_t;
 
 static void cmos_hal_init(void* data);
 static unsigned char cmos_hal_read(unsigned addr);
 static void cmos_hal_write(unsigned addr, unsigned char value);
+static void cmos_set_iopl(int level);
 
 static cmos_access_t cmos_hal = {
 	.init = cmos_hal_init,
 	.read = cmos_hal_read,
-	.write = cmos_hal_write
+	.write = cmos_hal_write,
+	.set_iopl = cmos_set_iopl,
+};
+
+static void mem_hal_init(void* data);
+static unsigned char mem_hal_read(unsigned addr);
+static void mem_hal_write(unsigned addr, unsigned char value);
+static void mem_set_iopl(int level);
+
+static cmos_access_t memory_hal = {
+	.init = mem_hal_init,
+	.read = mem_hal_read,
+	.write = mem_hal_write,
+	.set_iopl = mem_set_iopl,
 };
 
 static cmos_access_t *current_access = &cmos_hal;
@@ -96,6 +112,37 @@ static void cmos_hal_write(unsigned index, unsigned char value)
 	OUTB(value, port_1);
 }
 
+static unsigned char* mem_hal_data = (unsigned char*)-1;
+static void mem_hal_init(void *data)
+{
+	mem_hal_data = data;
+}
+
+static unsigned char mem_hal_read(unsigned index)
+{
+	assert(mem_hal_data != (unsigned char*)-1);
+	return mem_hal_data[index];
+}
+
+static void mem_hal_write(unsigned index, unsigned char value)
+{
+	assert(mem_hal_data != (unsigned char*)-1);
+	mem_hal_data[index] = value;
+}
+
+void select_hal(hal_t hal, void *data)
+{
+	switch(hal) {
+		case HAL_CMOS:
+			current_access = &cmos_hal;
+			break;
+		case HAL_MEMORY:
+			current_access = &memory_hal;
+			break;
+	}
+	current_access->init(data);
+}
+
 /* Bit-level access */
 typedef struct {
 	unsigned byte_index;
@@ -303,6 +350,11 @@ void cmos_write_all(unsigned char data[])
  ****************************************************************************/
 void set_iopl(int level)
 {
+	current_access->set_iopl(level);
+}
+
+static void cmos_set_iopl(int level)
+{
 #if defined(__FreeBSD__)
 	static int io_fd = -1;
 #endif
@@ -333,6 +385,10 @@ void set_iopl(int level)
 #endif
 }
 
+static void mem_set_iopl(__attribute__ ((unused)) int level)
+{
+}
+
 /****************************************************************************
  * verify_cmos_op
  *
diff --git a/util/nvramtool/cmos_lowlevel.h b/util/nvramtool/cmos_lowlevel.h
index ebe82a7a11..3c2efce1e1 100644
--- a/util/nvramtool/cmos_lowlevel.h
+++ b/util/nvramtool/cmos_lowlevel.h
@@ -34,6 +34,9 @@
 #include "common.h"
 #include "layout.h"
 
+typedef enum { HAL_CMOS, HAL_MEMORY } hal_t;
+void select_hal(hal_t hal, void *data);
+
 #define CMOS_AREA_OUT_OF_RANGE (CMOS_RESULT_START + 0)
 #define CMOS_AREA_OVERLAPS_RTC (CMOS_RESULT_START + 1)
 #define CMOS_AREA_TOO_WIDE (CMOS_RESULT_START + 2)