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 | |
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 |
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(cpp: pf->cpp, id, val); |
59 | if (type == hwmon_power && attr == hwmon_power_input) |
60 | return nfp_hwmon_read_sensor(cpp: pf->cpp, id, val); |
61 | |
62 | return -EINVAL; |
63 | } |
64 | |
65 | static umode_t |
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 u32 nfp_chip_config[] = { |
87 | HWMON_C_REGISTER_TZ, |
88 | 0 |
89 | }; |
90 | |
91 | static const struct hwmon_channel_info nfp_chip = { |
92 | .type = hwmon_chip, |
93 | .config = nfp_chip_config, |
94 | }; |
95 | |
96 | static u32 nfp_temp_config[] = { |
97 | HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT, |
98 | 0 |
99 | }; |
100 | |
101 | static const struct hwmon_channel_info nfp_temp = { |
102 | .type = hwmon_temp, |
103 | .config = nfp_temp_config, |
104 | }; |
105 | |
106 | static u32 nfp_power_config[] = { |
107 | HWMON_P_INPUT | HWMON_P_MAX, |
108 | HWMON_P_INPUT, |
109 | HWMON_P_INPUT, |
110 | 0 |
111 | }; |
112 | |
113 | static const struct hwmon_channel_info nfp_power = { |
114 | .type = hwmon_power, |
115 | .config = nfp_power_config, |
116 | }; |
117 | |
118 | static const struct hwmon_channel_info * const nfp_hwmon_info[] = { |
119 | &nfp_chip, |
120 | &nfp_temp, |
121 | &nfp_power, |
122 | NULL |
123 | }; |
124 | |
125 | static const struct hwmon_ops nfp_hwmon_ops = { |
126 | .is_visible = nfp_hwmon_is_visible, |
127 | .read = nfp_hwmon_read, |
128 | }; |
129 | |
130 | static const struct hwmon_chip_info nfp_chip_info = { |
131 | .ops = &nfp_hwmon_ops, |
132 | .info = nfp_hwmon_info, |
133 | }; |
134 | |
135 | int nfp_hwmon_register(struct nfp_pf *pf) |
136 | { |
137 | if (!IS_REACHABLE(CONFIG_HWMON)) |
138 | return 0; |
139 | |
140 | if (!pf->nspi) { |
141 | nfp_warn(pf->cpp, "not registering HWMON (no NSP info)\n" ); |
142 | return 0; |
143 | } |
144 | if (!pf->nspi->sensor_mask) { |
145 | nfp_info(pf->cpp, |
146 | "not registering HWMON (NSP doesn't report sensors)\n" ); |
147 | return 0; |
148 | } |
149 | |
150 | pf->hwmon_dev = hwmon_device_register_with_info(dev: &pf->pdev->dev, name: "nfp" , |
151 | drvdata: pf, info: &nfp_chip_info, |
152 | NULL); |
153 | return PTR_ERR_OR_ZERO(ptr: pf->hwmon_dev); |
154 | } |
155 | |
156 | void nfp_hwmon_unregister(struct nfp_pf *pf) |
157 | { |
158 | if (!IS_REACHABLE(CONFIG_HWMON) || !pf->hwmon_dev) |
159 | return; |
160 | |
161 | hwmon_device_unregister(dev: pf->hwmon_dev); |
162 | } |
163 | |