mirror of
https://gitlab.com/qemu-project/qemu
synced 2024-11-05 20:35:44 +00:00
libqtest: Prepare I2C libqos
This adds a simple I2C API and a driver implementation for omap_i2c. Signed-off-by: Andreas Färber <andreas.faerber@web.de> Reviewed-by: Anthony Liguori <aliguori@us.ibm.com> Signed-off-by: Anthony Liguori <aliguori@us.ibm.com>
This commit is contained in:
parent
457b654327
commit
2bf7b4572b
4 changed files with 219 additions and 0 deletions
|
@ -116,6 +116,7 @@ QTEST_TARGETS=$(foreach TARGET,$(TARGETS), $(if $(check-qtest-$(TARGET)-y), $(TA
|
|||
check-qtest-$(CONFIG_POSIX)=$(foreach TARGET,$(TARGETS), $(check-qtest-$(TARGET)-y))
|
||||
|
||||
qtest-obj-y = tests/libqtest.o libqemuutil.a libqemustub.a
|
||||
qtest-obj-y += tests/libi2c.o tests/libi2c-omap.o
|
||||
$(check-qtest-y): $(qtest-obj-y)
|
||||
|
||||
.PHONY: check-help
|
||||
|
|
166
tests/libi2c-omap.c
Normal file
166
tests/libi2c-omap.c
Normal file
|
@ -0,0 +1,166 @@
|
|||
/*
|
||||
* QTest I2C driver
|
||||
*
|
||||
* Copyright (c) 2012 Andreas Färber
|
||||
*
|
||||
* 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 "libi2c.h"
|
||||
|
||||
#include <glib.h>
|
||||
#include <string.h>
|
||||
|
||||
#include "qemu/osdep.h"
|
||||
#include "libqtest.h"
|
||||
|
||||
enum OMAPI2CRegisters {
|
||||
OMAP_I2C_REV = 0x00,
|
||||
OMAP_I2C_STAT = 0x08,
|
||||
OMAP_I2C_CNT = 0x18,
|
||||
OMAP_I2C_DATA = 0x1c,
|
||||
OMAP_I2C_CON = 0x24,
|
||||
OMAP_I2C_SA = 0x2c,
|
||||
};
|
||||
|
||||
enum OMAPI2CSTATBits {
|
||||
OMAP_I2C_STAT_NACK = 1 << 1,
|
||||
OMAP_I2C_STAT_ARDY = 1 << 2,
|
||||
OMAP_I2C_STAT_RRDY = 1 << 3,
|
||||
OMAP_I2C_STAT_XRDY = 1 << 4,
|
||||
OMAP_I2C_STAT_ROVR = 1 << 11,
|
||||
OMAP_I2C_STAT_SBD = 1 << 15,
|
||||
};
|
||||
|
||||
enum OMAPI2CCONBits {
|
||||
OMAP_I2C_CON_STT = 1 << 0,
|
||||
OMAP_I2C_CON_STP = 1 << 1,
|
||||
OMAP_I2C_CON_TRX = 1 << 9,
|
||||
OMAP_I2C_CON_MST = 1 << 10,
|
||||
OMAP_I2C_CON_BE = 1 << 14,
|
||||
OMAP_I2C_CON_I2C_EN = 1 << 15,
|
||||
};
|
||||
|
||||
typedef struct OMAPI2C {
|
||||
I2CAdapter parent;
|
||||
|
||||
uint64_t addr;
|
||||
} OMAPI2C;
|
||||
|
||||
|
||||
static void omap_i2c_set_slave_addr(OMAPI2C *s, uint8_t addr)
|
||||
{
|
||||
uint16_t data = addr;
|
||||
|
||||
memwrite(s->addr + OMAP_I2C_SA, &data, 2);
|
||||
memread(s->addr + OMAP_I2C_SA, &data, 2);
|
||||
g_assert_cmphex(data, ==, addr);
|
||||
}
|
||||
|
||||
static void omap_i2c_send(I2CAdapter *i2c, uint8_t addr,
|
||||
const uint8_t *buf, uint16_t len)
|
||||
{
|
||||
OMAPI2C *s = (OMAPI2C *)i2c;
|
||||
uint16_t data;
|
||||
|
||||
omap_i2c_set_slave_addr(s, addr);
|
||||
|
||||
data = len;
|
||||
memwrite(s->addr + OMAP_I2C_CNT, &data, 2);
|
||||
|
||||
data = OMAP_I2C_CON_I2C_EN |
|
||||
OMAP_I2C_CON_TRX |
|
||||
OMAP_I2C_CON_MST |
|
||||
OMAP_I2C_CON_STT |
|
||||
OMAP_I2C_CON_STP;
|
||||
memwrite(s->addr + OMAP_I2C_CON, &data, 2);
|
||||
memread(s->addr + OMAP_I2C_CON, &data, 2);
|
||||
g_assert((data & OMAP_I2C_CON_STP) != 0);
|
||||
|
||||
memread(s->addr + OMAP_I2C_STAT, &data, 2);
|
||||
g_assert((data & OMAP_I2C_STAT_NACK) == 0);
|
||||
|
||||
while (len > 1) {
|
||||
memread(s->addr + OMAP_I2C_STAT, &data, 2);
|
||||
g_assert((data & OMAP_I2C_STAT_XRDY) != 0);
|
||||
|
||||
memwrite(s->addr + OMAP_I2C_DATA, buf, 2);
|
||||
buf = (uint8_t *)buf + 2;
|
||||
len -= 2;
|
||||
}
|
||||
if (len == 1) {
|
||||
memread(s->addr + OMAP_I2C_STAT, &data, 2);
|
||||
g_assert((data & OMAP_I2C_STAT_XRDY) != 0);
|
||||
|
||||
memwrite(s->addr + OMAP_I2C_DATA, buf, 1);
|
||||
}
|
||||
|
||||
memread(s->addr + OMAP_I2C_CON, &data, 2);
|
||||
g_assert((data & OMAP_I2C_CON_STP) == 0);
|
||||
}
|
||||
|
||||
static void omap_i2c_recv(I2CAdapter *i2c, uint8_t addr,
|
||||
uint8_t *buf, uint16_t len)
|
||||
{
|
||||
OMAPI2C *s = (OMAPI2C *)i2c;
|
||||
uint16_t data, stat;
|
||||
|
||||
omap_i2c_set_slave_addr(s, addr);
|
||||
|
||||
data = len;
|
||||
memwrite(s->addr + OMAP_I2C_CNT, &data, 2);
|
||||
|
||||
data = OMAP_I2C_CON_I2C_EN |
|
||||
OMAP_I2C_CON_MST |
|
||||
OMAP_I2C_CON_STT |
|
||||
OMAP_I2C_CON_STP;
|
||||
memwrite(s->addr + OMAP_I2C_CON, &data, 2);
|
||||
memread(s->addr + OMAP_I2C_CON, &data, 2);
|
||||
g_assert((data & OMAP_I2C_CON_STP) == 0);
|
||||
|
||||
memread(s->addr + OMAP_I2C_STAT, &data, 2);
|
||||
g_assert((data & OMAP_I2C_STAT_NACK) == 0);
|
||||
|
||||
memread(s->addr + OMAP_I2C_CNT, &data, 2);
|
||||
g_assert_cmpuint(data, ==, len);
|
||||
|
||||
while (len > 0) {
|
||||
memread(s->addr + OMAP_I2C_STAT, &data, 2);
|
||||
g_assert((data & OMAP_I2C_STAT_RRDY) != 0);
|
||||
g_assert((data & OMAP_I2C_STAT_ROVR) == 0);
|
||||
|
||||
memread(s->addr + OMAP_I2C_DATA, &data, 2);
|
||||
|
||||
memread(s->addr + OMAP_I2C_STAT, &stat, 2);
|
||||
if (unlikely(len == 1)) {
|
||||
*buf = data & 0xf;
|
||||
buf++;
|
||||
len--;
|
||||
} else {
|
||||
memcpy(buf, &data, 2);
|
||||
buf += 2;
|
||||
len -= 2;
|
||||
}
|
||||
}
|
||||
|
||||
memread(s->addr + OMAP_I2C_CON, &data, 2);
|
||||
g_assert((data & OMAP_I2C_CON_STP) == 0);
|
||||
}
|
||||
|
||||
I2CAdapter *omap_i2c_create(uint64_t addr)
|
||||
{
|
||||
OMAPI2C *s = g_malloc0(sizeof(*s));
|
||||
I2CAdapter *i2c = (I2CAdapter *)s;
|
||||
uint16_t data;
|
||||
|
||||
s->addr = addr;
|
||||
|
||||
i2c->send = omap_i2c_send;
|
||||
i2c->recv = omap_i2c_recv;
|
||||
|
||||
/* verify the mmio address by looking for a known signature */
|
||||
memread(addr + OMAP_I2C_REV, &data, 2);
|
||||
g_assert_cmphex(data, ==, 0x34);
|
||||
|
||||
return i2c;
|
||||
}
|
22
tests/libi2c.c
Normal file
22
tests/libi2c.c
Normal file
|
@ -0,0 +1,22 @@
|
|||
/*
|
||||
* QTest I2C driver
|
||||
*
|
||||
* Copyright (c) 2012 Andreas Färber
|
||||
*
|
||||
* 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 "libi2c.h"
|
||||
#include "libqtest.h"
|
||||
|
||||
void i2c_send(I2CAdapter *i2c, uint8_t addr,
|
||||
const uint8_t *buf, uint16_t len)
|
||||
{
|
||||
i2c->send(i2c, addr, buf, len);
|
||||
}
|
||||
|
||||
void i2c_recv(I2CAdapter *i2c, uint8_t addr,
|
||||
uint8_t *buf, uint16_t len)
|
||||
{
|
||||
i2c->recv(i2c, addr, buf, len);
|
||||
}
|
30
tests/libi2c.h
Normal file
30
tests/libi2c.h
Normal file
|
@ -0,0 +1,30 @@
|
|||
/*
|
||||
* I2C libqos
|
||||
*
|
||||
* Copyright (c) 2012 Andreas Färber
|
||||
*
|
||||
* This work is licensed under the terms of the GNU GPL, version 2 or later.
|
||||
* See the COPYING file in the top-level directory.
|
||||
*/
|
||||
#ifndef LIBQOS_I2C_H
|
||||
#define LIBQOS_I2C_H
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
typedef struct I2CAdapter I2CAdapter;
|
||||
struct I2CAdapter {
|
||||
void (*send)(I2CAdapter *adapter, uint8_t addr,
|
||||
const uint8_t *buf, uint16_t len);
|
||||
void (*recv)(I2CAdapter *adapter, uint8_t addr,
|
||||
uint8_t *buf, uint16_t len);
|
||||
};
|
||||
|
||||
void i2c_send(I2CAdapter *i2c, uint8_t addr,
|
||||
const uint8_t *buf, uint16_t len);
|
||||
void i2c_recv(I2CAdapter *i2c, uint8_t addr,
|
||||
uint8_t *buf, uint16_t len);
|
||||
|
||||
/* libi2c-omap.c */
|
||||
I2CAdapter *omap_i2c_create(uint64_t addr);
|
||||
|
||||
#endif
|
Loading…
Reference in a new issue