qemu-devel
[Top][All Lists]
Advanced

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

Re: [PATCH] hw/sensor: Add SB-TSI Temperature Sensor Interface


From: Patrick Venture
Subject: Re: [PATCH] hw/sensor: Add SB-TSI Temperature Sensor Interface
Date: Tue, 18 Jan 2022 09:10:32 -0800



On Mon, Jan 17, 2022 at 6:05 AM Corey Minyard <cminyard@mvista.com> wrote:
On Sun, Jan 09, 2022 at 06:17:34PM -0800, Patrick Venture wrote:
> On Fri, Jan 7, 2022 at 7:04 PM Patrick Venture <venture@google.com> wrote:
>
> > From: Hao Wu <wuhaotsh@google.com>
> >
> > SB Temperature Sensor Interface (SB-TSI) is an SMBus compatible
> > interface that reports AMD SoC's Ttcl (normalized temperature),
> > and resembles a typical 8-pin remote temperature sensor's I2C interface
> > to BMC.
> >
> > This patch implements a basic AMD SB-TSI sensor that is
> > compatible with the open-source data sheet from AMD and Linux
> > kernel driver.
> >
> > Reference:
> > Linux kernel driver:
> > https://lkml.org/lkml/2020/12/11/968
> > Register Map:
> > https://developer.amd.com/wp-content/resources/56255_3_03.PDF
> > (Chapter 6)
> >
> > Signed-off-by: Hao Wu <wuhaotsh@google.com>
> > Reviewed-by: Doug Evans <dje@google.com>
> > ---
> >  hw/sensor/Kconfig            |   4 +
> >  hw/sensor/meson.build        |   1 +
> >  hw/sensor/tmp_sbtsi.c        | 393 +++++++++++++++++++++++++++++++++++
> >  hw/sensor/trace-events       |   5 +
> >  hw/sensor/trace.h            |   1 +
> >  meson.build                  |   1 +
> >  tests/qtest/meson.build      |   1 +
> >  tests/qtest/tmp_sbtsi-test.c | 180 ++++++++++++++++
> >  8 files changed, 586 insertions(+)
> >  create mode 100644 hw/sensor/tmp_sbtsi.c
> >  create mode 100644 hw/sensor/trace-events
> >  create mode 100644 hw/sensor/trace.h
> >  create mode 100644 tests/qtest/tmp_sbtsi-test.c
> >
> > diff --git a/hw/sensor/Kconfig b/hw/sensor/Kconfig
> > index 9c8a049b06..27f6f79c84 100644
> > --- a/hw/sensor/Kconfig
> > +++ b/hw/sensor/Kconfig
> > @@ -21,3 +21,7 @@ config ADM1272
> >  config MAX34451
> >      bool
> >      depends on I2C
> > +
> > +config AMDSBTSI
> > +    bool
> > +    depends on I2C
> > diff --git a/hw/sensor/meson.build b/hw/sensor/meson.build
> > index 059c4ca935..f7b0e645eb 100644
> > --- a/hw/sensor/meson.build
> > +++ b/hw/sensor/meson.build
> > @@ -4,3 +4,4 @@ softmmu_ss.add(when: 'CONFIG_DPS310', if_true:
> > files('dps310.c'))
> >  softmmu_ss.add(when: 'CONFIG_EMC141X', if_true: files('emc141x.c'))
> >  softmmu_ss.add(when: 'CONFIG_ADM1272', if_true: files('adm1272.c'))
> >  softmmu_ss.add(when: 'CONFIG_MAX34451', if_true: files('max34451.c'))
> > +softmmu_ss.add(when: 'CONFIG_AMDSBTSI', if_true: files('tmp_sbtsi.c'))
> > diff --git a/hw/sensor/tmp_sbtsi.c b/hw/sensor/tmp_sbtsi.c
> > new file mode 100644
> > index 0000000000..b68c7ebf61
> > --- /dev/null
> > +++ b/hw/sensor/tmp_sbtsi.c
> > @@ -0,0 +1,393 @@
> > +/*
> > + * AMD SBI Temperature Sensor Interface (SB-TSI)
> > + *
> > + * Copyright 2021 Google LLC
> > + *
> > + * This program is free software; you can redistribute it and/or modify it
> > + * under the terms of the GNU General Public License as published by the
> > + * Free Software Foundation; either version 2 of the License, or
> > + * (at your option) any later version.
> > + *
> > + * This program is distributed in the hope that it will be useful, but
> > WITHOUT
> > + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
> > + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
> > + * for more details.
> > + */
> > +
> > +#include "qemu/osdep.h"
> > +#include "hw/i2c/smbus_slave.h"
> > +#include "hw/irq.h"
> > +#include "migration/vmstate.h"
> > +#include "qapi/error.h"
> > +#include "qapi/visitor.h"
> > +#include "qemu/log.h"
> > +#include "qemu/module.h"
> > +#include "trace.h"
> > +
> > +#define TYPE_SBTSI "sbtsi"
> > +#define SBTSI(obj) OBJECT_CHECK(SBTSIState, (obj), TYPE_SBTSI)
> > +
> > +/**
> > + * SBTSIState:
> > + * temperatures are in units of 0.125 degrees
> > + * @temperature: Temperature
> > + * @limit_low: Lowest temperature
> > + * @limit_high: Highest temperature
> > + * @status: The status register
> > + * @config: The config register
> > + * @alert_config: The config for alarm_l output.
> > + * @addr: The address to read/write for the next cmd.
> > + * @alarm: The alarm_l output pin (GPIO)
> > + */
> > +typedef struct SBTSIState {
> > +    SMBusDevice parent;
> > +
> > +    uint32_t temperature;
> > +    uint32_t limit_low;
> > +    uint32_t limit_high;
> > +    uint8_t status;
> > +    uint8_t config;
> > +    uint8_t alert_config;
> > +    uint8_t addr;
> > +    qemu_irq alarm;
> > +} SBTSIState;
> > +
> > +/*
> > + * SB-TSI registers only support SMBus byte data access. "_INT" registers
> > are
> > + * the integer part of a temperature value or limit, and "_DEC" registers
> > are
> > + * corresponding decimal parts.
> > + */
> > +#define SBTSI_REG_TEMP_INT      0x01 /* RO */
> > +#define SBTSI_REG_STATUS        0x02 /* RO */
> > +#define SBTSI_REG_CONFIG        0x03 /* RO */
> > +#define SBTSI_REG_TEMP_HIGH_INT 0x07 /* RW */
> > +#define SBTSI_REG_TEMP_LOW_INT  0x08 /* RW */
> > +#define SBTSI_REG_CONFIG_WR     0x09 /* RW */
> > +#define SBTSI_REG_TEMP_DEC      0x10 /* RO */
> > +#define SBTSI_REG_TEMP_HIGH_DEC 0x13 /* RW */
> > +#define SBTSI_REG_TEMP_LOW_DEC  0x14 /* RW */
> > +#define SBTSI_REG_ALERT_CONFIG  0xBF /* RW */
> > +#define SBTSI_REG_MAN           0xFE /* RO */
> > +#define SBTSI_REG_REV           0xFF /* RO */
> > +
> > +#define SBTSI_STATUS_HIGH_ALERT BIT(4)
> > +#define SBTSI_STATUS_LOW_ALERT  BIT(3)
> > +#define SBTSI_CONFIG_ALERT_MASK BIT(7)
> > +#define SBTSI_ALARM_EN          BIT(0)
> > +
> > +#define SBTSI_LIMIT_LOW_DEFAULT (0)
> > +#define SBTSI_LIMIT_HIGH_DEFAULT (560)
> > +#define SBTSI_MAN_DEFAULT (0)
> > +#define SBTSI_REV_DEFAULT (4)
> > +#define SBTSI_ALARM_L "alarm_l"
> > +
> > +/* The temperature we stored are in units of 0.125 degrees. */
> > +#define SBTSI_TEMP_UNIT_IN_MILLIDEGREE 125
> > +
> > +/*
> > + * The integer part and decimal of the temperature both 8 bits.
> > + * Only the top 3 bits of the decimal parts are used.
> > + * So the max temperature is (2^8-1) + (2^3-1)/8 = 255.875 degrees.
> > + */
> > +#define SBTSI_TEMP_MAX 255875
> > +
> > +/* The integer part of the temperature in terms of 0.125 degrees. */
> > +static uint8_t get_temp_int(uint32_t temp)
> > +{
> > +    return temp >> 3;
> > +}
> > +
> > +/*
> > + * The decimal part of the temperature, in terms of 0.125 degrees.
> > + * H/W store it in the top 3 bits so we shift it by 5.
> > + */
> > +static uint8_t get_temp_dec(uint32_t temp)
> > +{
> > +    return (temp & 0x7) << 5;
> > +}
> > +
> > +/*
> > + * Compute the temperature using the integer and decimal part,
> > + * in terms of 0.125 degrees. The decimal part are only the top 3 bits
> > + * so we shift it by 5 here.
> > + */
> > +static uint32_t compute_temp(uint8_t integer, uint8_t decimal)
> > +{
> > +    return (integer << 3) + (decimal >> 5);
> > +}
> > +
> > +/* Compute new temp with new int part of the temperature. */
> > +static uint32_t compute_temp_int(uint32_t temp, uint8_t integer)
> > +{
> > +    return compute_temp(integer, get_temp_dec(temp));
> > +}
> > +
> > +/* Compute new temp with new dec part of the temperature. */
> > +static uint32_t compute_temp_dec(uint32_t temp, uint8_t decimal)
> > +{
> > +    return compute_temp(get_temp_int(temp), decimal);
> > +}
> > +
> > +/* The integer part of the temperature. */
> > +static void sbtsi_update_status(SBTSIState *s)
> > +{
> > +    s->status = 0;
> > +    if (s->alert_config & SBTSI_ALARM_EN) {
> > +        if (s->temperature >= s->limit_high) {
> > +            s->status |= SBTSI_STATUS_HIGH_ALERT;
> > +        }
> > +        if (s->temperature <= s->limit_low) {
> > +            s->status |= SBTSI_STATUS_LOW_ALERT;
> > +        }
> > +    }
> > +}
> > +
> > +static void sbtsi_update_alarm(SBTSIState *s)
> > +{
> > +    sbtsi_update_status(s);
> > +    if (s->status != 0 && !(s->config & SBTSI_CONFIG_ALERT_MASK)) {
> > +        qemu_irq_raise(s->alarm);
> > +    } else {
> > +        qemu_irq_lower(s->alarm);
> > +    }
> > +}
> > +
> > +static uint8_t sbtsi_read_byte(SMBusDevice *d)
> > +{
> > +    SBTSIState *s = SBTSI(d);
> > +    uint8_t data = ""> > > +
> > +    switch (s->addr) {
> > +    case SBTSI_REG_TEMP_INT:
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_TEMP_DEC:
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_TEMP_HIGH_INT:
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_TEMP_LOW_INT:
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_TEMP_HIGH_DEC:
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_TEMP_LOW_DEC:
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_CONFIG:
> > +    case SBTSI_REG_CONFIG_WR:
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_STATUS:
> > +        sbtsi_update_alarm(s);
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_ALERT_CONFIG:
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_MAN:
> > +        data = ""> > > +        break;
> > +
> > +    case SBTSI_REG_REV:
> > +        data = ""> > > +        break;

Does this device do some sort of auto-increment on the address when
reading/writing?

+Hao Wu   - Please take a look at the above question.  I imagine it's a while since you've thought about it, but please double check :)
Thanks!


Other than that possible issue, I don't see anything else, it's pretty
straightforward.

> > +
> > +    default:
> > +        qemu_log_mask(LOG_GUEST_ERROR,
> > +                "%s: reading from invalid reg: 0x%02x\n",
> > +                __func__, s->addr);
> > +        break;
> > +    }
> > +
> > +    trace_tmp_sbtsi_read_data(s->addr, data);
> > +    return data;
> > +}
> > +
> > +static void sbtsi_write(SBTSIState *s, uint8_t data)
> > +{
> > +    trace_tmp_sbtsi_write_data(s->addr, data);
> > +    switch (s->addr) {
> > +    case SBTSI_REG_CONFIG_WR:
> > +        s->config = data;
> > +        break;
> > +
> > +    case SBTSI_REG_TEMP_HIGH_INT:
> > +        s->limit_high = compute_temp_int(s->limit_high, data);
> > +        break;
> > +
> > +    case SBTSI_REG_TEMP_LOW_INT:
> > +        s->limit_low = compute_temp_int(s->limit_low, data);
> > +        break;
> > +
> > +    case SBTSI_REG_TEMP_HIGH_DEC:
> > +        s->limit_high = compute_temp_dec(s->limit_high, data);
> > +        break;
> > +
> > +    case SBTSI_REG_TEMP_LOW_DEC:
> > +        s->limit_low = compute_temp_dec(s->limit_low, data);
> > +        break;
> > +
> > +    case SBTSI_REG_ALERT_CONFIG:
> > +        s->alert_config = data;
> > +        break;
> > +
> > +    case SBTSI_REG_TEMP_INT:
> > +    case SBTSI_REG_TEMP_DEC:
> > +    case SBTSI_REG_CONFIG:
> > +    case SBTSI_REG_STATUS:
> > +    case SBTSI_REG_MAN:
> > +    case SBTSI_REG_REV:
> > +        qemu_log_mask(LOG_GUEST_ERROR,
> > +                "%s: writing to read only reg: 0x%02x data: 0x%02x\n",
> > +                __func__, s->addr, data);
> > +        break;
> > +
> > +    default:
> > +        qemu_log_mask(LOG_GUEST_ERROR,
> > +                "%s: writing to invalid reg: 0x%02x data: 0x%02x\n",
> > +                __func__, s->addr, data);
> > +        break;
> > +    }
> > +    sbtsi_update_alarm(s);
> > +}
> > +
> > +static int sbtsi_write_data(SMBusDevice *d, uint8_t *buf, uint8_t len)
> > +{
> > +    SBTSIState *s = SBTSI(d);
> > +
> > +    if (len == 0) {
> > +        qemu_log_mask(LOG_GUEST_ERROR, "%s: writing empty data\n",
> > __func__);
> > +        return -1;
> > +    }
> > +
> > +    s->addr = buf[0];
> > +    if (len > 1) {
> > +        sbtsi_write(s, buf[1]);
> > +        if (len > 2) {
> > +            qemu_log_mask(LOG_GUEST_ERROR, "%s: extra data at end\n",
> > __func__);
> > +        }
> > +    }
> > +    return 0;
> > +}
> > +
> > +/* Units are millidegrees. */
> > +static void sbtsi_get_temperature(Object *obj, Visitor *v, const char
> > *name,
> > +                                  void *opaque, Error **errp)
> > +{
> > +    SBTSIState *s = SBTSI(obj);
> > +    uint32_t temp = s->temperature * SBTSI_TEMP_UNIT_IN_MILLIDEGREE;
> > +
> > +    visit_type_uint32(v, name, &temp, errp);
> > +}
> > +
> > +/* Units are millidegrees. */
> > +static void sbtsi_set_temperature(Object *obj, Visitor *v, const char
> > *name,
> > +                                  void *opaque, Error **errp)
> > +{
> > +    SBTSIState *s = SBTSI(obj);
> > +    uint32_t temp;
> > +
> > +    if (!visit_type_uint32(v, name, &temp, errp)) {
> > +        return;
> > +    }
> > +    if (temp > SBTSI_TEMP_MAX) {
> > +        error_setg(errp, "value %" PRIu32 ".%03" PRIu32 " C is out of
> > range",
> > +                   temp / 1000, temp % 1000);
> > +        return;
> > +    }
> > +
> > +    s->temperature = temp / SBTSI_TEMP_UNIT_IN_MILLIDEGREE;
> > +    sbtsi_update_alarm(s);
> > +}
> > +
> > +static int sbtsi_post_load(void *opaque, int version_id)
> > +{
> > +    SBTSIState *s = opaque;
> > +
> > +    sbtsi_update_alarm(s);
> > +    return 0;
> > +}
> > +
> > +static const VMStateDescription vmstate_sbtsi = {
> > +    .name = "SBTSI",
> > +    .version_id = 0,
> > +    .minimum_version_id = 0,
> > +    .post_load = sbtsi_post_load,
> > +    .fields = (VMStateField[]) {
> > +        VMSTATE_UINT32(temperature, SBTSIState),
> > +        VMSTATE_UINT32(limit_low, SBTSIState),
> > +        VMSTATE_UINT32(limit_high, SBTSIState),
> > +        VMSTATE_UINT8(config, SBTSIState),
> > +        VMSTATE_UINT8(status, SBTSIState),
> > +        VMSTATE_UINT8(addr, SBTSIState),
> > +        VMSTATE_END_OF_LIST()
> > +    }
> > +};
> > +
> > +static void sbtsi_enter_reset(Object *obj, ResetType type)
> > +{
> > +    SBTSIState *s = SBTSI(obj);
> > +
> > +    s->config = 0;
> > +    s->limit_low = SBTSI_LIMIT_LOW_DEFAULT;
> > +    s->limit_high = SBTSI_LIMIT_HIGH_DEFAULT;
> > +}
> > +
> > +static void sbtsi_hold_reset(Object *obj)
> > +{
> > +    SBTSIState *s = SBTSI(obj);
> > +
> > +    qemu_irq_lower(s->alarm);
> > +}
> > +
> > +static void sbtsi_init(Object *obj)
> > +{
> > +    SBTSIState *s = SBTSI(obj);
> > +
> > +    /* Current temperature in millidegrees. */
> > +    object_property_add(obj, "temperature", "uint32",
> > +                        sbtsi_get_temperature, sbtsi_set_temperature,
> > +                        NULL, NULL);
> > +    qdev_init_gpio_out_named(DEVICE(obj), &s->alarm, SBTSI_ALARM_L, 0);
> > +}
> > +
> > +static void sbtsi_class_init(ObjectClass *klass, void *data)
> > +{
> > +    ResettableClass *rc = RESETTABLE_CLASS(klass);
> > +    DeviceClass *dc = DEVICE_CLASS(klass);
> > +    SMBusDeviceClass *k = SMBUS_DEVICE_CLASS(klass);
> > +
> > +    dc->desc = "SB-TSI Temperature Sensor";
> > +    dc->vmsd = &vmstate_sbtsi;
> > +    k->write_data = sbtsi_write_data;
> > +    k->receive_byte = sbtsi_read_byte;
> > +    rc->phases.enter = sbtsi_enter_reset;
> > +    rc->phases.hold = sbtsi_hold_reset;
> > +}
> > +
> > +static const TypeInfo sbtsi_info = {
> > +    .name          = TYPE_SBTSI,
> > +    .parent        = TYPE_SMBUS_DEVICE,
> > +    .instance_size = sizeof(SBTSIState),
> > +    .instance_init = sbtsi_init,
> > +    .class_init    = sbtsi_class_init,
> > +};
> > +
> > +static void sbtsi_register_types(void)
> > +{
> > +    type_register_static(&sbtsi_info);
> > +}
> > +
> > +type_init(sbtsi_register_types)
> > diff --git a/hw/sensor/trace-events b/hw/sensor/trace-events
> > new file mode 100644
> > index 0000000000..21ab3809e2
> > --- /dev/null
> > +++ b/hw/sensor/trace-events
> > @@ -0,0 +1,5 @@
> > +# See docs/devel/tracing.rst for syntax documentation.
> > +
> > +# tmp_sbtsi.c
> > +tmp_sbtsi_write_data(uint8_t addr, uint8_t value) "SBTSI write
> > addr:0x%02x data: 0x%02x"
> > +tmp_sbtsi_read_data(uint8_t addr, uint8_t value) "SBTSI read addr:0x%02x
> > data: 0x%02x"
> > diff --git a/hw/sensor/trace.h b/hw/sensor/trace.h
> > new file mode 100644
> > index 0000000000..e4721560b0
> > --- /dev/null
> > +++ b/hw/sensor/trace.h
> > @@ -0,0 +1 @@
> > +#include "trace/trace-hw_sensor.h"
> > diff --git a/meson.build b/meson.build
> > index 53065e96ec..f8ab0bf74e 100644
> > --- a/meson.build
> > +++ b/meson.build
> > @@ -2494,6 +2494,7 @@ if have_system
> >      'hw/rtc',
> >      'hw/s390x',
> >      'hw/scsi',
> > +    'hw/sensor',
> >      'hw/sd',
> >      'hw/sh4',
> >      'hw/sparc',
> > diff --git a/tests/qtest/meson.build b/tests/qtest/meson.build
> > index 37e1eaa449..d1a8c38f74 100644
> > --- a/tests/qtest/meson.build
> > +++ b/tests/qtest/meson.build
> > @@ -254,6 +254,7 @@ qos_test_ss.add(
> >    'spapr-phb-test.c',
> >    'tmp105-test.c',
> >    'emc141x-test.c',
> > +  'tmp_sbtsi-test.c',
> >    'usb-hcd-ohci-test.c',
> >    'virtio-test.c',
> >    'virtio-blk-test.c',
> > diff --git a/tests/qtest/tmp_sbtsi-test.c b/tests/qtest/tmp_sbtsi-test.c
> > new file mode 100644
> > index 0000000000..7f5fafacc7
> > --- /dev/null
> > +++ b/tests/qtest/tmp_sbtsi-test.c
> > @@ -0,0 +1,180 @@
> > +/*
> > + * QTests for the SBTSI temperature sensor
> > + *
> > + * Copyright 2020 Google LLC
> > + *
> > + * This program is free software; you can redistribute it and/or modify it
> > + * under the terms of the GNU General Public License as published by the
> > + * Free Software Foundation; either version 2 of the License, or
> > + * (at your option) any later version.
> > + *
> > + * This program is distributed in the hope that it will be useful, but
> > WITHOUT
> > + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
> > + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
> > + * for more details.
> > + */
> > +
> > +#include "qemu/osdep.h"
> > +
> > +#include "libqtest-single.h"
> > +#include "libqos/qgraph.h"
> > +#include "libqos/i2c.h"
> > +#include "qapi/qmp/qdict.h"
> > +#include "qemu/bitops.h"
> > +
> > +#define TEST_ID   "sbtsi-test"
> > +#define TEST_ADDR (0x4c)
> > +
> > +/*
> > + * SB-TSI registers only support SMBus byte data access. "_INT" registers
> > are
> > + * the integer part of a temperature value or limit, and "_DEC" registers
> > are
> > + * corresponding decimal parts.
> > + */
> > +#define REG_TEMP_INT      0x01 /* RO */
> > +#define REG_STATUS        0x02 /* RO */
> > +#define REG_CONFIG        0x03 /* RO */
> > +#define REG_TEMP_HIGH_INT 0x07 /* RW */
> > +#define REG_TEMP_LOW_INT  0x08 /* RW */
> > +#define REG_CONFIG_WR     0x09 /* RW */
> > +#define REG_TEMP_DEC      0x10 /* RO */
> > +#define REG_TEMP_HIGH_DEC 0x13 /* RW */
> > +#define REG_TEMP_LOW_DEC  0x14 /* RW */
> > +#define REG_ALERT_CONFIG  0xBF /* RW */
> > +
> > +#define STATUS_HIGH_ALERT BIT(4)
> > +#define STATUS_LOW_ALERT  BIT(3)
> > +#define CONFIG_ALERT_MASK BIT(7)
> > +#define ALARM_EN          BIT(0)
> > +
> > +/* The temperature stored are in units of 0.125 degrees. */
> > +#define TEMP_UNIT_IN_MILLIDEGREE 125
> > +#define LIMIT_LOW (10500)
> > +#define LIMIT_HIGH (55125)
> > +
> > +static uint32_t qmp_sbtsi_get_temperature(const char *id)
> > +{
> > +    QDict *response;
> > +    int ret;
> > +
> > +    response = qmp("{ 'execute': 'qom-get', 'arguments': { 'path': %s, "
> > +                   "'property': 'temperature' } }", id);
> > +    g_assert(qdict_haskey(response, "return"));
> > +    ret = (uint32_t)qdict_get_int(response, "return");
> > +    qobject_unref(response);
> > +    return ret;
> > +}
> > +
> > +static void qmp_sbtsi_set_temperature(const char *id, uint32_t value)
> > +{
> > +    QDict *response;
> > +
> > +    response = qmp("{ 'execute': 'qom-set', 'arguments': { 'path': %s, "
> > +                   "'property': 'temperature', 'value': %d } }", id,
> > value);
> > +    g_assert(qdict_haskey(response, "return"));
> > +    qobject_unref(response);
> > +}
> > +
> > +/*
> > + * Compute the temperature using the integer and decimal part and return
> > + * millidegrees. The decimal part are only the top 3 bits so we shift it
> > by
> > + * 5 here.
> > + */
> > +static uint32_t regs_to_temp(uint8_t integer, uint8_t decimal)
> > +{
> > +    return ((integer << 3) + (decimal >> 5)) * TEMP_UNIT_IN_MILLIDEGREE;
> > +}
> > +
> > +/*
> > + * Compute the integer and decimal parts of the temperature in
> > millidegrees.
> > + * H/W store the decimal in the top 3 bits so we shift it by 5.
> > + */
> > +static void temp_to_regs(uint32_t temp, uint8_t *integer, uint8_t
> > *decimal)
> > +{
> > +    temp /= TEMP_UNIT_IN_MILLIDEGREE;
> > +    *integer = temp >> 3;
> > +    *decimal = (temp & 0x7) << 5;
> > +}
> > +
> > +static void tx_rx(void *obj, void *data, QGuestAllocator *alloc)
> > +{
> > +    uint16_t value;
> > +    uint8_t integer, decimal;
> > +    QI2CDevice *i2cdev = (QI2CDevice *)obj;
> > +
> > +    /* Test default values */
> > +    value = qmp_sbtsi_get_temperature(TEST_ID);
> > +    g_assert_cmpuint(value, ==, 0);
> > +
> > +    integer = i2c_get8(i2cdev, REG_TEMP_INT);
> > +    decimal = i2c_get8(i2cdev, REG_TEMP_DEC);
> > +    g_assert_cmpuint(regs_to_temp(integer, decimal), ==, 0);
> > +
> > +    /* Test setting temperature */
> > +    qmp_sbtsi_set_temperature(TEST_ID, 20000);
> > +    value = qmp_sbtsi_get_temperature(TEST_ID);
> > +    g_assert_cmpuint(value, ==, 20000);
> > +
> > +    integer = i2c_get8(i2cdev, REG_TEMP_INT);
> > +    decimal = i2c_get8(i2cdev, REG_TEMP_DEC);
> > +    g_assert_cmpuint(regs_to_temp(integer, decimal), ==, 20000);
> > +
> > +    /* Set alert mask in config */
> > +    i2c_set8(i2cdev, REG_CONFIG_WR, CONFIG_ALERT_MASK);
> > +    value = i2c_get8(i2cdev, REG_CONFIG);
> > +    g_assert_cmphex(value, ==, CONFIG_ALERT_MASK);
> > +    /* Enable alarm_en */
> > +    i2c_set8(i2cdev, REG_ALERT_CONFIG, ALARM_EN);
> > +    value = i2c_get8(i2cdev, REG_ALERT_CONFIG);
> > +    g_assert_cmphex(value, ==, ALARM_EN);
> > +
> > +    /* Test setting limits */
> > +    /* Limit low = 10.500 */
> > +    temp_to_regs(LIMIT_LOW, &integer, &decimal);
> > +    i2c_set8(i2cdev, REG_TEMP_LOW_INT, integer);
> > +    i2c_set8(i2cdev, REG_TEMP_LOW_DEC, decimal);
> > +    integer = i2c_get8(i2cdev, REG_TEMP_LOW_INT);
> > +    decimal = i2c_get8(i2cdev, REG_TEMP_LOW_DEC);
> > +    g_assert_cmpuint(regs_to_temp(integer, decimal), ==, LIMIT_LOW);
> > +    /* Limit high = 55.125 */
> > +    temp_to_regs(LIMIT_HIGH, &integer, &decimal);
> > +    i2c_set8(i2cdev, REG_TEMP_HIGH_INT, integer);
> > +    i2c_set8(i2cdev, REG_TEMP_HIGH_DEC, decimal);
> > +    integer = i2c_get8(i2cdev, REG_TEMP_HIGH_INT);
> > +    decimal = i2c_get8(i2cdev, REG_TEMP_HIGH_DEC);
> > +    g_assert_cmpuint(regs_to_temp(integer, decimal), ==, LIMIT_HIGH);
> > +    /* No alert is generated. */
> > +    value = i2c_get8(i2cdev, REG_STATUS);
> > +    g_assert_cmphex(value, ==, 0);
> > +
> > +    /* Test alert for low temperature */
> > +    qmp_sbtsi_set_temperature(TEST_ID, LIMIT_LOW);
> > +    value = i2c_get8(i2cdev, REG_STATUS);
> > +    g_assert_cmphex(value, ==, STATUS_LOW_ALERT);
> > +
> > +    /* Test alert for high temperature */
> > +    qmp_sbtsi_set_temperature(TEST_ID, LIMIT_HIGH);
> > +    value = i2c_get8(i2cdev, REG_STATUS);
> > +    g_assert_cmphex(value, ==, STATUS_HIGH_ALERT);
> > +
> > +    /* Disable alarm_en */
> > +    i2c_set8(i2cdev, REG_ALERT_CONFIG, 0);
> > +    value = i2c_get8(i2cdev, REG_ALERT_CONFIG);
> > +    g_assert_cmphex(value, ==, 0);
> > +    /* No alert when alarm_en is false. */
> > +    value = i2c_get8(i2cdev, REG_STATUS);
> > +    g_assert_cmphex(value, ==, 0);
> > +}
> > +
> > +static void sbtsi_register_nodes(void)
> > +{
> > +    QOSGraphEdgeOptions opts = {
> > +        .extra_device_opts = "id=" TEST_ID ",address=0x4c"
> > +    };
> > +    add_qi2c_address(&opts, &(QI2CAddress) { TEST_ADDR });
> > +
> > +    qos_node_create_driver("sbtsi", i2c_device_create);
> > +    qos_node_consumes("sbtsi", "i2c-bus", &opts);
> > +
> > +    qos_add_test("tx-rx", "sbtsi", tx_rx, NULL);
> > +}
> > +libqos_init(sbtsi_register_nodes);
> > --
>
>
> + Corey for i2c maintainer.  The new sensor directory is mostly if not
> entirely i2c devices.  I didn't create a maintainer entry for this i2c
> device, but I can if desired and send out a v2.

Yeah, I guess I should be maintainer there.  I'll queue up a change for
that.  Thanks.

-corey

>
>
> > 2.34.1.575.g55b058a8bb-goog
> >
> >

reply via email to

[Prev in Thread] Current Thread [Next in Thread]