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