162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/**************************************************************************** 362306a36Sopenharmony_ci * Driver for Solarflare network controllers and boards 462306a36Sopenharmony_ci * Copyright 2011-2013 Solarflare Communications Inc. 562306a36Sopenharmony_ci */ 662306a36Sopenharmony_ci 762306a36Sopenharmony_ci#include <linux/bitops.h> 862306a36Sopenharmony_ci#include <linux/slab.h> 962306a36Sopenharmony_ci#include <linux/hwmon.h> 1062306a36Sopenharmony_ci#include <linux/stat.h> 1162306a36Sopenharmony_ci 1262306a36Sopenharmony_ci#include "net_driver.h" 1362306a36Sopenharmony_ci#include "mcdi.h" 1462306a36Sopenharmony_ci#include "mcdi_pcol.h" 1562306a36Sopenharmony_ci#include "nic.h" 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_cienum efx_hwmon_type { 1862306a36Sopenharmony_ci EFX_HWMON_UNKNOWN, 1962306a36Sopenharmony_ci EFX_HWMON_TEMP, /* temperature */ 2062306a36Sopenharmony_ci EFX_HWMON_COOL, /* cooling device, probably a heatsink */ 2162306a36Sopenharmony_ci EFX_HWMON_IN, /* voltage */ 2262306a36Sopenharmony_ci EFX_HWMON_CURR, /* current */ 2362306a36Sopenharmony_ci EFX_HWMON_POWER, /* power */ 2462306a36Sopenharmony_ci EFX_HWMON_TYPES_COUNT 2562306a36Sopenharmony_ci}; 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_cistatic const char *const efx_hwmon_unit[EFX_HWMON_TYPES_COUNT] = { 2862306a36Sopenharmony_ci [EFX_HWMON_TEMP] = " degC", 2962306a36Sopenharmony_ci [EFX_HWMON_COOL] = " rpm", /* though nonsense for a heatsink */ 3062306a36Sopenharmony_ci [EFX_HWMON_IN] = " mV", 3162306a36Sopenharmony_ci [EFX_HWMON_CURR] = " mA", 3262306a36Sopenharmony_ci [EFX_HWMON_POWER] = " W", 3362306a36Sopenharmony_ci}; 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_cistatic const struct { 3662306a36Sopenharmony_ci const char *label; 3762306a36Sopenharmony_ci enum efx_hwmon_type hwmon_type; 3862306a36Sopenharmony_ci int port; 3962306a36Sopenharmony_ci} efx_mcdi_sensor_type[] = { 4062306a36Sopenharmony_ci#define SENSOR(name, label, hwmon_type, port) \ 4162306a36Sopenharmony_ci [MC_CMD_SENSOR_##name] = { label, EFX_HWMON_ ## hwmon_type, port } 4262306a36Sopenharmony_ci SENSOR(CONTROLLER_TEMP, "Controller board temp.", TEMP, -1), 4362306a36Sopenharmony_ci SENSOR(PHY_COMMON_TEMP, "PHY temp.", TEMP, -1), 4462306a36Sopenharmony_ci SENSOR(CONTROLLER_COOLING, "Controller heat sink", COOL, -1), 4562306a36Sopenharmony_ci SENSOR(PHY0_TEMP, "PHY temp.", TEMP, 0), 4662306a36Sopenharmony_ci SENSOR(PHY0_COOLING, "PHY heat sink", COOL, 0), 4762306a36Sopenharmony_ci SENSOR(PHY1_TEMP, "PHY temp.", TEMP, 1), 4862306a36Sopenharmony_ci SENSOR(PHY1_COOLING, "PHY heat sink", COOL, 1), 4962306a36Sopenharmony_ci SENSOR(IN_1V0, "1.0V supply", IN, -1), 5062306a36Sopenharmony_ci SENSOR(IN_1V2, "1.2V supply", IN, -1), 5162306a36Sopenharmony_ci SENSOR(IN_1V8, "1.8V supply", IN, -1), 5262306a36Sopenharmony_ci SENSOR(IN_2V5, "2.5V supply", IN, -1), 5362306a36Sopenharmony_ci SENSOR(IN_3V3, "3.3V supply", IN, -1), 5462306a36Sopenharmony_ci SENSOR(IN_12V0, "12.0V supply", IN, -1), 5562306a36Sopenharmony_ci SENSOR(IN_1V2A, "1.2V analogue supply", IN, -1), 5662306a36Sopenharmony_ci SENSOR(IN_VREF, "Ref. voltage", IN, -1), 5762306a36Sopenharmony_ci SENSOR(OUT_VAOE, "AOE FPGA supply", IN, -1), 5862306a36Sopenharmony_ci SENSOR(AOE_TEMP, "AOE FPGA temp.", TEMP, -1), 5962306a36Sopenharmony_ci SENSOR(PSU_AOE_TEMP, "AOE regulator temp.", TEMP, -1), 6062306a36Sopenharmony_ci SENSOR(PSU_TEMP, "Controller regulator temp.", 6162306a36Sopenharmony_ci TEMP, -1), 6262306a36Sopenharmony_ci SENSOR(FAN_0, "Fan 0", COOL, -1), 6362306a36Sopenharmony_ci SENSOR(FAN_1, "Fan 1", COOL, -1), 6462306a36Sopenharmony_ci SENSOR(FAN_2, "Fan 2", COOL, -1), 6562306a36Sopenharmony_ci SENSOR(FAN_3, "Fan 3", COOL, -1), 6662306a36Sopenharmony_ci SENSOR(FAN_4, "Fan 4", COOL, -1), 6762306a36Sopenharmony_ci SENSOR(IN_VAOE, "AOE input supply", IN, -1), 6862306a36Sopenharmony_ci SENSOR(OUT_IAOE, "AOE output current", CURR, -1), 6962306a36Sopenharmony_ci SENSOR(IN_IAOE, "AOE input current", CURR, -1), 7062306a36Sopenharmony_ci SENSOR(NIC_POWER, "Board power use", POWER, -1), 7162306a36Sopenharmony_ci SENSOR(IN_0V9, "0.9V supply", IN, -1), 7262306a36Sopenharmony_ci SENSOR(IN_I0V9, "0.9V supply current", CURR, -1), 7362306a36Sopenharmony_ci SENSOR(IN_I1V2, "1.2V supply current", CURR, -1), 7462306a36Sopenharmony_ci SENSOR(IN_0V9_ADC, "0.9V supply (ext. ADC)", IN, -1), 7562306a36Sopenharmony_ci SENSOR(CONTROLLER_2_TEMP, "Controller board temp. 2", TEMP, -1), 7662306a36Sopenharmony_ci SENSOR(VREG_INTERNAL_TEMP, "Regulator die temp.", TEMP, -1), 7762306a36Sopenharmony_ci SENSOR(VREG_0V9_TEMP, "0.9V regulator temp.", TEMP, -1), 7862306a36Sopenharmony_ci SENSOR(VREG_1V2_TEMP, "1.2V regulator temp.", TEMP, -1), 7962306a36Sopenharmony_ci SENSOR(CONTROLLER_VPTAT, 8062306a36Sopenharmony_ci "Controller PTAT voltage (int. ADC)", IN, -1), 8162306a36Sopenharmony_ci SENSOR(CONTROLLER_INTERNAL_TEMP, 8262306a36Sopenharmony_ci "Controller die temp. (int. ADC)", TEMP, -1), 8362306a36Sopenharmony_ci SENSOR(CONTROLLER_VPTAT_EXTADC, 8462306a36Sopenharmony_ci "Controller PTAT voltage (ext. ADC)", IN, -1), 8562306a36Sopenharmony_ci SENSOR(CONTROLLER_INTERNAL_TEMP_EXTADC, 8662306a36Sopenharmony_ci "Controller die temp. (ext. ADC)", TEMP, -1), 8762306a36Sopenharmony_ci SENSOR(AMBIENT_TEMP, "Ambient temp.", TEMP, -1), 8862306a36Sopenharmony_ci SENSOR(AIRFLOW, "Air flow raw", IN, -1), 8962306a36Sopenharmony_ci SENSOR(VDD08D_VSS08D_CSR, "0.9V die (int. ADC)", IN, -1), 9062306a36Sopenharmony_ci SENSOR(VDD08D_VSS08D_CSR_EXTADC, "0.9V die (ext. ADC)", IN, -1), 9162306a36Sopenharmony_ci SENSOR(HOTPOINT_TEMP, "Controller board temp. (hotpoint)", TEMP, -1), 9262306a36Sopenharmony_ci#undef SENSOR 9362306a36Sopenharmony_ci}; 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_cistatic const char *const sensor_status_names[] = { 9662306a36Sopenharmony_ci [MC_CMD_SENSOR_STATE_OK] = "OK", 9762306a36Sopenharmony_ci [MC_CMD_SENSOR_STATE_WARNING] = "Warning", 9862306a36Sopenharmony_ci [MC_CMD_SENSOR_STATE_FATAL] = "Fatal", 9962306a36Sopenharmony_ci [MC_CMD_SENSOR_STATE_BROKEN] = "Device failure", 10062306a36Sopenharmony_ci [MC_CMD_SENSOR_STATE_NO_READING] = "No reading", 10162306a36Sopenharmony_ci}; 10262306a36Sopenharmony_ci 10362306a36Sopenharmony_civoid efx_siena_mcdi_sensor_event(struct efx_nic *efx, efx_qword_t *ev) 10462306a36Sopenharmony_ci{ 10562306a36Sopenharmony_ci unsigned int type, state, value; 10662306a36Sopenharmony_ci enum efx_hwmon_type hwmon_type = EFX_HWMON_UNKNOWN; 10762306a36Sopenharmony_ci const char *name = NULL, *state_txt, *unit; 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_ci type = EFX_QWORD_FIELD(*ev, MCDI_EVENT_SENSOREVT_MONITOR); 11062306a36Sopenharmony_ci state = EFX_QWORD_FIELD(*ev, MCDI_EVENT_SENSOREVT_STATE); 11162306a36Sopenharmony_ci value = EFX_QWORD_FIELD(*ev, MCDI_EVENT_SENSOREVT_VALUE); 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_ci /* Deal gracefully with the board having more drivers than we 11462306a36Sopenharmony_ci * know about, but do not expect new sensor states. */ 11562306a36Sopenharmony_ci if (type < ARRAY_SIZE(efx_mcdi_sensor_type)) { 11662306a36Sopenharmony_ci name = efx_mcdi_sensor_type[type].label; 11762306a36Sopenharmony_ci hwmon_type = efx_mcdi_sensor_type[type].hwmon_type; 11862306a36Sopenharmony_ci } 11962306a36Sopenharmony_ci if (!name) 12062306a36Sopenharmony_ci name = "No sensor name available"; 12162306a36Sopenharmony_ci EFX_WARN_ON_PARANOID(state >= ARRAY_SIZE(sensor_status_names)); 12262306a36Sopenharmony_ci state_txt = sensor_status_names[state]; 12362306a36Sopenharmony_ci EFX_WARN_ON_PARANOID(hwmon_type >= EFX_HWMON_TYPES_COUNT); 12462306a36Sopenharmony_ci unit = efx_hwmon_unit[hwmon_type]; 12562306a36Sopenharmony_ci if (!unit) 12662306a36Sopenharmony_ci unit = ""; 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_ci netif_err(efx, hw, efx->net_dev, 12962306a36Sopenharmony_ci "Sensor %d (%s) reports condition '%s' for value %d%s\n", 13062306a36Sopenharmony_ci type, name, state_txt, value, unit); 13162306a36Sopenharmony_ci} 13262306a36Sopenharmony_ci 13362306a36Sopenharmony_ci#ifdef CONFIG_SFC_SIENA_MCDI_MON 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_cistruct efx_mcdi_mon_attribute { 13662306a36Sopenharmony_ci struct device_attribute dev_attr; 13762306a36Sopenharmony_ci unsigned int index; 13862306a36Sopenharmony_ci unsigned int type; 13962306a36Sopenharmony_ci enum efx_hwmon_type hwmon_type; 14062306a36Sopenharmony_ci unsigned int limit_value; 14162306a36Sopenharmony_ci char name[12]; 14262306a36Sopenharmony_ci}; 14362306a36Sopenharmony_ci 14462306a36Sopenharmony_cistatic int efx_mcdi_mon_update(struct efx_nic *efx) 14562306a36Sopenharmony_ci{ 14662306a36Sopenharmony_ci struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); 14762306a36Sopenharmony_ci MCDI_DECLARE_BUF(inbuf, MC_CMD_READ_SENSORS_EXT_IN_LEN); 14862306a36Sopenharmony_ci int rc; 14962306a36Sopenharmony_ci 15062306a36Sopenharmony_ci MCDI_SET_QWORD(inbuf, READ_SENSORS_EXT_IN_DMA_ADDR, 15162306a36Sopenharmony_ci hwmon->dma_buf.dma_addr); 15262306a36Sopenharmony_ci MCDI_SET_DWORD(inbuf, READ_SENSORS_EXT_IN_LENGTH, hwmon->dma_buf.len); 15362306a36Sopenharmony_ci 15462306a36Sopenharmony_ci rc = efx_siena_mcdi_rpc(efx, MC_CMD_READ_SENSORS, 15562306a36Sopenharmony_ci inbuf, sizeof(inbuf), NULL, 0, NULL); 15662306a36Sopenharmony_ci if (rc == 0) 15762306a36Sopenharmony_ci hwmon->last_update = jiffies; 15862306a36Sopenharmony_ci return rc; 15962306a36Sopenharmony_ci} 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_cistatic int efx_mcdi_mon_get_entry(struct device *dev, unsigned int index, 16262306a36Sopenharmony_ci efx_dword_t *entry) 16362306a36Sopenharmony_ci{ 16462306a36Sopenharmony_ci struct efx_nic *efx = dev_get_drvdata(dev->parent); 16562306a36Sopenharmony_ci struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); 16662306a36Sopenharmony_ci int rc; 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci BUILD_BUG_ON(MC_CMD_READ_SENSORS_OUT_LEN != 0); 16962306a36Sopenharmony_ci 17062306a36Sopenharmony_ci mutex_lock(&hwmon->update_lock); 17162306a36Sopenharmony_ci 17262306a36Sopenharmony_ci /* Use cached value if last update was < 1 s ago */ 17362306a36Sopenharmony_ci if (time_before(jiffies, hwmon->last_update + HZ)) 17462306a36Sopenharmony_ci rc = 0; 17562306a36Sopenharmony_ci else 17662306a36Sopenharmony_ci rc = efx_mcdi_mon_update(efx); 17762306a36Sopenharmony_ci 17862306a36Sopenharmony_ci /* Copy out the requested entry */ 17962306a36Sopenharmony_ci *entry = ((efx_dword_t *)hwmon->dma_buf.addr)[index]; 18062306a36Sopenharmony_ci 18162306a36Sopenharmony_ci mutex_unlock(&hwmon->update_lock); 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_ci return rc; 18462306a36Sopenharmony_ci} 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_cistatic ssize_t efx_mcdi_mon_show_value(struct device *dev, 18762306a36Sopenharmony_ci struct device_attribute *attr, 18862306a36Sopenharmony_ci char *buf) 18962306a36Sopenharmony_ci{ 19062306a36Sopenharmony_ci struct efx_mcdi_mon_attribute *mon_attr = 19162306a36Sopenharmony_ci container_of(attr, struct efx_mcdi_mon_attribute, dev_attr); 19262306a36Sopenharmony_ci efx_dword_t entry; 19362306a36Sopenharmony_ci unsigned int value, state; 19462306a36Sopenharmony_ci int rc; 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ci rc = efx_mcdi_mon_get_entry(dev, mon_attr->index, &entry); 19762306a36Sopenharmony_ci if (rc) 19862306a36Sopenharmony_ci return rc; 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_ci state = EFX_DWORD_FIELD(entry, MC_CMD_SENSOR_VALUE_ENTRY_TYPEDEF_STATE); 20162306a36Sopenharmony_ci if (state == MC_CMD_SENSOR_STATE_NO_READING) 20262306a36Sopenharmony_ci return -EBUSY; 20362306a36Sopenharmony_ci 20462306a36Sopenharmony_ci value = EFX_DWORD_FIELD(entry, MC_CMD_SENSOR_VALUE_ENTRY_TYPEDEF_VALUE); 20562306a36Sopenharmony_ci 20662306a36Sopenharmony_ci switch (mon_attr->hwmon_type) { 20762306a36Sopenharmony_ci case EFX_HWMON_TEMP: 20862306a36Sopenharmony_ci /* Convert temperature from degrees to milli-degrees Celsius */ 20962306a36Sopenharmony_ci value *= 1000; 21062306a36Sopenharmony_ci break; 21162306a36Sopenharmony_ci case EFX_HWMON_POWER: 21262306a36Sopenharmony_ci /* Convert power from watts to microwatts */ 21362306a36Sopenharmony_ci value *= 1000000; 21462306a36Sopenharmony_ci break; 21562306a36Sopenharmony_ci default: 21662306a36Sopenharmony_ci /* No conversion needed */ 21762306a36Sopenharmony_ci break; 21862306a36Sopenharmony_ci } 21962306a36Sopenharmony_ci 22062306a36Sopenharmony_ci return sprintf(buf, "%u\n", value); 22162306a36Sopenharmony_ci} 22262306a36Sopenharmony_ci 22362306a36Sopenharmony_cistatic ssize_t efx_mcdi_mon_show_limit(struct device *dev, 22462306a36Sopenharmony_ci struct device_attribute *attr, 22562306a36Sopenharmony_ci char *buf) 22662306a36Sopenharmony_ci{ 22762306a36Sopenharmony_ci struct efx_mcdi_mon_attribute *mon_attr = 22862306a36Sopenharmony_ci container_of(attr, struct efx_mcdi_mon_attribute, dev_attr); 22962306a36Sopenharmony_ci unsigned int value; 23062306a36Sopenharmony_ci 23162306a36Sopenharmony_ci value = mon_attr->limit_value; 23262306a36Sopenharmony_ci 23362306a36Sopenharmony_ci switch (mon_attr->hwmon_type) { 23462306a36Sopenharmony_ci case EFX_HWMON_TEMP: 23562306a36Sopenharmony_ci /* Convert temperature from degrees to milli-degrees Celsius */ 23662306a36Sopenharmony_ci value *= 1000; 23762306a36Sopenharmony_ci break; 23862306a36Sopenharmony_ci case EFX_HWMON_POWER: 23962306a36Sopenharmony_ci /* Convert power from watts to microwatts */ 24062306a36Sopenharmony_ci value *= 1000000; 24162306a36Sopenharmony_ci break; 24262306a36Sopenharmony_ci default: 24362306a36Sopenharmony_ci /* No conversion needed */ 24462306a36Sopenharmony_ci break; 24562306a36Sopenharmony_ci } 24662306a36Sopenharmony_ci 24762306a36Sopenharmony_ci return sprintf(buf, "%u\n", value); 24862306a36Sopenharmony_ci} 24962306a36Sopenharmony_ci 25062306a36Sopenharmony_cistatic ssize_t efx_mcdi_mon_show_alarm(struct device *dev, 25162306a36Sopenharmony_ci struct device_attribute *attr, 25262306a36Sopenharmony_ci char *buf) 25362306a36Sopenharmony_ci{ 25462306a36Sopenharmony_ci struct efx_mcdi_mon_attribute *mon_attr = 25562306a36Sopenharmony_ci container_of(attr, struct efx_mcdi_mon_attribute, dev_attr); 25662306a36Sopenharmony_ci efx_dword_t entry; 25762306a36Sopenharmony_ci int state; 25862306a36Sopenharmony_ci int rc; 25962306a36Sopenharmony_ci 26062306a36Sopenharmony_ci rc = efx_mcdi_mon_get_entry(dev, mon_attr->index, &entry); 26162306a36Sopenharmony_ci if (rc) 26262306a36Sopenharmony_ci return rc; 26362306a36Sopenharmony_ci 26462306a36Sopenharmony_ci state = EFX_DWORD_FIELD(entry, MC_CMD_SENSOR_VALUE_ENTRY_TYPEDEF_STATE); 26562306a36Sopenharmony_ci return sprintf(buf, "%d\n", state != MC_CMD_SENSOR_STATE_OK); 26662306a36Sopenharmony_ci} 26762306a36Sopenharmony_ci 26862306a36Sopenharmony_cistatic ssize_t efx_mcdi_mon_show_label(struct device *dev, 26962306a36Sopenharmony_ci struct device_attribute *attr, 27062306a36Sopenharmony_ci char *buf) 27162306a36Sopenharmony_ci{ 27262306a36Sopenharmony_ci struct efx_mcdi_mon_attribute *mon_attr = 27362306a36Sopenharmony_ci container_of(attr, struct efx_mcdi_mon_attribute, dev_attr); 27462306a36Sopenharmony_ci return sprintf(buf, "%s\n", 27562306a36Sopenharmony_ci efx_mcdi_sensor_type[mon_attr->type].label); 27662306a36Sopenharmony_ci} 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_cistatic void 27962306a36Sopenharmony_ciefx_mcdi_mon_add_attr(struct efx_nic *efx, const char *name, 28062306a36Sopenharmony_ci ssize_t (*reader)(struct device *, 28162306a36Sopenharmony_ci struct device_attribute *, char *), 28262306a36Sopenharmony_ci unsigned int index, unsigned int type, 28362306a36Sopenharmony_ci unsigned int limit_value) 28462306a36Sopenharmony_ci{ 28562306a36Sopenharmony_ci struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); 28662306a36Sopenharmony_ci struct efx_mcdi_mon_attribute *attr = &hwmon->attrs[hwmon->n_attrs]; 28762306a36Sopenharmony_ci 28862306a36Sopenharmony_ci strscpy(attr->name, name, sizeof(attr->name)); 28962306a36Sopenharmony_ci attr->index = index; 29062306a36Sopenharmony_ci attr->type = type; 29162306a36Sopenharmony_ci if (type < ARRAY_SIZE(efx_mcdi_sensor_type)) 29262306a36Sopenharmony_ci attr->hwmon_type = efx_mcdi_sensor_type[type].hwmon_type; 29362306a36Sopenharmony_ci else 29462306a36Sopenharmony_ci attr->hwmon_type = EFX_HWMON_UNKNOWN; 29562306a36Sopenharmony_ci attr->limit_value = limit_value; 29662306a36Sopenharmony_ci sysfs_attr_init(&attr->dev_attr.attr); 29762306a36Sopenharmony_ci attr->dev_attr.attr.name = attr->name; 29862306a36Sopenharmony_ci attr->dev_attr.attr.mode = 0444; 29962306a36Sopenharmony_ci attr->dev_attr.show = reader; 30062306a36Sopenharmony_ci hwmon->group.attrs[hwmon->n_attrs++] = &attr->dev_attr.attr; 30162306a36Sopenharmony_ci} 30262306a36Sopenharmony_ci 30362306a36Sopenharmony_ciint efx_siena_mcdi_mon_probe(struct efx_nic *efx) 30462306a36Sopenharmony_ci{ 30562306a36Sopenharmony_ci unsigned int n_temp = 0, n_cool = 0, n_in = 0, n_curr = 0, n_power = 0; 30662306a36Sopenharmony_ci struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); 30762306a36Sopenharmony_ci MCDI_DECLARE_BUF(inbuf, MC_CMD_SENSOR_INFO_EXT_IN_LEN); 30862306a36Sopenharmony_ci MCDI_DECLARE_BUF(outbuf, MC_CMD_SENSOR_INFO_OUT_LENMAX); 30962306a36Sopenharmony_ci unsigned int n_pages, n_sensors, n_attrs, page; 31062306a36Sopenharmony_ci size_t outlen; 31162306a36Sopenharmony_ci char name[12]; 31262306a36Sopenharmony_ci u32 mask; 31362306a36Sopenharmony_ci int rc, i, j, type; 31462306a36Sopenharmony_ci 31562306a36Sopenharmony_ci /* Find out how many sensors are present */ 31662306a36Sopenharmony_ci n_sensors = 0; 31762306a36Sopenharmony_ci page = 0; 31862306a36Sopenharmony_ci do { 31962306a36Sopenharmony_ci MCDI_SET_DWORD(inbuf, SENSOR_INFO_EXT_IN_PAGE, page); 32062306a36Sopenharmony_ci 32162306a36Sopenharmony_ci rc = efx_siena_mcdi_rpc(efx, MC_CMD_SENSOR_INFO, inbuf, 32262306a36Sopenharmony_ci sizeof(inbuf), outbuf, sizeof(outbuf), 32362306a36Sopenharmony_ci &outlen); 32462306a36Sopenharmony_ci if (rc) 32562306a36Sopenharmony_ci return rc; 32662306a36Sopenharmony_ci if (outlen < MC_CMD_SENSOR_INFO_OUT_LENMIN) 32762306a36Sopenharmony_ci return -EIO; 32862306a36Sopenharmony_ci 32962306a36Sopenharmony_ci mask = MCDI_DWORD(outbuf, SENSOR_INFO_OUT_MASK); 33062306a36Sopenharmony_ci n_sensors += hweight32(mask & ~(1 << MC_CMD_SENSOR_PAGE0_NEXT)); 33162306a36Sopenharmony_ci ++page; 33262306a36Sopenharmony_ci } while (mask & (1 << MC_CMD_SENSOR_PAGE0_NEXT)); 33362306a36Sopenharmony_ci n_pages = page; 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci /* Don't create a device if there are none */ 33662306a36Sopenharmony_ci if (n_sensors == 0) 33762306a36Sopenharmony_ci return 0; 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci rc = efx_siena_alloc_buffer(efx, &hwmon->dma_buf, 34062306a36Sopenharmony_ci n_sensors * MC_CMD_SENSOR_VALUE_ENTRY_TYPEDEF_LEN, 34162306a36Sopenharmony_ci GFP_KERNEL); 34262306a36Sopenharmony_ci if (rc) 34362306a36Sopenharmony_ci return rc; 34462306a36Sopenharmony_ci 34562306a36Sopenharmony_ci mutex_init(&hwmon->update_lock); 34662306a36Sopenharmony_ci efx_mcdi_mon_update(efx); 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_ci /* Allocate space for the maximum possible number of 34962306a36Sopenharmony_ci * attributes for this set of sensors: 35062306a36Sopenharmony_ci * value, min, max, crit, alarm and label for each sensor. 35162306a36Sopenharmony_ci */ 35262306a36Sopenharmony_ci n_attrs = 6 * n_sensors; 35362306a36Sopenharmony_ci hwmon->attrs = kcalloc(n_attrs, sizeof(*hwmon->attrs), GFP_KERNEL); 35462306a36Sopenharmony_ci if (!hwmon->attrs) { 35562306a36Sopenharmony_ci rc = -ENOMEM; 35662306a36Sopenharmony_ci goto fail; 35762306a36Sopenharmony_ci } 35862306a36Sopenharmony_ci hwmon->group.attrs = kcalloc(n_attrs + 1, sizeof(struct attribute *), 35962306a36Sopenharmony_ci GFP_KERNEL); 36062306a36Sopenharmony_ci if (!hwmon->group.attrs) { 36162306a36Sopenharmony_ci rc = -ENOMEM; 36262306a36Sopenharmony_ci goto fail; 36362306a36Sopenharmony_ci } 36462306a36Sopenharmony_ci 36562306a36Sopenharmony_ci for (i = 0, j = -1, type = -1; ; i++) { 36662306a36Sopenharmony_ci enum efx_hwmon_type hwmon_type; 36762306a36Sopenharmony_ci const char *hwmon_prefix; 36862306a36Sopenharmony_ci unsigned hwmon_index; 36962306a36Sopenharmony_ci u16 min1, max1, min2, max2; 37062306a36Sopenharmony_ci 37162306a36Sopenharmony_ci /* Find next sensor type or exit if there is none */ 37262306a36Sopenharmony_ci do { 37362306a36Sopenharmony_ci type++; 37462306a36Sopenharmony_ci 37562306a36Sopenharmony_ci if ((type % 32) == 0) { 37662306a36Sopenharmony_ci page = type / 32; 37762306a36Sopenharmony_ci j = -1; 37862306a36Sopenharmony_ci if (page == n_pages) 37962306a36Sopenharmony_ci goto hwmon_register; 38062306a36Sopenharmony_ci 38162306a36Sopenharmony_ci MCDI_SET_DWORD(inbuf, SENSOR_INFO_EXT_IN_PAGE, 38262306a36Sopenharmony_ci page); 38362306a36Sopenharmony_ci rc = efx_siena_mcdi_rpc(efx, MC_CMD_SENSOR_INFO, 38462306a36Sopenharmony_ci inbuf, sizeof(inbuf), 38562306a36Sopenharmony_ci outbuf, sizeof(outbuf), 38662306a36Sopenharmony_ci &outlen); 38762306a36Sopenharmony_ci if (rc) 38862306a36Sopenharmony_ci goto fail; 38962306a36Sopenharmony_ci if (outlen < MC_CMD_SENSOR_INFO_OUT_LENMIN) { 39062306a36Sopenharmony_ci rc = -EIO; 39162306a36Sopenharmony_ci goto fail; 39262306a36Sopenharmony_ci } 39362306a36Sopenharmony_ci 39462306a36Sopenharmony_ci mask = (MCDI_DWORD(outbuf, 39562306a36Sopenharmony_ci SENSOR_INFO_OUT_MASK) & 39662306a36Sopenharmony_ci ~(1 << MC_CMD_SENSOR_PAGE0_NEXT)); 39762306a36Sopenharmony_ci 39862306a36Sopenharmony_ci /* Check again for short response */ 39962306a36Sopenharmony_ci if (outlen < 40062306a36Sopenharmony_ci MC_CMD_SENSOR_INFO_OUT_LEN(hweight32(mask))) { 40162306a36Sopenharmony_ci rc = -EIO; 40262306a36Sopenharmony_ci goto fail; 40362306a36Sopenharmony_ci } 40462306a36Sopenharmony_ci } 40562306a36Sopenharmony_ci } while (!(mask & (1 << type % 32))); 40662306a36Sopenharmony_ci j++; 40762306a36Sopenharmony_ci 40862306a36Sopenharmony_ci if (type < ARRAY_SIZE(efx_mcdi_sensor_type)) { 40962306a36Sopenharmony_ci hwmon_type = efx_mcdi_sensor_type[type].hwmon_type; 41062306a36Sopenharmony_ci 41162306a36Sopenharmony_ci /* Skip sensors specific to a different port */ 41262306a36Sopenharmony_ci if (hwmon_type != EFX_HWMON_UNKNOWN && 41362306a36Sopenharmony_ci efx_mcdi_sensor_type[type].port >= 0 && 41462306a36Sopenharmony_ci efx_mcdi_sensor_type[type].port != 41562306a36Sopenharmony_ci efx_port_num(efx)) 41662306a36Sopenharmony_ci continue; 41762306a36Sopenharmony_ci } else { 41862306a36Sopenharmony_ci hwmon_type = EFX_HWMON_UNKNOWN; 41962306a36Sopenharmony_ci } 42062306a36Sopenharmony_ci 42162306a36Sopenharmony_ci switch (hwmon_type) { 42262306a36Sopenharmony_ci case EFX_HWMON_TEMP: 42362306a36Sopenharmony_ci hwmon_prefix = "temp"; 42462306a36Sopenharmony_ci hwmon_index = ++n_temp; /* 1-based */ 42562306a36Sopenharmony_ci break; 42662306a36Sopenharmony_ci case EFX_HWMON_COOL: 42762306a36Sopenharmony_ci /* This is likely to be a heatsink, but there 42862306a36Sopenharmony_ci * is no convention for representing cooling 42962306a36Sopenharmony_ci * devices other than fans. 43062306a36Sopenharmony_ci */ 43162306a36Sopenharmony_ci hwmon_prefix = "fan"; 43262306a36Sopenharmony_ci hwmon_index = ++n_cool; /* 1-based */ 43362306a36Sopenharmony_ci break; 43462306a36Sopenharmony_ci default: 43562306a36Sopenharmony_ci hwmon_prefix = "in"; 43662306a36Sopenharmony_ci hwmon_index = n_in++; /* 0-based */ 43762306a36Sopenharmony_ci break; 43862306a36Sopenharmony_ci case EFX_HWMON_CURR: 43962306a36Sopenharmony_ci hwmon_prefix = "curr"; 44062306a36Sopenharmony_ci hwmon_index = ++n_curr; /* 1-based */ 44162306a36Sopenharmony_ci break; 44262306a36Sopenharmony_ci case EFX_HWMON_POWER: 44362306a36Sopenharmony_ci hwmon_prefix = "power"; 44462306a36Sopenharmony_ci hwmon_index = ++n_power; /* 1-based */ 44562306a36Sopenharmony_ci break; 44662306a36Sopenharmony_ci } 44762306a36Sopenharmony_ci 44862306a36Sopenharmony_ci min1 = MCDI_ARRAY_FIELD(outbuf, SENSOR_ENTRY, 44962306a36Sopenharmony_ci SENSOR_INFO_ENTRY, j, MIN1); 45062306a36Sopenharmony_ci max1 = MCDI_ARRAY_FIELD(outbuf, SENSOR_ENTRY, 45162306a36Sopenharmony_ci SENSOR_INFO_ENTRY, j, MAX1); 45262306a36Sopenharmony_ci min2 = MCDI_ARRAY_FIELD(outbuf, SENSOR_ENTRY, 45362306a36Sopenharmony_ci SENSOR_INFO_ENTRY, j, MIN2); 45462306a36Sopenharmony_ci max2 = MCDI_ARRAY_FIELD(outbuf, SENSOR_ENTRY, 45562306a36Sopenharmony_ci SENSOR_INFO_ENTRY, j, MAX2); 45662306a36Sopenharmony_ci 45762306a36Sopenharmony_ci if (min1 != max1) { 45862306a36Sopenharmony_ci snprintf(name, sizeof(name), "%s%u_input", 45962306a36Sopenharmony_ci hwmon_prefix, hwmon_index); 46062306a36Sopenharmony_ci efx_mcdi_mon_add_attr( 46162306a36Sopenharmony_ci efx, name, efx_mcdi_mon_show_value, i, type, 0); 46262306a36Sopenharmony_ci 46362306a36Sopenharmony_ci if (hwmon_type != EFX_HWMON_POWER) { 46462306a36Sopenharmony_ci snprintf(name, sizeof(name), "%s%u_min", 46562306a36Sopenharmony_ci hwmon_prefix, hwmon_index); 46662306a36Sopenharmony_ci efx_mcdi_mon_add_attr( 46762306a36Sopenharmony_ci efx, name, efx_mcdi_mon_show_limit, 46862306a36Sopenharmony_ci i, type, min1); 46962306a36Sopenharmony_ci } 47062306a36Sopenharmony_ci 47162306a36Sopenharmony_ci snprintf(name, sizeof(name), "%s%u_max", 47262306a36Sopenharmony_ci hwmon_prefix, hwmon_index); 47362306a36Sopenharmony_ci efx_mcdi_mon_add_attr( 47462306a36Sopenharmony_ci efx, name, efx_mcdi_mon_show_limit, 47562306a36Sopenharmony_ci i, type, max1); 47662306a36Sopenharmony_ci 47762306a36Sopenharmony_ci if (min2 != max2) { 47862306a36Sopenharmony_ci /* Assume max2 is critical value. 47962306a36Sopenharmony_ci * But we have no good way to expose min2. 48062306a36Sopenharmony_ci */ 48162306a36Sopenharmony_ci snprintf(name, sizeof(name), "%s%u_crit", 48262306a36Sopenharmony_ci hwmon_prefix, hwmon_index); 48362306a36Sopenharmony_ci efx_mcdi_mon_add_attr( 48462306a36Sopenharmony_ci efx, name, efx_mcdi_mon_show_limit, 48562306a36Sopenharmony_ci i, type, max2); 48662306a36Sopenharmony_ci } 48762306a36Sopenharmony_ci } 48862306a36Sopenharmony_ci 48962306a36Sopenharmony_ci snprintf(name, sizeof(name), "%s%u_alarm", 49062306a36Sopenharmony_ci hwmon_prefix, hwmon_index); 49162306a36Sopenharmony_ci efx_mcdi_mon_add_attr( 49262306a36Sopenharmony_ci efx, name, efx_mcdi_mon_show_alarm, i, type, 0); 49362306a36Sopenharmony_ci 49462306a36Sopenharmony_ci if (type < ARRAY_SIZE(efx_mcdi_sensor_type) && 49562306a36Sopenharmony_ci efx_mcdi_sensor_type[type].label) { 49662306a36Sopenharmony_ci snprintf(name, sizeof(name), "%s%u_label", 49762306a36Sopenharmony_ci hwmon_prefix, hwmon_index); 49862306a36Sopenharmony_ci efx_mcdi_mon_add_attr( 49962306a36Sopenharmony_ci efx, name, efx_mcdi_mon_show_label, i, type, 0); 50062306a36Sopenharmony_ci } 50162306a36Sopenharmony_ci } 50262306a36Sopenharmony_ci 50362306a36Sopenharmony_cihwmon_register: 50462306a36Sopenharmony_ci hwmon->groups[0] = &hwmon->group; 50562306a36Sopenharmony_ci hwmon->device = hwmon_device_register_with_groups(&efx->pci_dev->dev, 50662306a36Sopenharmony_ci KBUILD_MODNAME, NULL, 50762306a36Sopenharmony_ci hwmon->groups); 50862306a36Sopenharmony_ci if (IS_ERR(hwmon->device)) { 50962306a36Sopenharmony_ci rc = PTR_ERR(hwmon->device); 51062306a36Sopenharmony_ci goto fail; 51162306a36Sopenharmony_ci } 51262306a36Sopenharmony_ci 51362306a36Sopenharmony_ci return 0; 51462306a36Sopenharmony_ci 51562306a36Sopenharmony_cifail: 51662306a36Sopenharmony_ci efx_siena_mcdi_mon_remove(efx); 51762306a36Sopenharmony_ci return rc; 51862306a36Sopenharmony_ci} 51962306a36Sopenharmony_ci 52062306a36Sopenharmony_civoid efx_siena_mcdi_mon_remove(struct efx_nic *efx) 52162306a36Sopenharmony_ci{ 52262306a36Sopenharmony_ci struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); 52362306a36Sopenharmony_ci 52462306a36Sopenharmony_ci if (hwmon->device) 52562306a36Sopenharmony_ci hwmon_device_unregister(hwmon->device); 52662306a36Sopenharmony_ci kfree(hwmon->attrs); 52762306a36Sopenharmony_ci kfree(hwmon->group.attrs); 52862306a36Sopenharmony_ci efx_siena_free_buffer(efx, &hwmon->dma_buf); 52962306a36Sopenharmony_ci} 53062306a36Sopenharmony_ci 53162306a36Sopenharmony_ci#endif /* CONFIG_SFC_SIENA_MCDI_MON */ 532