![Gerd Hoffmann](/assets/img/avatar_default.png)
Sorry folks, but it has to be. One more of these invasive qdev patches. We have a serious design bug in the qdev interface: device init callbacks can't signal failure because the init() callback has no return value. This patch fixes it. We have already one case in-tree where this is needed: Try -device virtio-blk-pci (without drive= specified) and watch qemu segfault. This patch fixes it. With usb+scsi being converted to qdev we'll get more devices where the init callback can fail for various reasons. Signed-off-by: Gerd Hoffmann <kraxel@redhat.com> Signed-off-by: Anthony Liguori <aliguori@us.ibm.com>
188 lines
4 KiB
C
188 lines
4 KiB
C
/*
|
|
* Maxim MAX1110/1111 ADC chip emulation.
|
|
*
|
|
* Copyright (c) 2006 Openedhand Ltd.
|
|
* Written by Andrzej Zaborowski <balrog@zabor.org>
|
|
*
|
|
* This code is licensed under the GNU GPLv2.
|
|
*/
|
|
|
|
#include "ssi.h"
|
|
|
|
typedef struct {
|
|
SSISlave ssidev;
|
|
qemu_irq interrupt;
|
|
uint8_t tb1, rb2, rb3;
|
|
int cycle;
|
|
|
|
int input[8];
|
|
int inputs, com;
|
|
} MAX111xState;
|
|
|
|
/* Control-byte bitfields */
|
|
#define CB_PD0 (1 << 0)
|
|
#define CB_PD1 (1 << 1)
|
|
#define CB_SGL (1 << 2)
|
|
#define CB_UNI (1 << 3)
|
|
#define CB_SEL0 (1 << 4)
|
|
#define CB_SEL1 (1 << 5)
|
|
#define CB_SEL2 (1 << 6)
|
|
#define CB_START (1 << 7)
|
|
|
|
#define CHANNEL_NUM(v, b0, b1, b2) \
|
|
((((v) >> (2 + (b0))) & 4) | \
|
|
(((v) >> (3 + (b1))) & 2) | \
|
|
(((v) >> (4 + (b2))) & 1))
|
|
|
|
static uint32_t max111x_read(MAX111xState *s)
|
|
{
|
|
if (!s->tb1)
|
|
return 0;
|
|
|
|
switch (s->cycle ++) {
|
|
case 1:
|
|
return s->rb2;
|
|
case 2:
|
|
return s->rb3;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Interpret a control-byte */
|
|
static void max111x_write(MAX111xState *s, uint32_t value)
|
|
{
|
|
int measure, chan;
|
|
|
|
/* Ignore the value if START bit is zero */
|
|
if (!(value & CB_START))
|
|
return;
|
|
|
|
s->cycle = 0;
|
|
|
|
if (!(value & CB_PD1)) {
|
|
s->tb1 = 0;
|
|
return;
|
|
}
|
|
|
|
s->tb1 = value;
|
|
|
|
if (s->inputs == 8)
|
|
chan = CHANNEL_NUM(value, 1, 0, 2);
|
|
else
|
|
chan = CHANNEL_NUM(value & ~CB_SEL0, 0, 1, 2);
|
|
|
|
if (value & CB_SGL)
|
|
measure = s->input[chan] - s->com;
|
|
else
|
|
measure = s->input[chan] - s->input[chan ^ 1];
|
|
|
|
if (!(value & CB_UNI))
|
|
measure ^= 0x80;
|
|
|
|
s->rb2 = (measure >> 2) & 0x3f;
|
|
s->rb3 = (measure << 6) & 0xc0;
|
|
|
|
/* FIXME: When should the IRQ be lowered? */
|
|
qemu_irq_raise(s->interrupt);
|
|
}
|
|
|
|
static uint32_t max111x_transfer(SSISlave *dev, uint32_t value)
|
|
{
|
|
MAX111xState *s = FROM_SSI_SLAVE(MAX111xState, dev);
|
|
max111x_write(s, value);
|
|
return max111x_read(s);
|
|
}
|
|
|
|
static void max111x_save(QEMUFile *f, void *opaque)
|
|
{
|
|
MAX111xState *s = (MAX111xState *) opaque;
|
|
int i;
|
|
|
|
qemu_put_8s(f, &s->tb1);
|
|
qemu_put_8s(f, &s->rb2);
|
|
qemu_put_8s(f, &s->rb3);
|
|
qemu_put_be32(f, s->inputs);
|
|
qemu_put_be32(f, s->com);
|
|
for (i = 0; i < s->inputs; i ++)
|
|
qemu_put_byte(f, s->input[i]);
|
|
}
|
|
|
|
static int max111x_load(QEMUFile *f, void *opaque, int version_id)
|
|
{
|
|
MAX111xState *s = (MAX111xState *) opaque;
|
|
int i;
|
|
|
|
qemu_get_8s(f, &s->tb1);
|
|
qemu_get_8s(f, &s->rb2);
|
|
qemu_get_8s(f, &s->rb3);
|
|
if (s->inputs != qemu_get_be32(f))
|
|
return -EINVAL;
|
|
s->com = qemu_get_be32(f);
|
|
for (i = 0; i < s->inputs; i ++)
|
|
s->input[i] = qemu_get_byte(f);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int max111x_init(SSISlave *dev, int inputs)
|
|
{
|
|
MAX111xState *s = FROM_SSI_SLAVE(MAX111xState, dev);
|
|
|
|
qdev_init_gpio_out(&dev->qdev, &s->interrupt, 1);
|
|
|
|
s->inputs = inputs;
|
|
/* TODO: add a user interface for setting these */
|
|
s->input[0] = 0xf0;
|
|
s->input[1] = 0xe0;
|
|
s->input[2] = 0xd0;
|
|
s->input[3] = 0xc0;
|
|
s->input[4] = 0xb0;
|
|
s->input[5] = 0xa0;
|
|
s->input[6] = 0x90;
|
|
s->input[7] = 0x80;
|
|
s->com = 0;
|
|
|
|
register_savevm("max111x", -1, 0, max111x_save, max111x_load, s);
|
|
return 0;
|
|
}
|
|
|
|
static int max1110_init(SSISlave *dev)
|
|
{
|
|
return max111x_init(dev, 8);
|
|
}
|
|
|
|
static int max1111_init(SSISlave *dev)
|
|
{
|
|
return max111x_init(dev, 4);
|
|
}
|
|
|
|
void max111x_set_input(DeviceState *dev, int line, uint8_t value)
|
|
{
|
|
MAX111xState *s = FROM_SSI_SLAVE(MAX111xState, SSI_SLAVE_FROM_QDEV(dev));
|
|
assert(line >= 0 && line < s->inputs);
|
|
s->input[line] = value;
|
|
}
|
|
|
|
static SSISlaveInfo max1110_info = {
|
|
.qdev.name = "max1110",
|
|
.qdev.size = sizeof(MAX111xState),
|
|
.init = max1110_init,
|
|
.transfer = max111x_transfer
|
|
};
|
|
|
|
static SSISlaveInfo max1111_info = {
|
|
.qdev.name = "max1111",
|
|
.qdev.size = sizeof(MAX111xState),
|
|
.init = max1111_init,
|
|
.transfer = max111x_transfer
|
|
};
|
|
|
|
static void max111x_register_devices(void)
|
|
{
|
|
ssi_register_slave(&max1110_info);
|
|
ssi_register_slave(&max1111_info);
|
|
}
|
|
|
|
device_init(max111x_register_devices)
|