From 26491a388ce69d80c6d7d2b15ddf93d4399f04bc Mon Sep 17 00:00:00 2001 From: Markus Armbruster Date: Wed, 26 Jun 2013 15:52:22 +0200 Subject: libqos: Generalize I/O-mapped fw_cfg Provide a constructor that takes the base address in addition to the PC-specific one. Signed-off-by: Markus Armbruster Message-id: 1372254743-15808-12-git-send-email-armbru@redhat.com Signed-off-by: Anthony Liguori --- tests/libqos/fw_cfg.c | 26 ++++++++++++++++++++++++++ 1 file changed, 26 insertions(+) (limited to 'tests/libqos/fw_cfg.c') diff --git a/tests/libqos/fw_cfg.c b/tests/libqos/fw_cfg.c index 49d1683..ef00fed 100644 --- a/tests/libqos/fw_cfg.c +++ b/tests/libqos/fw_cfg.c @@ -79,3 +79,29 @@ QFWCFG *mm_fw_cfg_init(uint64_t base) return fw_cfg; } + +static void io_fw_cfg_select(QFWCFG *fw_cfg, uint16_t key) +{ + outw(fw_cfg->base, key); +} + +static void io_fw_cfg_read(QFWCFG *fw_cfg, void *data, size_t len) +{ + uint8_t *ptr = data; + int i; + + for (i = 0; i < len; i++) { + ptr[i] = inb(fw_cfg->base + 1); + } +} + +QFWCFG *io_fw_cfg_init(uint16_t base) +{ + QFWCFG *fw_cfg = g_malloc0(sizeof(*fw_cfg)); + + fw_cfg->base = base; + fw_cfg->select = io_fw_cfg_select; + fw_cfg->read = io_fw_cfg_read; + + return fw_cfg; +} -- cgit v1.1