108 lines
2.2 KiB
C
108 lines
2.2 KiB
C
/*
|
|
* libqos fw_cfg support
|
|
*
|
|
* Copyright IBM, Corp. 2012-2013
|
|
* Copyright (C) 2013 Red Hat Inc.
|
|
*
|
|
* Authors:
|
|
* Anthony Liguori <aliguori@us.ibm.com>
|
|
* Markus Armbruster <armbru@redhat.com>
|
|
*
|
|
* This work is licensed under the terms of the GNU GPL, version 2 or later.
|
|
* See the COPYING file in the top-level directory.
|
|
*/
|
|
|
|
#include <glib.h>
|
|
#include "libqos/fw_cfg.h"
|
|
#include "libqtest.h"
|
|
#include "qemu/bswap.h"
|
|
|
|
void qfw_cfg_select(QFWCFG *fw_cfg, uint16_t key)
|
|
{
|
|
fw_cfg->select(fw_cfg, key);
|
|
}
|
|
|
|
void qfw_cfg_read_data(QFWCFG *fw_cfg, void *data, size_t len)
|
|
{
|
|
fw_cfg->read(fw_cfg, data, len);
|
|
}
|
|
|
|
void qfw_cfg_get(QFWCFG *fw_cfg, uint16_t key, void *data, size_t len)
|
|
{
|
|
qfw_cfg_select(fw_cfg, key);
|
|
qfw_cfg_read_data(fw_cfg, data, len);
|
|
}
|
|
|
|
uint16_t qfw_cfg_get_u16(QFWCFG *fw_cfg, uint16_t key)
|
|
{
|
|
uint16_t value;
|
|
qfw_cfg_get(fw_cfg, key, &value, sizeof(value));
|
|
return le16_to_cpu(value);
|
|
}
|
|
|
|
uint32_t qfw_cfg_get_u32(QFWCFG *fw_cfg, uint16_t key)
|
|
{
|
|
uint32_t value;
|
|
qfw_cfg_get(fw_cfg, key, &value, sizeof(value));
|
|
return le32_to_cpu(value);
|
|
}
|
|
|
|
uint64_t qfw_cfg_get_u64(QFWCFG *fw_cfg, uint16_t key)
|
|
{
|
|
uint64_t value;
|
|
qfw_cfg_get(fw_cfg, key, &value, sizeof(value));
|
|
return le64_to_cpu(value);
|
|
}
|
|
|
|
static void mm_fw_cfg_select(QFWCFG *fw_cfg, uint16_t key)
|
|
{
|
|
writew(fw_cfg->base, key);
|
|
}
|
|
|
|
static void mm_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] = readb(fw_cfg->base + 2);
|
|
}
|
|
}
|
|
|
|
QFWCFG *mm_fw_cfg_init(uint64_t base)
|
|
{
|
|
QFWCFG *fw_cfg = g_malloc0(sizeof(*fw_cfg));
|
|
|
|
fw_cfg->base = base;
|
|
fw_cfg->select = mm_fw_cfg_select;
|
|
fw_cfg->read = mm_fw_cfg_read;
|
|
|
|
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;
|
|
}
|