mirrors/qemu
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
c04cfb4596
qemu/hw/i2c/pmbus_device.c
Titus Rwantare ff0511282d hw/i2c: pmbus: reset page register for out of range reads 
The linux pmbus driver scans all possible pages and does not reset the
current page after the scan, making all future page reads fail as out of range
on devices with a single page.

This change resets out of range pages immediately on write.

Also added a qtest for simultaneous writes to all pages.

Reviewed-by: Hao Wu <wuhaotsh@google.com>
Signed-off-by: Titus Rwantare <titusr@google.com>
Message-ID: <20231023-staging-pmbus-v3-v4-8-07a8cb7cd20a@google.com>
Signed-off-by: Philippe Mathieu-Daudé <philmd@linaro.org>
2023-11-07 13:08:49 +01:00

1930 lines
61 KiB
C
Raw Blame History

/*
* PMBus wrapper over SMBus
*
* Copyright 2021 Google LLC
*
* SPDX-License-Identifier: GPL-2.0-or-later
*/
#include "qemu/osdep.h"
#include <math.h>
#include "hw/i2c/pmbus_device.h"
#include "migration/vmstate.h"
#include "qemu/module.h"
#include "qemu/log.h"
uint16_t pmbus_data2direct_mode(PMBusCoefficients c, uint32_t value)
{
/* R is usually negative to fit large readings into 16 bits */
uint16_t y = (c.m * value + c.b) * pow(10, c.R);
return y;
}
uint32_t pmbus_direct_mode2data(PMBusCoefficients c, uint16_t value)
{
/* X = (Y * 10^-R - b) / m */
uint32_t x = (value / pow(10, c.R) - c.b) / c.m;
return x;
}
uint16_t pmbus_data2linear_mode(uint16_t value, int exp)
{
/* L = D * 2^(-e) */
if (exp < 0) {
return value << (-exp);
}
return value >> exp;
}
uint16_t pmbus_linear_mode2data(uint16_t value, int exp)
{
/* D = L * 2^e */
if (exp < 0) {
return value >> (-exp);
}
return value << exp;
}
void pmbus_send(PMBusDevice *pmdev, const uint8_t *data, uint16_t len)
{
if (pmdev->out_buf_len + len > SMBUS_DATA_MAX_LEN) {
qemu_log_mask(LOG_GUEST_ERROR,
"PMBus device tried to send too much data");
len = 0;
}
for (int i = len - 1; i >= 0; i--) {
pmdev->out_buf[i + pmdev->out_buf_len] = data[len - i - 1];
}
pmdev->out_buf_len += len;
}
/* Internal only, convert unsigned ints to the little endian bus */
static void pmbus_send_uint(PMBusDevice *pmdev, uint64_t data, uint8_t size)
{
uint8_t bytes[8];
g_assert(size <= 8);
for (int i = 0; i < size; i++) {
bytes[i] = data & 0xFF;
data = data >> 8;
}
pmbus_send(pmdev, bytes, size);
}
void pmbus_send8(PMBusDevice *pmdev, uint8_t data)
{
pmbus_send_uint(pmdev, data, 1);
}
void pmbus_send16(PMBusDevice *pmdev, uint16_t data)
{
pmbus_send_uint(pmdev, data, 2);
}
void pmbus_send32(PMBusDevice *pmdev, uint32_t data)
{
pmbus_send_uint(pmdev, data, 4);
}
void pmbus_send64(PMBusDevice *pmdev, uint64_t data)
{
pmbus_send_uint(pmdev, data, 8);
}
void pmbus_send_string(PMBusDevice *pmdev, const char *data)
{
if (!data) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: %s: uninitialised read from 0x%02x\n",
__func__, DEVICE(pmdev)->canonical_path, pmdev->code);
return;
}
size_t len = strlen(data);
g_assert(len + pmdev->out_buf_len < SMBUS_DATA_MAX_LEN);
pmdev->out_buf[len + pmdev->out_buf_len] = len;
for (int i = len - 1; i >= 0; i--) {
pmdev->out_buf[i + pmdev->out_buf_len] = data[len - 1 - i];
}
pmdev->out_buf_len += len + 1;
}
uint8_t pmbus_receive_block(PMBusDevice *pmdev, uint8_t *dest, size_t len)
{
/* dest may contain data from previous writes */
memset(dest, 0, len);
/* Exclude command code from return value */
pmdev->in_buf++;
pmdev->in_buf_len--;
/* The byte after the command code denotes the length */
uint8_t sent_len = pmdev->in_buf[0];
if (sent_len != pmdev->in_buf_len - 1) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: length mismatch. Expected %d bytes, got %d bytes\n",
__func__, sent_len, pmdev->in_buf_len - 1);
}
/* exclude length byte */
pmdev->in_buf++;
pmdev->in_buf_len--;
if (pmdev->in_buf_len < len) {
len = pmdev->in_buf_len;
}
memcpy(dest, pmdev->in_buf, len);
return len;
}
static uint64_t pmbus_receive_uint(PMBusDevice *pmdev)
{
uint64_t ret = 0;
/* Exclude command code from return value */
pmdev->in_buf++;
pmdev->in_buf_len--;
for (int i = pmdev->in_buf_len - 1; i >= 0; i--) {
ret = ret << 8 | pmdev->in_buf[i];
}
return ret;
}
uint8_t pmbus_receive8(PMBusDevice *pmdev)
{
if (pmdev->in_buf_len - 1 != 1) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: length mismatch. Expected 1 byte, got %d bytes\n",
__func__, pmdev->in_buf_len - 1);
}
return pmbus_receive_uint(pmdev);
}
uint16_t pmbus_receive16(PMBusDevice *pmdev)
{
if (pmdev->in_buf_len - 1 != 2) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: length mismatch. Expected 2 bytes, got %d bytes\n",
__func__, pmdev->in_buf_len - 1);
}
return pmbus_receive_uint(pmdev);
}
uint32_t pmbus_receive32(PMBusDevice *pmdev)
{
if (pmdev->in_buf_len - 1 != 4) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: length mismatch. Expected 4 bytes, got %d bytes\n",
__func__, pmdev->in_buf_len - 1);
}
return pmbus_receive_uint(pmdev);
}
uint64_t pmbus_receive64(PMBusDevice *pmdev)
{
if (pmdev->in_buf_len - 1 != 8) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: length mismatch. Expected 8 bytes, got %d bytes\n",
__func__, pmdev->in_buf_len - 1);
}
return pmbus_receive_uint(pmdev);
}
static uint8_t pmbus_out_buf_pop(PMBusDevice *pmdev)
{
if (pmdev->out_buf_len == 0) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: tried to read from empty buffer",
__func__);
return PMBUS_ERR_BYTE;
}
uint8_t data = pmdev->out_buf[pmdev->out_buf_len - 1];
pmdev->out_buf_len--;
return data;
}
static void pmbus_quick_cmd(SMBusDevice *smd, uint8_t read)
{
PMBusDevice *pmdev = PMBUS_DEVICE(smd);
PMBusDeviceClass *pmdc = PMBUS_DEVICE_GET_CLASS(pmdev);
if (pmdc->quick_cmd) {
pmdc->quick_cmd(pmdev, read);
}
}
static uint8_t pmbus_pages_num(PMBusDevice *pmdev)
{
const PMBusDeviceClass *k = PMBUS_DEVICE_GET_CLASS(pmdev);
/* some PMBus devices don't use the PAGE command, so they get 1 page */
return k->device_num_pages ? : 1;
}
static void pmbus_pages_alloc(PMBusDevice *pmdev)
{
pmdev->num_pages = pmbus_pages_num(pmdev);
pmdev->pages = g_new0(PMBusPage, pmdev->num_pages);
}
void pmbus_check_limits(PMBusDevice *pmdev)
{
for (int i = 0; i < pmdev->num_pages; i++) {
if ((pmdev->pages[i].operation & PB_OP_ON) == 0) {
continue; /* don't check powered off devices */
}
if (pmdev->pages[i].read_vout > pmdev->pages[i].vout_ov_fault_limit) {
pmdev->pages[i].status_word |= PB_STATUS_VOUT;
pmdev->pages[i].status_vout |= PB_STATUS_VOUT_OV_FAULT;
}
if (pmdev->pages[i].read_vout > pmdev->pages[i].vout_ov_warn_limit) {
pmdev->pages[i].status_word |= PB_STATUS_VOUT;
pmdev->pages[i].status_vout |= PB_STATUS_VOUT_OV_WARN;
}
if (pmdev->pages[i].read_vout < pmdev->pages[i].vout_uv_warn_limit) {
pmdev->pages[i].status_word |= PB_STATUS_VOUT;
pmdev->pages[i].status_vout |= PB_STATUS_VOUT_UV_WARN;
}
if (pmdev->pages[i].read_vout < pmdev->pages[i].vout_uv_fault_limit) {
pmdev->pages[i].status_word |= PB_STATUS_VOUT;
pmdev->pages[i].status_vout |= PB_STATUS_VOUT_UV_FAULT;
}
if (pmdev->pages[i].read_vin > pmdev->pages[i].vin_ov_warn_limit) {
pmdev->pages[i].status_word |= PB_STATUS_INPUT;
pmdev->pages[i].status_input |= PB_STATUS_INPUT_VIN_OV_WARN;
}
if (pmdev->pages[i].read_vin < pmdev->pages[i].vin_uv_warn_limit) {
pmdev->pages[i].status_word |= PB_STATUS_INPUT;
pmdev->pages[i].status_input |= PB_STATUS_INPUT_VIN_UV_WARN;
}
if (pmdev->pages[i].read_iout > pmdev->pages[i].iout_oc_warn_limit) {
pmdev->pages[i].status_word |= PB_STATUS_IOUT_POUT;
pmdev->pages[i].status_iout |= PB_STATUS_IOUT_OC_WARN;
}
if (pmdev->pages[i].read_iout > pmdev->pages[i].iout_oc_fault_limit) {
pmdev->pages[i].status_word |= PB_STATUS_IOUT_POUT;
pmdev->pages[i].status_iout |= PB_STATUS_IOUT_OC_FAULT;
}
if (pmdev->pages[i].read_pin > pmdev->pages[i].pin_op_warn_limit) {
pmdev->pages[i].status_word |= PB_STATUS_INPUT;
pmdev->pages[i].status_input |= PB_STATUS_INPUT_PIN_OP_WARN;
}
if (pmdev->pages[i].read_temperature_1
> pmdev->pages[i].ot_fault_limit) {
pmdev->pages[i].status_word |= PB_STATUS_TEMPERATURE;
pmdev->pages[i].status_temperature |= PB_STATUS_OT_FAULT;
}
if (pmdev->pages[i].read_temperature_1
> pmdev->pages[i].ot_warn_limit) {
pmdev->pages[i].status_word |= PB_STATUS_TEMPERATURE;
pmdev->pages[i].status_temperature |= PB_STATUS_OT_WARN;
}
}
}
void pmbus_idle(PMBusDevice *pmdev)
{
pmdev->code = PMBUS_IDLE_STATE;
}
/* assert the status_cml error upon receipt of malformed command */
static void pmbus_cml_error(PMBusDevice *pmdev)
{
for (int i = 0; i < pmdev->num_pages; i++) {
pmdev->pages[i].status_word |= PMBUS_STATUS_CML;
pmdev->pages[i].status_cml |= PB_CML_FAULT_INVALID_CMD;
}
}
static uint8_t pmbus_receive_byte(SMBusDevice *smd)
{
PMBusDevice *pmdev = PMBUS_DEVICE(smd);
PMBusDeviceClass *pmdc = PMBUS_DEVICE_GET_CLASS(pmdev);
uint8_t ret = PMBUS_ERR_BYTE;
uint8_t index;
if (pmdev->out_buf_len != 0) {
ret = pmbus_out_buf_pop(pmdev);
return ret;
}
/*
* Reading from all pages will return the value from page 0,
* means that all subsequent commands are to be applied to all output.
*/
if (pmdev->page == PB_ALL_PAGES) {
index = 0;
} else if (pmdev->page > pmdev->num_pages - 1) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: page %d is out of range\n",
__func__, pmdev->page);
pmbus_cml_error(pmdev);
return PMBUS_ERR_BYTE;
} else {
index = pmdev->page;
}
switch (pmdev->code) {
case PMBUS_PAGE:
pmbus_send8(pmdev, pmdev->page);
break;
case PMBUS_OPERATION: /* R/W byte */
pmbus_send8(pmdev, pmdev->pages[index].operation);
break;
case PMBUS_ON_OFF_CONFIG: /* R/W byte */
pmbus_send8(pmdev, pmdev->pages[index].on_off_config);
break;
case PMBUS_PHASE: /* R/W byte */
pmbus_send8(pmdev, pmdev->pages[index].phase);
break;
case PMBUS_WRITE_PROTECT: /* R/W byte */
pmbus_send8(pmdev, pmdev->pages[index].write_protect);
break;
case PMBUS_CAPABILITY:
pmbus_send8(pmdev, pmdev->capability);
if (pmdev->capability & BIT(7)) {
qemu_log_mask(LOG_UNIMP,
"%s: PEC is enabled but not yet supported.\n",
__func__);
}
break;
case PMBUS_VOUT_MODE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_MODE) {
pmbus_send8(pmdev, pmdev->pages[index].vout_mode);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_COMMAND: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_command);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_TRIM: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_trim);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_CAL_OFFSET: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_cal_offset);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_MAX: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_max);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_MARGIN_HIGH: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_MARGIN) {
pmbus_send16(pmdev, pmdev->pages[index].vout_margin_high);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_MARGIN_LOW: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_MARGIN) {
pmbus_send16(pmdev, pmdev->pages[index].vout_margin_low);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_TRANSITION_RATE: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_transition_rate);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_DROOP: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_droop);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_SCALE_LOOP: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_scale_loop);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_SCALE_MONITOR: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_scale_monitor);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_MIN: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].vout_min);
} else {
goto passthough;
}
break;
/* TODO: implement coefficients support */
case PMBUS_POUT_MAX: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_POUT) {
pmbus_send16(pmdev, pmdev->pages[index].pout_max);
} else {
goto passthough;
}
break;
case PMBUS_VIN_ON: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmbus_send16(pmdev, pmdev->pages[index].vin_on);
} else {
goto passthough;
}
break;
case PMBUS_VIN_OFF: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmbus_send16(pmdev, pmdev->pages[index].vin_off);
} else {
goto passthough;
}
break;
case PMBUS_IOUT_CAL_GAIN: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT_GAIN) {
pmbus_send16(pmdev, pmdev->pages[index].iout_cal_gain);
} else {
goto passthough;
}
break;
case PMBUS_FAN_CONFIG_1_2: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send8(pmdev, pmdev->pages[index].fan_config_1_2);
} else {
goto passthough;
}
break;
case PMBUS_FAN_COMMAND_1: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].fan_command_1);
} else {
goto passthough;
}
break;
case PMBUS_FAN_COMMAND_2: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].fan_command_2);
} else {
goto passthough;
}
break;
case PMBUS_FAN_CONFIG_3_4: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send8(pmdev, pmdev->pages[index].fan_config_3_4);
} else {
goto passthough;
}
break;
case PMBUS_FAN_COMMAND_3: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].fan_command_3);
} else {
goto passthough;
}
break;
case PMBUS_FAN_COMMAND_4: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].fan_command_4);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_OV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_ov_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_OV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send8(pmdev, pmdev->pages[index].vout_ov_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_OV_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_ov_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_UV_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_uv_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_UV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].vout_uv_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_VOUT_UV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send8(pmdev, pmdev->pages[index].vout_uv_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_IOUT_OC_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmbus_send16(pmdev, pmdev->pages[index].iout_oc_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_IOUT_OC_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmbus_send8(pmdev, pmdev->pages[index].iout_oc_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_IOUT_OC_LV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmbus_send16(pmdev, pmdev->pages[index].iout_oc_lv_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_IOUT_OC_LV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmbus_send8(pmdev, pmdev->pages[index].iout_oc_lv_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_IOUT_OC_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmbus_send16(pmdev, pmdev->pages[index].iout_oc_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_IOUT_UC_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmbus_send16(pmdev, pmdev->pages[index].iout_uc_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_IOUT_UC_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmbus_send8(pmdev, pmdev->pages[index].iout_uc_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_OT_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmbus_send16(pmdev, pmdev->pages[index].ot_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_OT_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmbus_send8(pmdev, pmdev->pages[index].ot_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_OT_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmbus_send16(pmdev, pmdev->pages[index].ot_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_UT_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmbus_send16(pmdev, pmdev->pages[index].ut_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_UT_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmbus_send16(pmdev, pmdev->pages[index].ut_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_UT_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmbus_send8(pmdev, pmdev->pages[index].ut_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_VIN_OV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmbus_send16(pmdev, pmdev->pages[index].vin_ov_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_VIN_OV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmbus_send8(pmdev, pmdev->pages[index].vin_ov_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_VIN_OV_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmbus_send16(pmdev, pmdev->pages[index].vin_ov_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_VIN_UV_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmbus_send16(pmdev, pmdev->pages[index].vin_uv_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_VIN_UV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmbus_send16(pmdev, pmdev->pages[index].vin_uv_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_VIN_UV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmbus_send8(pmdev, pmdev->pages[index].vin_uv_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_IIN_OC_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IIN) {
pmbus_send16(pmdev, pmdev->pages[index].iin_oc_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_IIN_OC_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IIN) {
pmbus_send8(pmdev, pmdev->pages[index].iin_oc_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_IIN_OC_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IIN) {
pmbus_send16(pmdev, pmdev->pages[index].iin_oc_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_POUT_OP_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_POUT) {
pmbus_send16(pmdev, pmdev->pages[index].pout_op_fault_limit);
} else {
goto passthough;
}
break;
case PMBUS_POUT_OP_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_POUT) {
pmbus_send8(pmdev, pmdev->pages[index].pout_op_fault_response);
} else {
goto passthough;
}
break;
case PMBUS_POUT_OP_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_POUT) {
pmbus_send16(pmdev, pmdev->pages[index].pout_op_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_PIN_OP_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_PIN) {
pmbus_send16(pmdev, pmdev->pages[index].pin_op_warn_limit);
} else {
goto passthough;
}
break;
case PMBUS_STATUS_BYTE: /* R/W byte */
pmbus_send8(pmdev, pmdev->pages[index].status_word & 0xFF);
break;
case PMBUS_STATUS_WORD: /* R/W word */
pmbus_send16(pmdev, pmdev->pages[index].status_word);
break;
case PMBUS_STATUS_VOUT: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send8(pmdev, pmdev->pages[index].status_vout);
} else {
goto passthough;
}
break;
case PMBUS_STATUS_IOUT: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmbus_send8(pmdev, pmdev->pages[index].status_iout);
} else {
goto passthough;
}
break;
case PMBUS_STATUS_INPUT: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VIN ||
pmdev->pages[index].page_flags & PB_HAS_IIN ||
pmdev->pages[index].page_flags & PB_HAS_PIN) {
pmbus_send8(pmdev, pmdev->pages[index].status_input);
} else {
goto passthough;
}
break;
case PMBUS_STATUS_TEMPERATURE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmbus_send8(pmdev, pmdev->pages[index].status_temperature);
} else {
goto passthough;
}
break;
case PMBUS_STATUS_CML: /* R/W byte */
pmbus_send8(pmdev, pmdev->pages[index].status_cml);
break;
case PMBUS_STATUS_OTHER: /* R/W byte */
pmbus_send8(pmdev, pmdev->pages[index].status_other);
break;
case PMBUS_STATUS_MFR_SPECIFIC: /* R/W byte */
pmbus_send8(pmdev, pmdev->pages[index].status_mfr_specific);
break;
case PMBUS_STATUS_FANS_1_2: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send8(pmdev, pmdev->pages[index].status_fans_1_2);
} else {
goto passthough;
}
break;
case PMBUS_STATUS_FANS_3_4: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send8(pmdev, pmdev->pages[index].status_fans_3_4);
} else {
goto passthough;
}
break;
case PMBUS_READ_EIN: /* Read-Only block 5 bytes */
if (pmdev->pages[index].page_flags & PB_HAS_EIN) {
pmbus_send(pmdev, pmdev->pages[index].read_ein, 5);
} else {
goto passthough;
}
break;
case PMBUS_READ_EOUT: /* Read-Only block 5 bytes */
if (pmdev->pages[index].page_flags & PB_HAS_EOUT) {
pmbus_send(pmdev, pmdev->pages[index].read_eout, 5);
} else {
goto passthough;
}
break;
case PMBUS_READ_VIN: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmbus_send16(pmdev, pmdev->pages[index].read_vin);
} else {
goto passthough;
}
break;
case PMBUS_READ_IIN: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_IIN) {
pmbus_send16(pmdev, pmdev->pages[index].read_iin);
} else {
goto passthough;
}
break;
case PMBUS_READ_VCAP: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_VCAP) {
pmbus_send16(pmdev, pmdev->pages[index].read_vcap);
} else {
goto passthough;
}
break;
case PMBUS_READ_VOUT: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmbus_send16(pmdev, pmdev->pages[index].read_vout);
} else {
goto passthough;
}
break;
case PMBUS_READ_IOUT: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmbus_send16(pmdev, pmdev->pages[index].read_iout);
} else {
goto passthough;
}
break;
case PMBUS_READ_TEMPERATURE_1: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmbus_send16(pmdev, pmdev->pages[index].read_temperature_1);
} else {
goto passthough;
}
break;
case PMBUS_READ_TEMPERATURE_2: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMP2) {
pmbus_send16(pmdev, pmdev->pages[index].read_temperature_2);
} else {
goto passthough;
}
break;
case PMBUS_READ_TEMPERATURE_3: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMP3) {
pmbus_send16(pmdev, pmdev->pages[index].read_temperature_3);
} else {
goto passthough;
}
break;
case PMBUS_READ_FAN_SPEED_1: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].read_fan_speed_1);
} else {
goto passthough;
}
break;
case PMBUS_READ_FAN_SPEED_2: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].read_fan_speed_2);
} else {
goto passthough;
}
break;
case PMBUS_READ_FAN_SPEED_3: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].read_fan_speed_3);
} else {
goto passthough;
}
break;
case PMBUS_READ_FAN_SPEED_4: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].read_fan_speed_4);
} else {
goto passthough;
}
break;
case PMBUS_READ_DUTY_CYCLE: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].read_duty_cycle);
} else {
goto passthough;
}
break;
case PMBUS_READ_FREQUENCY: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send16(pmdev, pmdev->pages[index].read_frequency);
} else {
goto passthough;
}
break;
case PMBUS_READ_POUT: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_POUT) {
pmbus_send16(pmdev, pmdev->pages[index].read_pout);
} else {
goto passthough;
}
break;
case PMBUS_READ_PIN: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_PIN) {
pmbus_send16(pmdev, pmdev->pages[index].read_pin);
} else {
goto passthough;
}
break;
case PMBUS_REVISION: /* Read-Only byte */
pmbus_send8(pmdev, pmdev->pages[index].revision);
break;
case PMBUS_MFR_ID: /* R/W block */
if (pmdev->pages[index].page_flags & PB_HAS_MFR_INFO) {
pmbus_send_string(pmdev, pmdev->pages[index].mfr_id);
} else {
goto passthough;
}
break;
case PMBUS_MFR_MODEL: /* R/W block */
if (pmdev->pages[index].page_flags & PB_HAS_MFR_INFO) {
pmbus_send_string(pmdev, pmdev->pages[index].mfr_model);
} else {
goto passthough;
}
break;
case PMBUS_MFR_REVISION: /* R/W block */
if (pmdev->pages[index].page_flags & PB_HAS_MFR_INFO) {
pmbus_send_string(pmdev, pmdev->pages[index].mfr_revision);
} else {
goto passthough;
}
break;
case PMBUS_MFR_LOCATION: /* R/W block */
if (pmdev->pages[index].page_flags & PB_HAS_MFR_INFO) {
pmbus_send_string(pmdev, pmdev->pages[index].mfr_location);
} else {
goto passthough;
}
break;
case PMBUS_MFR_VIN_MIN: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_vin_min);
} else {
goto passthough;
}
break;
case PMBUS_MFR_VIN_MAX: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_vin_max);
} else {
goto passthough;
}
break;
case PMBUS_MFR_IIN_MAX: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_IIN_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_iin_max);
} else {
goto passthough;
}
break;
case PMBUS_MFR_PIN_MAX: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_PIN_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_pin_max);
} else {
goto passthough;
}
break;
case PMBUS_MFR_VOUT_MIN: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_vout_min);
} else {
goto passthough;
}
break;
case PMBUS_MFR_VOUT_MAX: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_vout_max);
} else {
goto passthough;
}
break;
case PMBUS_MFR_IOUT_MAX: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_iout_max);
} else {
goto passthough;
}
break;
case PMBUS_MFR_POUT_MAX: /* Read-Only word */
if (pmdev->pages[index].page_flags & PB_HAS_POUT_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_pout_max);
} else {
goto passthough;
}
break;
case PMBUS_MFR_MAX_TEMP_1: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMP_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_max_temp_1);
} else {
goto passthough;
}
break;
case PMBUS_MFR_MAX_TEMP_2: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMP_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_max_temp_2);
} else {
goto passthough;
}
break;
case PMBUS_MFR_MAX_TEMP_3: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMP_RATING) {
pmbus_send16(pmdev, pmdev->pages[index].mfr_max_temp_3);
} else {
goto passthough;
}
break;
case PMBUS_IDLE_STATE:
pmbus_send8(pmdev, PMBUS_ERR_BYTE);
break;
case PMBUS_CLEAR_FAULTS: /* Send Byte */
case PMBUS_PAGE_PLUS_WRITE: /* Block Write-only */
case PMBUS_STORE_DEFAULT_ALL: /* Send Byte */
case PMBUS_RESTORE_DEFAULT_ALL: /* Send Byte */
case PMBUS_STORE_DEFAULT_CODE: /* Write-only Byte */
case PMBUS_RESTORE_DEFAULT_CODE: /* Write-only Byte */
case PMBUS_STORE_USER_ALL: /* Send Byte */
case PMBUS_RESTORE_USER_ALL: /* Send Byte */
case PMBUS_STORE_USER_CODE: /* Write-only Byte */
case PMBUS_RESTORE_USER_CODE: /* Write-only Byte */
case PMBUS_QUERY: /* Write-Only */
qemu_log_mask(LOG_GUEST_ERROR,
"%s: reading from write only register 0x%02x\n",
__func__, pmdev->code);
break;
passthough:
default:
/* Pass through read request if not handled */
if (pmdc->receive_byte) {
ret = pmdc->receive_byte(pmdev);
}
break;
}
if (pmdev->out_buf_len != 0) {
ret = pmbus_out_buf_pop(pmdev);
return ret;
}
return ret;
}
/*
* PMBus clear faults command applies to all status registers, existing faults
* should separately get re-asserted.
*/
static void pmbus_clear_faults(PMBusDevice *pmdev)
{
for (uint8_t i = 0; i < pmdev->num_pages; i++) {
pmdev->pages[i].status_word = 0;
pmdev->pages[i].status_vout = 0;
pmdev->pages[i].status_iout = 0;
pmdev->pages[i].status_input = 0;
pmdev->pages[i].status_temperature = 0;
pmdev->pages[i].status_cml = 0;
pmdev->pages[i].status_other = 0;
pmdev->pages[i].status_mfr_specific = 0;
pmdev->pages[i].status_fans_1_2 = 0;
pmdev->pages[i].status_fans_3_4 = 0;
}
}
/*
* PMBus operation is used to turn On and Off PSUs
* Therefore, default value for the Operation should be PB_OP_ON or 0x80
*/
static void pmbus_operation(PMBusDevice *pmdev)
{
uint8_t index = pmdev->page;
if ((pmdev->pages[index].operation & PB_OP_ON) == 0) {
pmdev->pages[index].read_vout = 0;
pmdev->pages[index].read_iout = 0;
pmdev->pages[index].read_pout = 0;
return;
}
if (pmdev->pages[index].operation & (PB_OP_ON | PB_OP_MARGIN_HIGH)) {
pmdev->pages[index].read_vout = pmdev->pages[index].vout_margin_high;
}
if (pmdev->pages[index].operation & (PB_OP_ON | PB_OP_MARGIN_LOW)) {
pmdev->pages[index].read_vout = pmdev->pages[index].vout_margin_low;
}
pmbus_check_limits(pmdev);
}
static int pmbus_write_data(SMBusDevice *smd, uint8_t *buf, uint8_t len)
{
PMBusDevice *pmdev = PMBUS_DEVICE(smd);
PMBusDeviceClass *pmdc = PMBUS_DEVICE_GET_CLASS(pmdev);
int ret = 0;
uint8_t index;
if (len == 0) {
qemu_log_mask(LOG_GUEST_ERROR, "%s: writing empty data\n", __func__);
return PMBUS_ERR_BYTE;
}
if (!pmdev->pages) { /* allocate memory for pages on first use */
pmbus_pages_alloc(pmdev);
}
pmdev->in_buf_len = len;
pmdev->in_buf = buf;
pmdev->code = buf[0]; /* PMBus command code */
if (pmdev->code == PMBUS_CLEAR_FAULTS) {
pmbus_clear_faults(pmdev);
}
if (len == 1) { /* Single length writes are command codes only */
return 0;
}
if (pmdev->code == PMBUS_PAGE) {
pmdev->page = pmbus_receive8(pmdev);
if (pmdev->page > pmdev->num_pages - 1 && pmdev->page != PB_ALL_PAGES) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: page %u is out of range\n",
__func__, pmdev->page);
pmdev->page = 0; /* undefined behaviour - reset to page 0 */
pmbus_cml_error(pmdev);
return PMBUS_ERR_BYTE;
}
return 0;
}
/* loop through all the pages when 0xFF is received */
if (pmdev->page == PB_ALL_PAGES) {
for (int i = 0; i < pmdev->num_pages; i++) {
pmdev->page = i;
pmbus_write_data(smd, buf, len);
}
pmdev->page = PB_ALL_PAGES;
return 0;
}
index = pmdev->page;
switch (pmdev->code) {
case PMBUS_OPERATION: /* R/W byte */
pmdev->pages[index].operation = pmbus_receive8(pmdev);
pmbus_operation(pmdev);
break;
case PMBUS_ON_OFF_CONFIG: /* R/W byte */
pmdev->pages[index].on_off_config = pmbus_receive8(pmdev);
break;
case PMBUS_CLEAR_FAULTS: /* Send Byte */
pmbus_clear_faults(pmdev);
break;
case PMBUS_PHASE: /* R/W byte */
pmdev->pages[index].phase = pmbus_receive8(pmdev);
break;
case PMBUS_PAGE_PLUS_WRITE: /* Block Write-only */
case PMBUS_WRITE_PROTECT: /* R/W byte */
pmdev->pages[index].write_protect = pmbus_receive8(pmdev);
break;
case PMBUS_VOUT_MODE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_MODE) {
pmdev->pages[index].vout_mode = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_COMMAND: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_command = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_TRIM: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_trim = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_CAL_OFFSET: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_cal_offset = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_MAX: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_max = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_MARGIN_HIGH: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_MARGIN) {
pmdev->pages[index].vout_margin_high = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_MARGIN_LOW: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_MARGIN) {
pmdev->pages[index].vout_margin_low = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_TRANSITION_RATE: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_transition_rate = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_DROOP: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_droop = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_SCALE_LOOP: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_scale_loop = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_SCALE_MONITOR: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_scale_monitor = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_MIN: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT_RATING) {
pmdev->pages[index].vout_min = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_POUT_MAX: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].pout_max = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VIN_ON: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmdev->pages[index].vin_on = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VIN_OFF: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmdev->pages[index].vin_off = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IOUT_CAL_GAIN: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT_GAIN) {
pmdev->pages[index].iout_cal_gain = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_FAN_CONFIG_1_2: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmdev->pages[index].fan_config_1_2 = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_FAN_COMMAND_1: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmdev->pages[index].fan_command_1 = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_FAN_COMMAND_2: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmdev->pages[index].fan_command_2 = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_FAN_CONFIG_3_4: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmdev->pages[index].fan_config_3_4 = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_FAN_COMMAND_3: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmdev->pages[index].fan_command_3 = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_FAN_COMMAND_4: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmdev->pages[index].fan_command_4 = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_OV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_ov_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_OV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_ov_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_OV_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_ov_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_UV_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_uv_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_UV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_uv_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VOUT_UV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].vout_uv_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IOUT_OC_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmdev->pages[index].iout_oc_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IOUT_OC_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmdev->pages[index].iout_oc_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IOUT_OC_LV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmdev->pages[index].iout_oc_lv_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IOUT_OC_LV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmdev->pages[index].iout_oc_lv_fault_response
= pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IOUT_OC_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmdev->pages[index].iout_oc_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IOUT_UC_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmdev->pages[index].iout_uc_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IOUT_UC_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmdev->pages[index].iout_uc_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_OT_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmdev->pages[index].ot_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_OT_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmdev->pages[index].ot_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_OT_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmdev->pages[index].ot_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_UT_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmdev->pages[index].ut_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_UT_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmdev->pages[index].ut_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_UT_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmdev->pages[index].ut_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VIN_OV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmdev->pages[index].vin_ov_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VIN_OV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmdev->pages[index].vin_ov_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VIN_OV_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmdev->pages[index].vin_ov_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VIN_UV_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmdev->pages[index].vin_uv_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VIN_UV_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmdev->pages[index].vin_uv_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_VIN_UV_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VIN) {
pmdev->pages[index].vin_uv_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IIN_OC_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IIN) {
pmdev->pages[index].iin_oc_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IIN_OC_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IIN) {
pmdev->pages[index].iin_oc_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_IIN_OC_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_IIN) {
pmdev->pages[index].iin_oc_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_POUT_OP_FAULT_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].pout_op_fault_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_POUT_OP_FAULT_RESPONSE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].pout_op_fault_response = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_POUT_OP_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].pout_op_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_PIN_OP_WARN_LIMIT: /* R/W word */
if (pmdev->pages[index].page_flags & PB_HAS_PIN) {
pmdev->pages[index].pin_op_warn_limit = pmbus_receive16(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_STATUS_BYTE: /* R/W byte */
pmdev->pages[index].status_word = pmbus_receive8(pmdev);
break;
case PMBUS_STATUS_WORD: /* R/W word */
pmdev->pages[index].status_word = pmbus_receive16(pmdev);
break;
case PMBUS_STATUS_VOUT: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_VOUT) {
pmdev->pages[index].status_vout = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_STATUS_IOUT: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_IOUT) {
pmdev->pages[index].status_iout = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_STATUS_INPUT: /* R/W byte */
pmdev->pages[index].status_input = pmbus_receive8(pmdev);
break;
case PMBUS_STATUS_TEMPERATURE: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_TEMPERATURE) {
pmdev->pages[index].status_temperature = pmbus_receive8(pmdev);
} else {
goto passthrough;
}
break;
case PMBUS_STATUS_CML: /* R/W byte */
pmdev->pages[index].status_cml = pmbus_receive8(pmdev);
break;
case PMBUS_STATUS_OTHER: /* R/W byte */
pmdev->pages[index].status_other = pmbus_receive8(pmdev);
break;
case PMBUS_STATUS_MFR_SPECIFIC: /* R/W byte */
pmdev->pages[index].status_mfr_specific = pmbus_receive8(pmdev);
break;
case PMBUS_STATUS_FANS_1_2: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send8(pmdev, pmdev->pages[index].status_fans_1_2);
} else {
goto passthrough;
}
break;
case PMBUS_STATUS_FANS_3_4: /* R/W byte */
if (pmdev->pages[index].page_flags & PB_HAS_FAN) {
pmbus_send8(pmdev, pmdev->pages[index].status_fans_3_4);
} else {
goto passthrough;
}
break;
case PMBUS_PAGE_PLUS_READ: /* Block Read-only */
case PMBUS_CAPABILITY: /* Read-Only byte */
case PMBUS_COEFFICIENTS: /* Read-only block 5 bytes */
case PMBUS_READ_EIN: /* Read-Only block 5 bytes */
case PMBUS_READ_EOUT: /* Read-Only block 5 bytes */
case PMBUS_READ_VIN: /* Read-Only word */
case PMBUS_READ_IIN: /* Read-Only word */
case PMBUS_READ_VCAP: /* Read-Only word */
case PMBUS_READ_VOUT: /* Read-Only word */
case PMBUS_READ_IOUT: /* Read-Only word */
case PMBUS_READ_TEMPERATURE_1: /* Read-Only word */
case PMBUS_READ_TEMPERATURE_2: /* Read-Only word */
case PMBUS_READ_TEMPERATURE_3: /* Read-Only word */
case PMBUS_READ_FAN_SPEED_1: /* Read-Only word */
case PMBUS_READ_FAN_SPEED_2: /* Read-Only word */
case PMBUS_READ_FAN_SPEED_3: /* Read-Only word */
case PMBUS_READ_FAN_SPEED_4: /* Read-Only word */
case PMBUS_READ_DUTY_CYCLE: /* Read-Only word */
case PMBUS_READ_FREQUENCY: /* Read-Only word */
case PMBUS_READ_POUT: /* Read-Only word */
case PMBUS_READ_PIN: /* Read-Only word */
case PMBUS_REVISION: /* Read-Only byte */
case PMBUS_APP_PROFILE_SUPPORT: /* Read-Only block-read */
case PMBUS_MFR_VIN_MIN: /* Read-Only word */
case PMBUS_MFR_VIN_MAX: /* Read-Only word */
case PMBUS_MFR_IIN_MAX: /* Read-Only word */
case PMBUS_MFR_PIN_MAX: /* Read-Only word */
case PMBUS_MFR_VOUT_MIN: /* Read-Only word */
case PMBUS_MFR_VOUT_MAX: /* Read-Only word */
case PMBUS_MFR_IOUT_MAX: /* Read-Only word */
case PMBUS_MFR_POUT_MAX: /* Read-Only word */
case PMBUS_MFR_TAMBIENT_MAX: /* Read-Only word */
case PMBUS_MFR_TAMBIENT_MIN: /* Read-Only word */
case PMBUS_MFR_EFFICIENCY_LL: /* Read-Only block 14 bytes */
case PMBUS_MFR_EFFICIENCY_HL: /* Read-Only block 14 bytes */
case PMBUS_MFR_PIN_ACCURACY: /* Read-Only byte */
case PMBUS_IC_DEVICE_ID: /* Read-Only block-read */
case PMBUS_IC_DEVICE_REV: /* Read-Only block-read */
qemu_log_mask(LOG_GUEST_ERROR,
"%s: writing to read-only register 0x%02x\n",
__func__, pmdev->code);
break;
passthrough:
/* Unimplemented registers get passed to the device */
default:
if (pmdc->write_data) {
ret = pmdc->write_data(pmdev, buf, len);
}
break;
}
pmbus_check_limits(pmdev);
pmdev->in_buf_len = 0;
return ret;
}
int pmbus_page_config(PMBusDevice *pmdev, uint8_t index, uint64_t flags)
{
if (!pmdev->pages) { /* allocate memory for pages on first use */
pmbus_pages_alloc(pmdev);
}
/* The 0xFF page is special for commands applying to all pages */
if (index == PB_ALL_PAGES) {
for (int i = 0; i < pmdev->num_pages; i++) {
pmdev->pages[i].page_flags = flags;
}
return 0;
}
if (index > pmdev->num_pages - 1) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: index %u is out of range\n",
__func__, index);
return -1;
}
pmdev->pages[index].page_flags = flags;
return 0;
}
/* TODO: include pmbus page info in vmstate */
const VMStateDescription vmstate_pmbus_device = {
.name = TYPE_PMBUS_DEVICE,
.version_id = 0,
.minimum_version_id = 0,
.fields = (VMStateField[]) {
VMSTATE_SMBUS_DEVICE(smb, PMBusDevice),
VMSTATE_UINT8(num_pages, PMBusDevice),
VMSTATE_UINT8(code, PMBusDevice),
VMSTATE_UINT8(page, PMBusDevice),
VMSTATE_UINT8(capability, PMBusDevice),
VMSTATE_END_OF_LIST()
}
};
static void pmbus_device_finalize(Object *obj)
{
PMBusDevice *pmdev = PMBUS_DEVICE(obj);
g_free(pmdev->pages);
}
static void pmbus_device_class_init(ObjectClass *klass, void *data)
{
SMBusDeviceClass *k = SMBUS_DEVICE_CLASS(klass);
k->quick_cmd = pmbus_quick_cmd;
k->write_data = pmbus_write_data;
k->receive_byte = pmbus_receive_byte;
}
static const TypeInfo pmbus_device_type_info = {
.name = TYPE_PMBUS_DEVICE,
.parent = TYPE_SMBUS_DEVICE,
.instance_size = sizeof(PMBusDevice),
.instance_finalize = pmbus_device_finalize,
.abstract = true,
.class_size = sizeof(PMBusDeviceClass),
.class_init = pmbus_device_class_init,
};
static void pmbus_device_register_types(void)
{
type_register_static(&pmbus_device_type_info);
}
type_init(pmbus_device_register_types)
Reference in New Issue View Git Blame Copy Permalink