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
nfp_hwmon_sensor_id(enum hwmon_sensor_types type,int channel)17 static 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
26 static int
nfp_hwmon_read(struct device * dev,enum hwmon_sensor_types type,u32 attr,int channel,long * val)27 nfp_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
65 static umode_t
nfp_hwmon_is_visible(const void * data,enum hwmon_sensor_types type,u32 attr,int channel)66 nfp_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
86 static 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
95 static const struct hwmon_ops nfp_hwmon_ops = {
96 .is_visible = nfp_hwmon_is_visible,
97 .read = nfp_hwmon_read,
98 };
99
100 static const struct hwmon_chip_info nfp_chip_info = {
101 .ops = &nfp_hwmon_ops,
102 .info = nfp_hwmon_info,
103 };
104
nfp_hwmon_register(struct nfp_pf * pf)105 int 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
nfp_hwmon_unregister(struct nfp_pf * pf)126 void 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 }
133