nfp_hwmon.c

  1// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
  2/* Copyright (C) 2017 Netronome Systems, Inc. */
  3
  4#include <linux/kernel.h>
  5#include <linux/bitops.h>
  6#include <linux/hwmon.h>
  7
  8#include "nfpcore/nfp_cpp.h"
  9#include "nfpcore/nfp_nsp.h"
 10#include "nfp_main.h"
 11
 12#define NFP_TEMP_MAX		(95 * 1000)
 13#define NFP_TEMP_CRIT		(105 * 1000)
 14
 15#define NFP_POWER_MAX		(25 * 1000 * 1000)
 16
 17static int nfp_hwmon_sensor_id(enum hwmon_sensor_types type, int channel)
 18{
 19	if (type == hwmon_temp)
 20		return NFP_SENSOR_CHIP_TEMPERATURE;
 21	if (type == hwmon_power)
 22		return NFP_SENSOR_ASSEMBLY_POWER + channel;
 23	return -EINVAL;
 24}
 25
 26static int
 27nfp_hwmon_read(struct device *dev, enum hwmon_sensor_types type, u32 attr,
 28	       int channel, long *val)
 29{
 30	static const struct {
 31		enum hwmon_sensor_types type;
 32		u32 attr;
 33		long val;
 34	} const_vals[] = {
 35		{ hwmon_temp,	hwmon_temp_max,		NFP_TEMP_MAX },
 36		{ hwmon_temp,	hwmon_temp_crit,	NFP_TEMP_CRIT },
 37		{ hwmon_power,	hwmon_power_max,	NFP_POWER_MAX },
 38	};
 39	struct nfp_pf *pf = dev_get_drvdata(dev);
 40	enum nfp_nsp_sensor_id id;
 41	int err, i;
 42
 43	for (i = 0; i < ARRAY_SIZE(const_vals); i++)
 44		if (const_vals[i].type == type && const_vals[i].attr == attr) {
 45			*val = const_vals[i].val;
 46			return 0;
 47		}
 48
 49	err = nfp_hwmon_sensor_id(type, channel);
 50	if (err < 0)
 51		return err;
 52	id = err;
 53
 54	if (!(pf->nspi->sensor_mask & BIT(id)))
 55		return -EOPNOTSUPP;
 56
 57	if (type == hwmon_temp && attr == hwmon_temp_input)
 58		return nfp_hwmon_read_sensor(pf->cpp, id, val);
 59	if (type == hwmon_power && attr == hwmon_power_input)
 60		return nfp_hwmon_read_sensor(pf->cpp, id, val);
 61
 62	return -EINVAL;
 63}
 64
 65static umode_t
 66nfp_hwmon_is_visible(const void *data, enum hwmon_sensor_types type, u32 attr,
 67		     int channel)
 68{
 69	if (type == hwmon_temp) {
 70		switch (attr) {
 71		case hwmon_temp_input:
 72		case hwmon_temp_crit:
 73		case hwmon_temp_max:
 74			return 0444;
 75		}
 76	} else if (type == hwmon_power) {
 77		switch (attr) {
 78		case hwmon_power_input:
 79		case hwmon_power_max:
 80			return 0444;
 81		}
 82	}
 83	return 0;
 84}
 85
 86static const struct hwmon_channel_info * const nfp_hwmon_info[] = {
 87	HWMON_CHANNEL_INFO(chip, HWMON_C_REGISTER_TZ),
 88	HWMON_CHANNEL_INFO(temp, HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT),
 89	HWMON_CHANNEL_INFO(power, HWMON_P_INPUT | HWMON_P_MAX,
 90			   HWMON_P_INPUT,
 91			   HWMON_P_INPUT),
 92	NULL
 93};
 94
 95static const struct hwmon_ops nfp_hwmon_ops = {
 96	.is_visible = nfp_hwmon_is_visible,
 97	.read = nfp_hwmon_read,
 98};
 99
100static const struct hwmon_chip_info nfp_chip_info = {
101	.ops = &nfp_hwmon_ops,
102	.info = nfp_hwmon_info,
103};
104
105int nfp_hwmon_register(struct nfp_pf *pf)
106{
107	if (!IS_REACHABLE(CONFIG_HWMON))
108		return 0;
109
110	if (!pf->nspi) {
111		nfp_warn(pf->cpp, "not registering HWMON (no NSP info)\n");
112		return 0;
113	}
114	if (!pf->nspi->sensor_mask) {
115		nfp_info(pf->cpp,
116			 "not registering HWMON (NSP doesn't report sensors)\n");
117		return 0;
118	}
119
120	pf->hwmon_dev = hwmon_device_register_with_info(&pf->pdev->dev, "nfp",
121							pf, &nfp_chip_info,
122							NULL);
123	return PTR_ERR_OR_ZERO(pf->hwmon_dev);
124}
125
126void nfp_hwmon_unregister(struct nfp_pf *pf)
127{
128	if (!IS_REACHABLE(CONFIG_HWMON) || !pf->hwmon_dev)
129		return;
130
131	hwmon_device_unregister(pf->hwmon_dev);
132}