The only way object_property_add() can fail is when a property with the same name already exists. Since our property names are all hardcoded, failure is a programming error, and the appropriate way to handle it is passing &error_abort. Same for its variants, except for object_property_add_child(), which additionally fails when the child already has a parent. Parentage is also under program control, so this is a programming error, too. We have a bit over 500 callers. Almost half of them pass &error_abort, slightly fewer ignore errors, one test case handles errors, and the remaining few callers pass them to their own callers. The previous few commits demonstrated once again that ignoring programming errors is a bad idea. Of the few ones that pass on errors, several violate the Error API. The Error ** argument must be NULL, &error_abort, &error_fatal, or a pointer to a variable containing NULL. Passing an argument of the latter kind twice without clearing it in between is wrong: if the first call sets an error, it no longer points to NULL for the second call. ich9_pm_add_properties(), sparc32_ledma_realize(), sparc32_dma_realize(), xilinx_axidma_realize(), xilinx_enet_realize() are wrong that way. When the one appropriate choice of argument is &error_abort, letting users pick the argument is a bad idea. Drop parameter @errp and assert the preconditions instead. There's one exception to "duplicate property name is a programming error": the way object_property_add() implements the magic (and undocumented) "automatic arrayification". Don't drop @errp there. Instead, rename object_property_add() to object_property_try_add(), and add the obvious wrapper object_property_add(). Signed-off-by: Markus Armbruster <armbru@redhat.com> Reviewed-by: Eric Blake <eblake@redhat.com> Reviewed-by: Paolo Bonzini <pbonzini@redhat.com> Message-Id: <20200505152926.18877-15-armbru@redhat.com> [Two semantic rebase conflicts resolved]
332 lines
8.4 KiB
C
332 lines
8.4 KiB
C
/*
|
|
* PCA9552 I2C LED blinker
|
|
*
|
|
* https://www.nxp.com/docs/en/application-note/AN264.pdf
|
|
*
|
|
* Copyright (c) 2017-2018, IBM Corporation.
|
|
*
|
|
* 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 "qemu/log.h"
|
|
#include "qemu/module.h"
|
|
#include "hw/misc/pca9552.h"
|
|
#include "hw/misc/pca9552_regs.h"
|
|
#include "migration/vmstate.h"
|
|
#include "qapi/error.h"
|
|
#include "qapi/visitor.h"
|
|
|
|
#define PCA9552_LED_ON 0x0
|
|
#define PCA9552_LED_OFF 0x1
|
|
#define PCA9552_LED_PWM0 0x2
|
|
#define PCA9552_LED_PWM1 0x3
|
|
|
|
static const char *led_state[] = {"on", "off", "pwm0", "pwm1"};
|
|
|
|
static uint8_t pca9552_pin_get_config(PCA9552State *s, int pin)
|
|
{
|
|
uint8_t reg = PCA9552_LS0 + (pin / 4);
|
|
uint8_t shift = (pin % 4) << 1;
|
|
|
|
return extract32(s->regs[reg], shift, 2);
|
|
}
|
|
|
|
static void pca9552_update_pin_input(PCA9552State *s)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < s->nr_leds; i++) {
|
|
uint8_t input_reg = PCA9552_INPUT0 + (i / 8);
|
|
uint8_t input_shift = (i % 8);
|
|
uint8_t config = pca9552_pin_get_config(s, i);
|
|
|
|
switch (config) {
|
|
case PCA9552_LED_ON:
|
|
s->regs[input_reg] |= 1 << input_shift;
|
|
break;
|
|
case PCA9552_LED_OFF:
|
|
s->regs[input_reg] &= ~(1 << input_shift);
|
|
break;
|
|
case PCA9552_LED_PWM0:
|
|
case PCA9552_LED_PWM1:
|
|
/* TODO */
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
static uint8_t pca9552_read(PCA9552State *s, uint8_t reg)
|
|
{
|
|
switch (reg) {
|
|
case PCA9552_INPUT0:
|
|
case PCA9552_INPUT1:
|
|
case PCA9552_PSC0:
|
|
case PCA9552_PWM0:
|
|
case PCA9552_PSC1:
|
|
case PCA9552_PWM1:
|
|
case PCA9552_LS0:
|
|
case PCA9552_LS1:
|
|
case PCA9552_LS2:
|
|
case PCA9552_LS3:
|
|
return s->regs[reg];
|
|
default:
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: unexpected read to register %d\n",
|
|
__func__, reg);
|
|
return 0xFF;
|
|
}
|
|
}
|
|
|
|
static void pca9552_write(PCA9552State *s, uint8_t reg, uint8_t data)
|
|
{
|
|
switch (reg) {
|
|
case PCA9552_PSC0:
|
|
case PCA9552_PWM0:
|
|
case PCA9552_PSC1:
|
|
case PCA9552_PWM1:
|
|
s->regs[reg] = data;
|
|
break;
|
|
|
|
case PCA9552_LS0:
|
|
case PCA9552_LS1:
|
|
case PCA9552_LS2:
|
|
case PCA9552_LS3:
|
|
s->regs[reg] = data;
|
|
pca9552_update_pin_input(s);
|
|
break;
|
|
|
|
case PCA9552_INPUT0:
|
|
case PCA9552_INPUT1:
|
|
default:
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: unexpected write to register %d\n",
|
|
__func__, reg);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* When Auto-Increment is on, the register address is incremented
|
|
* after each byte is sent to or received by the device. The index
|
|
* rollovers to 0 when the maximum register address is reached.
|
|
*/
|
|
static void pca9552_autoinc(PCA9552State *s)
|
|
{
|
|
if (s->pointer != 0xFF && s->pointer & PCA9552_AUTOINC) {
|
|
uint8_t reg = s->pointer & 0xf;
|
|
|
|
reg = (reg + 1) % (s->max_reg + 1);
|
|
s->pointer = reg | PCA9552_AUTOINC;
|
|
}
|
|
}
|
|
|
|
static uint8_t pca9552_recv(I2CSlave *i2c)
|
|
{
|
|
PCA9552State *s = PCA9552(i2c);
|
|
uint8_t ret;
|
|
|
|
ret = pca9552_read(s, s->pointer & 0xf);
|
|
|
|
/*
|
|
* From the Specs:
|
|
*
|
|
* Important Note: When a Read sequence is initiated and the
|
|
* AI bit is set to Logic Level 1, the Read Sequence MUST
|
|
* start by a register different from 0.
|
|
*
|
|
* I don't know what should be done in this case, so throw an
|
|
* error.
|
|
*/
|
|
if (s->pointer == PCA9552_AUTOINC) {
|
|
qemu_log_mask(LOG_GUEST_ERROR,
|
|
"%s: Autoincrement read starting with register 0\n",
|
|
__func__);
|
|
}
|
|
|
|
pca9552_autoinc(s);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int pca9552_send(I2CSlave *i2c, uint8_t data)
|
|
{
|
|
PCA9552State *s = PCA9552(i2c);
|
|
|
|
/* First byte sent by is the register address */
|
|
if (s->len == 0) {
|
|
s->pointer = data;
|
|
s->len++;
|
|
} else {
|
|
pca9552_write(s, s->pointer & 0xf, data);
|
|
|
|
pca9552_autoinc(s);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int pca9552_event(I2CSlave *i2c, enum i2c_event event)
|
|
{
|
|
PCA9552State *s = PCA9552(i2c);
|
|
|
|
s->len = 0;
|
|
return 0;
|
|
}
|
|
|
|
static void pca9552_get_led(Object *obj, Visitor *v, const char *name,
|
|
void *opaque, Error **errp)
|
|
{
|
|
PCA9552State *s = PCA9552(obj);
|
|
int led, rc, reg;
|
|
uint8_t state;
|
|
|
|
rc = sscanf(name, "led%2d", &led);
|
|
if (rc != 1) {
|
|
error_setg(errp, "%s: error reading %s", __func__, name);
|
|
return;
|
|
}
|
|
if (led < 0 || led > s->nr_leds) {
|
|
error_setg(errp, "%s invalid led %s", __func__, name);
|
|
return;
|
|
}
|
|
/*
|
|
* Get the LSx register as the qom interface should expose the device
|
|
* state, not the modeled 'input line' behaviour which would come from
|
|
* reading the INPUTx reg
|
|
*/
|
|
reg = PCA9552_LS0 + led / 4;
|
|
state = (pca9552_read(s, reg) >> (led % 8)) & 0x3;
|
|
visit_type_str(v, name, (char **)&led_state[state], errp);
|
|
}
|
|
|
|
/*
|
|
* Return an LED selector register value based on an existing one, with
|
|
* the appropriate 2-bit state value set for the given LED number (0-3).
|
|
*/
|
|
static inline uint8_t pca955x_ledsel(uint8_t oldval, int led_num, int state)
|
|
{
|
|
return (oldval & (~(0x3 << (led_num << 1)))) |
|
|
((state & 0x3) << (led_num << 1));
|
|
}
|
|
|
|
static void pca9552_set_led(Object *obj, Visitor *v, const char *name,
|
|
void *opaque, Error **errp)
|
|
{
|
|
PCA9552State *s = PCA9552(obj);
|
|
Error *local_err = NULL;
|
|
int led, rc, reg, val;
|
|
uint8_t state;
|
|
char *state_str;
|
|
|
|
visit_type_str(v, name, &state_str, &local_err);
|
|
if (local_err) {
|
|
error_propagate(errp, local_err);
|
|
return;
|
|
}
|
|
rc = sscanf(name, "led%2d", &led);
|
|
if (rc != 1) {
|
|
error_setg(errp, "%s: error reading %s", __func__, name);
|
|
return;
|
|
}
|
|
if (led < 0 || led > s->nr_leds) {
|
|
error_setg(errp, "%s invalid led %s", __func__, name);
|
|
return;
|
|
}
|
|
|
|
for (state = 0; state < ARRAY_SIZE(led_state); state++) {
|
|
if (!strcmp(state_str, led_state[state])) {
|
|
break;
|
|
}
|
|
}
|
|
if (state >= ARRAY_SIZE(led_state)) {
|
|
error_setg(errp, "%s invalid led state %s", __func__, state_str);
|
|
return;
|
|
}
|
|
|
|
reg = PCA9552_LS0 + led / 4;
|
|
val = pca9552_read(s, reg);
|
|
val = pca955x_ledsel(val, led % 4, state);
|
|
pca9552_write(s, reg, val);
|
|
}
|
|
|
|
static const VMStateDescription pca9552_vmstate = {
|
|
.name = "PCA9552",
|
|
.version_id = 0,
|
|
.minimum_version_id = 0,
|
|
.fields = (VMStateField[]) {
|
|
VMSTATE_UINT8(len, PCA9552State),
|
|
VMSTATE_UINT8(pointer, PCA9552State),
|
|
VMSTATE_UINT8_ARRAY(regs, PCA9552State, PCA9552_NR_REGS),
|
|
VMSTATE_I2C_SLAVE(i2c, PCA9552State),
|
|
VMSTATE_END_OF_LIST()
|
|
}
|
|
};
|
|
|
|
static void pca9552_reset(DeviceState *dev)
|
|
{
|
|
PCA9552State *s = PCA9552(dev);
|
|
|
|
s->regs[PCA9552_PSC0] = 0xFF;
|
|
s->regs[PCA9552_PWM0] = 0x80;
|
|
s->regs[PCA9552_PSC1] = 0xFF;
|
|
s->regs[PCA9552_PWM1] = 0x80;
|
|
s->regs[PCA9552_LS0] = 0x55; /* all OFF */
|
|
s->regs[PCA9552_LS1] = 0x55;
|
|
s->regs[PCA9552_LS2] = 0x55;
|
|
s->regs[PCA9552_LS3] = 0x55;
|
|
|
|
pca9552_update_pin_input(s);
|
|
|
|
s->pointer = 0xFF;
|
|
s->len = 0;
|
|
}
|
|
|
|
static void pca9552_initfn(Object *obj)
|
|
{
|
|
PCA9552State *s = PCA9552(obj);
|
|
int led;
|
|
|
|
/* If support for the other PCA955X devices are implemented, these
|
|
* constant values might be part of class structure describing the
|
|
* PCA955X device
|
|
*/
|
|
s->max_reg = PCA9552_LS3;
|
|
s->nr_leds = 16;
|
|
|
|
for (led = 0; led < s->nr_leds; led++) {
|
|
char *name;
|
|
|
|
name = g_strdup_printf("led%d", led);
|
|
object_property_add(obj, name, "bool", pca9552_get_led, pca9552_set_led,
|
|
NULL, NULL);
|
|
g_free(name);
|
|
}
|
|
}
|
|
|
|
static void pca9552_class_init(ObjectClass *klass, void *data)
|
|
{
|
|
DeviceClass *dc = DEVICE_CLASS(klass);
|
|
I2CSlaveClass *k = I2C_SLAVE_CLASS(klass);
|
|
|
|
k->event = pca9552_event;
|
|
k->recv = pca9552_recv;
|
|
k->send = pca9552_send;
|
|
dc->reset = pca9552_reset;
|
|
dc->vmsd = &pca9552_vmstate;
|
|
}
|
|
|
|
static const TypeInfo pca9552_info = {
|
|
.name = TYPE_PCA9552,
|
|
.parent = TYPE_I2C_SLAVE,
|
|
.instance_init = pca9552_initfn,
|
|
.instance_size = sizeof(PCA9552State),
|
|
.class_init = pca9552_class_init,
|
|
};
|
|
|
|
static void pca9552_register_types(void)
|
|
{
|
|
type_register_static(&pca9552_info);
|
|
}
|
|
|
|
type_init(pca9552_register_types)
|