This is useful to write qtest about fw_cfg file entry. Signed-off-by: Li Qiang <liq3ea@163.com> Acked-by: Thomas Huth <thuth@redhat.com> Tested-by: Thomas Huth <thuth@redhat.com> Reviewed-by: Philippe Mathieu-Daudé <philmd@redhat.com> Tested-by: Philippe Mathieu-Daudé <philmd@redhat.com> Message-Id: <20190424140643.62457-3-liq3ea@163.com> Signed-off-by: Philippe Mathieu-Daudé <philmd@redhat.com>
165 lines
4 KiB
C
165 lines
4 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 "qemu/osdep.h"
|
|
#include "libqos/fw_cfg.h"
|
|
#include "libqtest.h"
|
|
#include "qemu/bswap.h"
|
|
#include "hw/nvram/fw_cfg.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)
|
|
{
|
|
qtest_writew(fw_cfg->qts, fw_cfg->base, key);
|
|
}
|
|
|
|
/*
|
|
* The caller need check the return value. When the return value is
|
|
* nonzero, it means that some bytes have been transferred.
|
|
*
|
|
* If the fw_cfg file in question is smaller than the allocated & passed-in
|
|
* buffer, then the buffer has been populated only in part.
|
|
*
|
|
* If the fw_cfg file in question is larger than the passed-in
|
|
* buffer, then the return value explains how much room would have been
|
|
* necessary in total. And, while the caller's buffer has been fully
|
|
* populated, it has received only a starting slice of the fw_cfg file.
|
|
*/
|
|
size_t qfw_cfg_get_file(QFWCFG *fw_cfg, const char *filename,
|
|
void *data, size_t buflen)
|
|
{
|
|
uint32_t count;
|
|
uint32_t i;
|
|
unsigned char *filesbuf = NULL;
|
|
size_t dsize;
|
|
FWCfgFile *pdir_entry;
|
|
size_t filesize = 0;
|
|
|
|
qfw_cfg_get(fw_cfg, FW_CFG_FILE_DIR, &count, sizeof(count));
|
|
count = be32_to_cpu(count);
|
|
dsize = sizeof(uint32_t) + count * sizeof(struct fw_cfg_file);
|
|
filesbuf = g_malloc(dsize);
|
|
qfw_cfg_get(fw_cfg, FW_CFG_FILE_DIR, filesbuf, dsize);
|
|
pdir_entry = (FWCfgFile *)(filesbuf + sizeof(uint32_t));
|
|
for (i = 0; i < count; ++i, ++pdir_entry) {
|
|
if (!strcmp(pdir_entry->name, filename)) {
|
|
uint32_t len = be32_to_cpu(pdir_entry->size);
|
|
uint16_t sel = be16_to_cpu(pdir_entry->select);
|
|
filesize = len;
|
|
if (len > buflen) {
|
|
len = buflen;
|
|
}
|
|
qfw_cfg_get(fw_cfg, sel, data, len);
|
|
break;
|
|
}
|
|
}
|
|
g_free(filesbuf);
|
|
return filesize;
|
|
}
|
|
|
|
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] = qtest_readb(fw_cfg->qts, fw_cfg->base + 2);
|
|
}
|
|
}
|
|
|
|
QFWCFG *mm_fw_cfg_init(QTestState *qts, uint64_t base)
|
|
{
|
|
QFWCFG *fw_cfg = g_malloc0(sizeof(*fw_cfg));
|
|
|
|
fw_cfg->base = base;
|
|
fw_cfg->qts = qts;
|
|
fw_cfg->select = mm_fw_cfg_select;
|
|
fw_cfg->read = mm_fw_cfg_read;
|
|
|
|
return fw_cfg;
|
|
}
|
|
|
|
void mm_fw_cfg_uninit(QFWCFG *fw_cfg)
|
|
{
|
|
g_free(fw_cfg);
|
|
}
|
|
|
|
static void io_fw_cfg_select(QFWCFG *fw_cfg, uint16_t key)
|
|
{
|
|
qtest_outw(fw_cfg->qts, 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] = qtest_inb(fw_cfg->qts, fw_cfg->base + 1);
|
|
}
|
|
}
|
|
|
|
QFWCFG *io_fw_cfg_init(QTestState *qts, uint16_t base)
|
|
{
|
|
QFWCFG *fw_cfg = g_malloc0(sizeof(*fw_cfg));
|
|
|
|
fw_cfg->base = base;
|
|
fw_cfg->qts = qts;
|
|
fw_cfg->select = io_fw_cfg_select;
|
|
fw_cfg->read = io_fw_cfg_read;
|
|
|
|
return fw_cfg;
|
|
}
|
|
|
|
void io_fw_cfg_uninit(QFWCFG *fw_cfg)
|
|
{
|
|
g_free(fw_cfg);
|
|
}
|