mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-28 11:49:32 +00:00
nfp: add hwmon support
Add support for retrieving temperature and power sensor and limits via NSP. Signed-off-by: David Brunecz <david.brunecz@netronome.com> Signed-off-by: Jakub Kicinski <jakub.kicinski@netronome.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
a87853f383
commit
eefbde7e10
8 changed files with 286 additions and 7 deletions
|
@ -16,6 +16,7 @@ nfp-objs := \
|
|||
nfpcore/nfp_target.o \
|
||||
nfp_app.o \
|
||||
nfp_devlink.o \
|
||||
nfp_hwmon.o \
|
||||
nfp_main.o \
|
||||
nfp_net_common.o \
|
||||
nfp_net_ethtool.o \
|
||||
|
|
192
drivers/net/ethernet/netronome/nfp/nfp_hwmon.c
Normal file
192
drivers/net/ethernet/netronome/nfp/nfp_hwmon.c
Normal file
|
@ -0,0 +1,192 @@
|
|||
/*
|
||||
* Copyright (C) 2017 Netronome Systems, Inc.
|
||||
*
|
||||
* This software is dual licensed under the GNU General License Version 2,
|
||||
* June 1991 as shown in the file COPYING in the top-level directory of this
|
||||
* source tree or the BSD 2-Clause License provided below. You have the
|
||||
* option to license this software under the complete terms of either license.
|
||||
*
|
||||
* The BSD 2-Clause License:
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or
|
||||
* without modification, are permitted provided that the following
|
||||
* conditions are met:
|
||||
*
|
||||
* 1. Redistributions of source code must retain the above
|
||||
* copyright notice, this list of conditions and the following
|
||||
* disclaimer.
|
||||
*
|
||||
* 2. Redistributions in binary form must reproduce the above
|
||||
* copyright notice, this list of conditions and the following
|
||||
* disclaimer in the documentation and/or other materials
|
||||
* provided with the distribution.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
||||
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
||||
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
||||
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
||||
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
||||
* SOFTWARE.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/bitops.h>
|
||||
#include <linux/hwmon.h>
|
||||
|
||||
#include "nfpcore/nfp_cpp.h"
|
||||
#include "nfpcore/nfp_nsp.h"
|
||||
#include "nfp_main.h"
|
||||
|
||||
#define NFP_TEMP_MAX (95 * 1000)
|
||||
#define NFP_TEMP_CRIT (105 * 1000)
|
||||
|
||||
#define NFP_POWER_MAX (25 * 1000 * 1000)
|
||||
|
||||
static int nfp_hwmon_sensor_id(enum hwmon_sensor_types type, int channel)
|
||||
{
|
||||
if (type == hwmon_temp)
|
||||
return NFP_SENSOR_CHIP_TEMPERATURE;
|
||||
if (type == hwmon_power)
|
||||
return NFP_SENSOR_ASSEMBLY_POWER + channel;
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
static int
|
||||
nfp_hwmon_read(struct device *dev, enum hwmon_sensor_types type, u32 attr,
|
||||
int channel, long *val)
|
||||
{
|
||||
static const struct {
|
||||
enum hwmon_sensor_types type;
|
||||
u32 attr;
|
||||
long val;
|
||||
} const_vals[] = {
|
||||
{ hwmon_temp, hwmon_temp_max, NFP_TEMP_MAX },
|
||||
{ hwmon_temp, hwmon_temp_crit, NFP_TEMP_CRIT },
|
||||
{ hwmon_power, hwmon_power_max, NFP_POWER_MAX },
|
||||
};
|
||||
struct nfp_pf *pf = dev_get_drvdata(dev);
|
||||
enum nfp_nsp_sensor_id id;
|
||||
int err, i;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(const_vals); i++)
|
||||
if (const_vals[i].type == type && const_vals[i].attr == attr) {
|
||||
*val = const_vals[i].val;
|
||||
return 0;
|
||||
}
|
||||
|
||||
err = nfp_hwmon_sensor_id(type, channel);
|
||||
if (err < 0)
|
||||
return err;
|
||||
id = err;
|
||||
|
||||
if (!(pf->nspi->sensor_mask & BIT(id)))
|
||||
return -EOPNOTSUPP;
|
||||
|
||||
if (type == hwmon_temp && attr == hwmon_temp_input)
|
||||
return nfp_hwmon_read_sensor(pf->cpp, id, val);
|
||||
if (type == hwmon_power && attr == hwmon_power_input)
|
||||
return nfp_hwmon_read_sensor(pf->cpp, id, val);
|
||||
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
static umode_t
|
||||
nfp_hwmon_is_visible(const void *data, enum hwmon_sensor_types type, u32 attr,
|
||||
int channel)
|
||||
{
|
||||
if (type == hwmon_temp) {
|
||||
switch (attr) {
|
||||
case hwmon_temp_input:
|
||||
case hwmon_temp_crit:
|
||||
case hwmon_temp_max:
|
||||
return 0444;
|
||||
}
|
||||
} else if (type == hwmon_power) {
|
||||
switch (attr) {
|
||||
case hwmon_power_input:
|
||||
case hwmon_power_max:
|
||||
return 0444;
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static u32 nfp_chip_config[] = {
|
||||
HWMON_C_REGISTER_TZ,
|
||||
0
|
||||
};
|
||||
|
||||
static const struct hwmon_channel_info nfp_chip = {
|
||||
.type = hwmon_chip,
|
||||
.config = nfp_chip_config,
|
||||
};
|
||||
|
||||
static u32 nfp_temp_config[] = {
|
||||
HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT,
|
||||
0
|
||||
};
|
||||
|
||||
static const struct hwmon_channel_info nfp_temp = {
|
||||
.type = hwmon_temp,
|
||||
.config = nfp_temp_config,
|
||||
};
|
||||
|
||||
static u32 nfp_power_config[] = {
|
||||
HWMON_P_INPUT | HWMON_P_MAX,
|
||||
HWMON_P_INPUT,
|
||||
HWMON_P_INPUT,
|
||||
0
|
||||
};
|
||||
|
||||
static const struct hwmon_channel_info nfp_power = {
|
||||
.type = hwmon_power,
|
||||
.config = nfp_power_config,
|
||||
};
|
||||
|
||||
static const struct hwmon_channel_info *nfp_hwmon_info[] = {
|
||||
&nfp_chip,
|
||||
&nfp_temp,
|
||||
&nfp_power,
|
||||
NULL
|
||||
};
|
||||
|
||||
static const struct hwmon_ops nfp_hwmon_ops = {
|
||||
.is_visible = nfp_hwmon_is_visible,
|
||||
.read = nfp_hwmon_read,
|
||||
};
|
||||
|
||||
static const struct hwmon_chip_info nfp_chip_info = {
|
||||
.ops = &nfp_hwmon_ops,
|
||||
.info = nfp_hwmon_info,
|
||||
};
|
||||
|
||||
int nfp_hwmon_register(struct nfp_pf *pf)
|
||||
{
|
||||
if (!IS_REACHABLE(CONFIG_HWMON))
|
||||
return 0;
|
||||
|
||||
if (!pf->nspi) {
|
||||
nfp_warn(pf->cpp, "not registering HWMON (no NSP info)\n");
|
||||
return 0;
|
||||
}
|
||||
if (!pf->nspi->sensor_mask) {
|
||||
nfp_info(pf->cpp,
|
||||
"not registering HWMON (NSP doesn't report sensors)\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
pf->hwmon_dev = hwmon_device_register_with_info(&pf->pdev->dev, "nfp",
|
||||
pf, &nfp_chip_info,
|
||||
NULL);
|
||||
return PTR_ERR_OR_ZERO(pf->hwmon_dev);
|
||||
}
|
||||
|
||||
void nfp_hwmon_unregister(struct nfp_pf *pf)
|
||||
{
|
||||
if (!IS_REACHABLE(CONFIG_HWMON) || !pf->hwmon_dev)
|
||||
return;
|
||||
|
||||
hwmon_device_unregister(pf->hwmon_dev);
|
||||
}
|
|
@ -257,7 +257,6 @@ nfp_fw_load(struct pci_dev *pdev, struct nfp_pf *pf, struct nfp_nsp *nsp)
|
|||
|
||||
static int nfp_nsp_init(struct pci_dev *pdev, struct nfp_pf *pf)
|
||||
{
|
||||
struct nfp_nsp_identify *nspi;
|
||||
struct nfp_nsp *nsp;
|
||||
int err;
|
||||
|
||||
|
@ -274,11 +273,9 @@ static int nfp_nsp_init(struct pci_dev *pdev, struct nfp_pf *pf)
|
|||
|
||||
pf->eth_tbl = __nfp_eth_read_ports(pf->cpp, nsp);
|
||||
|
||||
nspi = __nfp_nsp_identify(nsp);
|
||||
if (nspi) {
|
||||
dev_info(&pdev->dev, "BSP: %s\n", nspi->version);
|
||||
kfree(nspi);
|
||||
}
|
||||
pf->nspi = __nfp_nsp_identify(nsp);
|
||||
if (pf->nspi)
|
||||
dev_info(&pdev->dev, "BSP: %s\n", pf->nspi->version);
|
||||
|
||||
err = nfp_fw_load(pdev, pf, nsp);
|
||||
if (err < 0) {
|
||||
|
@ -383,14 +380,23 @@ static int nfp_pci_probe(struct pci_dev *pdev,
|
|||
if (err)
|
||||
goto err_sriov_unlimit;
|
||||
|
||||
err = nfp_hwmon_register(pf);
|
||||
if (err) {
|
||||
dev_err(&pdev->dev, "Failed to register hwmon info\n");
|
||||
goto err_net_remove;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_net_remove:
|
||||
nfp_net_pci_remove(pf);
|
||||
err_sriov_unlimit:
|
||||
pci_sriov_set_totalvfs(pf->pdev, 0);
|
||||
err_fw_unload:
|
||||
if (pf->fw_loaded)
|
||||
nfp_fw_unload(pf);
|
||||
kfree(pf->eth_tbl);
|
||||
kfree(pf->nspi);
|
||||
err_devlink_unreg:
|
||||
devlink_unregister(devlink);
|
||||
err_cpp_free:
|
||||
|
@ -412,6 +418,8 @@ static void nfp_pci_remove(struct pci_dev *pdev)
|
|||
struct nfp_pf *pf = pci_get_drvdata(pdev);
|
||||
struct devlink *devlink;
|
||||
|
||||
nfp_hwmon_unregister(pf);
|
||||
|
||||
devlink = priv_to_devlink(pf);
|
||||
|
||||
nfp_net_pci_remove(pf);
|
||||
|
@ -428,6 +436,7 @@ static void nfp_pci_remove(struct pci_dev *pdev)
|
|||
nfp_cpp_free(pf->cpp);
|
||||
|
||||
kfree(pf->eth_tbl);
|
||||
kfree(pf->nspi);
|
||||
mutex_destroy(&pf->lock);
|
||||
devlink_free(devlink);
|
||||
pci_release_regions(pdev);
|
||||
|
|
|
@ -47,12 +47,14 @@
|
|||
#include <linux/workqueue.h>
|
||||
|
||||
struct dentry;
|
||||
struct device;
|
||||
struct devlink_ops;
|
||||
struct pci_dev;
|
||||
|
||||
struct nfp_cpp;
|
||||
struct nfp_cpp_area;
|
||||
struct nfp_eth_table;
|
||||
struct nfp_nsp_identify;
|
||||
|
||||
/**
|
||||
* struct nfp_pf - NFP PF-specific device structure
|
||||
|
@ -67,6 +69,8 @@ struct nfp_eth_table;
|
|||
* @num_vfs: Number of SR-IOV VFs enabled
|
||||
* @fw_loaded: Is the firmware loaded?
|
||||
* @eth_tbl: NSP ETH table
|
||||
* @nspi: NSP identification info
|
||||
* @hwmon_dev: pointer to hwmon device
|
||||
* @ddir: Per-device debugfs directory
|
||||
* @max_data_vnics: Number of data vNICs app firmware supports
|
||||
* @num_vnics: Number of vNICs spawned
|
||||
|
@ -94,6 +98,9 @@ struct nfp_pf {
|
|||
bool fw_loaded;
|
||||
|
||||
struct nfp_eth_table *eth_tbl;
|
||||
struct nfp_nsp_identify *nspi;
|
||||
|
||||
struct device *hwmon_dev;
|
||||
|
||||
struct dentry *ddir;
|
||||
|
||||
|
@ -113,4 +120,7 @@ extern const struct devlink_ops nfp_devlink_ops;
|
|||
int nfp_net_pci_probe(struct nfp_pf *pf);
|
||||
void nfp_net_pci_remove(struct nfp_pf *pf);
|
||||
|
||||
int nfp_hwmon_register(struct nfp_pf *pf);
|
||||
void nfp_hwmon_unregister(struct nfp_pf *pf);
|
||||
|
||||
#endif /* NFP_MAIN_H */
|
||||
|
|
|
@ -64,6 +64,8 @@ int nfp_nsp_read_eth_table(struct nfp_nsp *state, void *buf, unsigned int size);
|
|||
int nfp_nsp_write_eth_table(struct nfp_nsp *state,
|
||||
const void *buf, unsigned int size);
|
||||
int nfp_nsp_read_identify(struct nfp_nsp *state, void *buf, unsigned int size);
|
||||
int nfp_nsp_read_sensors(struct nfp_nsp *state, unsigned int sensor_mask,
|
||||
void *buf, unsigned int size);
|
||||
|
||||
/* Implemented in nfp_resource.c */
|
||||
|
||||
|
|
|
@ -93,6 +93,7 @@ enum nfp_nsp_cmd {
|
|||
SPCODE_FW_LOAD = 6, /* Load fw from buffer, len in option */
|
||||
SPCODE_ETH_RESCAN = 7, /* Rescan ETHs, write ETH_TABLE to buf */
|
||||
SPCODE_ETH_CONTROL = 8, /* Update media config from buffer */
|
||||
SPCODE_NSP_SENSORS = 12, /* Read NSP sensor(s) */
|
||||
SPCODE_NSP_IDENTIFY = 13, /* Read NSP version */
|
||||
};
|
||||
|
||||
|
@ -506,3 +507,10 @@ int nfp_nsp_read_identify(struct nfp_nsp *state, void *buf, unsigned int size)
|
|||
return nfp_nsp_command_buf(state, SPCODE_NSP_IDENTIFY, size, NULL, 0,
|
||||
buf, size);
|
||||
}
|
||||
|
||||
int nfp_nsp_read_sensors(struct nfp_nsp *state, unsigned int sensor_mask,
|
||||
void *buf, unsigned int size)
|
||||
{
|
||||
return nfp_nsp_command_buf(state, SPCODE_NSP_SENSORS, sensor_mask,
|
||||
NULL, 0, buf, size);
|
||||
}
|
||||
|
|
|
@ -160,6 +160,7 @@ int __nfp_eth_set_split(struct nfp_nsp *nsp, unsigned int lanes);
|
|||
* @primary: version of primarary bootloader
|
||||
* @secondary: version id of secondary bootloader
|
||||
* @nsp: version id of NSP
|
||||
* @sensor_mask: mask of present sensors available on NIC
|
||||
*/
|
||||
struct nfp_nsp_identify {
|
||||
char version[40];
|
||||
|
@ -170,8 +171,19 @@ struct nfp_nsp_identify {
|
|||
u16 primary;
|
||||
u16 secondary;
|
||||
u16 nsp;
|
||||
u64 sensor_mask;
|
||||
};
|
||||
|
||||
struct nfp_nsp_identify *__nfp_nsp_identify(struct nfp_nsp *nsp);
|
||||
|
||||
enum nfp_nsp_sensor_id {
|
||||
NFP_SENSOR_CHIP_TEMPERATURE,
|
||||
NFP_SENSOR_ASSEMBLY_POWER,
|
||||
NFP_SENSOR_ASSEMBLY_12V_POWER,
|
||||
NFP_SENSOR_ASSEMBLY_3V3_POWER,
|
||||
};
|
||||
|
||||
int nfp_hwmon_read_sensor(struct nfp_cpp *cpp, enum nfp_nsp_sensor_id id,
|
||||
long *val);
|
||||
|
||||
#endif
|
||||
|
|
|
@ -46,7 +46,8 @@ struct nsp_identify {
|
|||
__le16 primary;
|
||||
__le16 secondary;
|
||||
__le16 nsp;
|
||||
__le16 reserved;
|
||||
u8 reserved[6];
|
||||
__le64 sensor_mask;
|
||||
};
|
||||
|
||||
struct nfp_nsp_identify *__nfp_nsp_identify(struct nfp_nsp *nsp)
|
||||
|
@ -82,8 +83,52 @@ struct nfp_nsp_identify *__nfp_nsp_identify(struct nfp_nsp *nsp)
|
|||
nspi->primary = le16_to_cpu(ni->primary);
|
||||
nspi->secondary = le16_to_cpu(ni->secondary);
|
||||
nspi->nsp = le16_to_cpu(ni->nsp);
|
||||
nspi->sensor_mask = le64_to_cpu(ni->sensor_mask);
|
||||
|
||||
exit_free:
|
||||
kfree(ni);
|
||||
return nspi;
|
||||
}
|
||||
|
||||
struct nfp_sensors {
|
||||
__le32 chip_temp;
|
||||
__le32 assembly_power;
|
||||
__le32 assembly_12v_power;
|
||||
__le32 assembly_3v3_power;
|
||||
};
|
||||
|
||||
int nfp_hwmon_read_sensor(struct nfp_cpp *cpp, enum nfp_nsp_sensor_id id,
|
||||
long *val)
|
||||
{
|
||||
struct nfp_sensors s;
|
||||
struct nfp_nsp *nsp;
|
||||
int ret;
|
||||
|
||||
nsp = nfp_nsp_open(cpp);
|
||||
if (IS_ERR(nsp))
|
||||
return PTR_ERR(nsp);
|
||||
|
||||
ret = nfp_nsp_read_sensors(nsp, BIT(id), &s, sizeof(s));
|
||||
nfp_nsp_close(nsp);
|
||||
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
switch (id) {
|
||||
case NFP_SENSOR_CHIP_TEMPERATURE:
|
||||
*val = le32_to_cpu(s.chip_temp);
|
||||
break;
|
||||
case NFP_SENSOR_ASSEMBLY_POWER:
|
||||
*val = le32_to_cpu(s.assembly_power);
|
||||
break;
|
||||
case NFP_SENSOR_ASSEMBLY_12V_POWER:
|
||||
*val = le32_to_cpu(s.assembly_12v_power);
|
||||
break;
|
||||
case NFP_SENSOR_ASSEMBLY_3V3_POWER:
|
||||
*val = le32_to_cpu(s.assembly_3v3_power);
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
|
Loading…
Reference in a new issue