]>
Commit | Line | Data |
---|---|---|
fff7b8ab RM |
1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* | |
3 | * Copyright (c) 2020 Sartura Ltd. | |
4 | * | |
5 | * Driver for the TI TPS23861 PoE PSE. | |
6 | * | |
7 | * Author: Robert Marko <robert.marko@sartura.hr> | |
8 | */ | |
9 | ||
10 | #include <linux/bitfield.h> | |
11 | #include <linux/debugfs.h> | |
12 | #include <linux/delay.h> | |
13 | #include <linux/hwmon-sysfs.h> | |
14 | #include <linux/hwmon.h> | |
15 | #include <linux/i2c.h> | |
16 | #include <linux/module.h> | |
17 | #include <linux/of_device.h> | |
18 | #include <linux/regmap.h> | |
19 | ||
20 | #define TEMPERATURE 0x2c | |
21 | #define INPUT_VOLTAGE_LSB 0x2e | |
22 | #define INPUT_VOLTAGE_MSB 0x2f | |
23 | #define PORT_1_CURRENT_LSB 0x30 | |
24 | #define PORT_1_CURRENT_MSB 0x31 | |
25 | #define PORT_1_VOLTAGE_LSB 0x32 | |
26 | #define PORT_1_VOLTAGE_MSB 0x33 | |
27 | #define PORT_2_CURRENT_LSB 0x34 | |
28 | #define PORT_2_CURRENT_MSB 0x35 | |
29 | #define PORT_2_VOLTAGE_LSB 0x36 | |
30 | #define PORT_2_VOLTAGE_MSB 0x37 | |
31 | #define PORT_3_CURRENT_LSB 0x38 | |
32 | #define PORT_3_CURRENT_MSB 0x39 | |
33 | #define PORT_3_VOLTAGE_LSB 0x3a | |
34 | #define PORT_3_VOLTAGE_MSB 0x3b | |
35 | #define PORT_4_CURRENT_LSB 0x3c | |
36 | #define PORT_4_CURRENT_MSB 0x3d | |
37 | #define PORT_4_VOLTAGE_LSB 0x3e | |
38 | #define PORT_4_VOLTAGE_MSB 0x3f | |
39 | #define PORT_N_CURRENT_LSB_OFFSET 0x04 | |
40 | #define PORT_N_VOLTAGE_LSB_OFFSET 0x04 | |
41 | #define VOLTAGE_CURRENT_MASK GENMASK(13, 0) | |
42 | #define PORT_1_RESISTANCE_LSB 0x60 | |
43 | #define PORT_1_RESISTANCE_MSB 0x61 | |
44 | #define PORT_2_RESISTANCE_LSB 0x62 | |
45 | #define PORT_2_RESISTANCE_MSB 0x63 | |
46 | #define PORT_3_RESISTANCE_LSB 0x64 | |
47 | #define PORT_3_RESISTANCE_MSB 0x65 | |
48 | #define PORT_4_RESISTANCE_LSB 0x66 | |
49 | #define PORT_4_RESISTANCE_MSB 0x67 | |
50 | #define PORT_N_RESISTANCE_LSB_OFFSET 0x02 | |
51 | #define PORT_RESISTANCE_MASK GENMASK(13, 0) | |
52 | #define PORT_RESISTANCE_RSN_MASK GENMASK(15, 14) | |
53 | #define PORT_RESISTANCE_RSN_OTHER 0 | |
54 | #define PORT_RESISTANCE_RSN_LOW 1 | |
55 | #define PORT_RESISTANCE_RSN_OPEN 2 | |
56 | #define PORT_RESISTANCE_RSN_SHORT 3 | |
57 | #define PORT_1_STATUS 0x0c | |
58 | #define PORT_2_STATUS 0x0d | |
59 | #define PORT_3_STATUS 0x0e | |
60 | #define PORT_4_STATUS 0x0f | |
61 | #define PORT_STATUS_CLASS_MASK GENMASK(7, 4) | |
62 | #define PORT_STATUS_DETECT_MASK GENMASK(3, 0) | |
63 | #define PORT_CLASS_UNKNOWN 0 | |
64 | #define PORT_CLASS_1 1 | |
65 | #define PORT_CLASS_2 2 | |
66 | #define PORT_CLASS_3 3 | |
67 | #define PORT_CLASS_4 4 | |
68 | #define PORT_CLASS_RESERVED 5 | |
69 | #define PORT_CLASS_0 6 | |
70 | #define PORT_CLASS_OVERCURRENT 7 | |
71 | #define PORT_CLASS_MISMATCH 8 | |
72 | #define PORT_DETECT_UNKNOWN 0 | |
73 | #define PORT_DETECT_SHORT 1 | |
74 | #define PORT_DETECT_RESERVED 2 | |
75 | #define PORT_DETECT_RESISTANCE_LOW 3 | |
76 | #define PORT_DETECT_RESISTANCE_OK 4 | |
77 | #define PORT_DETECT_RESISTANCE_HIGH 5 | |
78 | #define PORT_DETECT_OPEN_CIRCUIT 6 | |
79 | #define PORT_DETECT_RESERVED_2 7 | |
80 | #define PORT_DETECT_MOSFET_FAULT 8 | |
81 | #define PORT_DETECT_LEGACY 9 | |
82 | /* Measurment beyond clamp voltage */ | |
83 | #define PORT_DETECT_CAPACITANCE_INVALID_BEYOND 10 | |
84 | /* Insufficient voltage delta */ | |
85 | #define PORT_DETECT_CAPACITANCE_INVALID_DELTA 11 | |
86 | #define PORT_DETECT_CAPACITANCE_OUT_OF_RANGE 12 | |
87 | #define POE_PLUS 0x40 | |
88 | #define OPERATING_MODE 0x12 | |
89 | #define OPERATING_MODE_OFF 0 | |
90 | #define OPERATING_MODE_MANUAL 1 | |
91 | #define OPERATING_MODE_SEMI 2 | |
92 | #define OPERATING_MODE_AUTO 3 | |
93 | #define OPERATING_MODE_PORT_1_MASK GENMASK(1, 0) | |
94 | #define OPERATING_MODE_PORT_2_MASK GENMASK(3, 2) | |
95 | #define OPERATING_MODE_PORT_3_MASK GENMASK(5, 4) | |
96 | #define OPERATING_MODE_PORT_4_MASK GENMASK(7, 6) | |
97 | ||
98 | #define DETECT_CLASS_RESTART 0x18 | |
99 | #define POWER_ENABLE 0x19 | |
100 | #define TPS23861_NUM_PORTS 4 | |
101 | ||
b325d352 RM |
102 | #define TPS23861_GENERAL_MASK_1 0x17 |
103 | #define TPS23861_CURRENT_SHUNT_MASK BIT(0) | |
104 | ||
fff7b8ab RM |
105 | #define TEMPERATURE_LSB 652 /* 0.652 degrees Celsius */ |
106 | #define VOLTAGE_LSB 3662 /* 3.662 mV */ | |
107 | #define SHUNT_RESISTOR_DEFAULT 255000 /* 255 mOhm */ | |
e13d1127 RM |
108 | #define CURRENT_LSB_250 62260 /* 62.260 uA */ |
109 | #define CURRENT_LSB_255 61039 /* 61.039 uA */ | |
fff7b8ab RM |
110 | #define RESISTANCE_LSB 110966 /* 11.0966 Ohm*/ |
111 | #define RESISTANCE_LSB_LOW 157216 /* 15.7216 Ohm*/ | |
112 | ||
113 | struct tps23861_data { | |
114 | struct regmap *regmap; | |
115 | u32 shunt_resistor; | |
116 | struct i2c_client *client; | |
117 | struct dentry *debugfs_dir; | |
118 | }; | |
119 | ||
120 | static struct regmap_config tps23861_regmap_config = { | |
121 | .reg_bits = 8, | |
122 | .val_bits = 8, | |
fb8543fb | 123 | .max_register = 0x6f, |
fff7b8ab RM |
124 | }; |
125 | ||
126 | static int tps23861_read_temp(struct tps23861_data *data, long *val) | |
127 | { | |
128 | unsigned int regval; | |
129 | int err; | |
130 | ||
131 | err = regmap_read(data->regmap, TEMPERATURE, ®val); | |
132 | if (err < 0) | |
133 | return err; | |
134 | ||
135 | *val = (regval * TEMPERATURE_LSB) - 20000; | |
136 | ||
137 | return 0; | |
138 | } | |
139 | ||
140 | static int tps23861_read_voltage(struct tps23861_data *data, int channel, | |
141 | long *val) | |
142 | { | |
0eabb139 AG |
143 | __le16 regval; |
144 | long raw_val; | |
fff7b8ab RM |
145 | int err; |
146 | ||
147 | if (channel < TPS23861_NUM_PORTS) { | |
148 | err = regmap_bulk_read(data->regmap, | |
149 | PORT_1_VOLTAGE_LSB + channel * PORT_N_VOLTAGE_LSB_OFFSET, | |
150 | ®val, 2); | |
151 | } else { | |
152 | err = regmap_bulk_read(data->regmap, | |
153 | INPUT_VOLTAGE_LSB, | |
154 | ®val, 2); | |
155 | } | |
156 | if (err < 0) | |
157 | return err; | |
158 | ||
0eabb139 AG |
159 | raw_val = le16_to_cpu(regval); |
160 | *val = (FIELD_GET(VOLTAGE_CURRENT_MASK, raw_val) * VOLTAGE_LSB) / 1000; | |
fff7b8ab RM |
161 | |
162 | return 0; | |
163 | } | |
164 | ||
165 | static int tps23861_read_current(struct tps23861_data *data, int channel, | |
166 | long *val) | |
167 | { | |
0eabb139 AG |
168 | long raw_val, current_lsb; |
169 | __le16 regval; | |
170 | ||
fff7b8ab RM |
171 | int err; |
172 | ||
173 | if (data->shunt_resistor == SHUNT_RESISTOR_DEFAULT) | |
174 | current_lsb = CURRENT_LSB_255; | |
175 | else | |
176 | current_lsb = CURRENT_LSB_250; | |
177 | ||
178 | err = regmap_bulk_read(data->regmap, | |
179 | PORT_1_CURRENT_LSB + channel * PORT_N_CURRENT_LSB_OFFSET, | |
180 | ®val, 2); | |
181 | if (err < 0) | |
182 | return err; | |
183 | ||
0eabb139 AG |
184 | raw_val = le16_to_cpu(regval); |
185 | *val = (FIELD_GET(VOLTAGE_CURRENT_MASK, raw_val) * current_lsb) / 1000000; | |
fff7b8ab RM |
186 | |
187 | return 0; | |
188 | } | |
189 | ||
190 | static int tps23861_port_disable(struct tps23861_data *data, int channel) | |
191 | { | |
192 | unsigned int regval = 0; | |
193 | int err; | |
194 | ||
195 | regval |= BIT(channel + 4); | |
196 | err = regmap_write(data->regmap, POWER_ENABLE, regval); | |
197 | ||
198 | return err; | |
199 | } | |
200 | ||
201 | static int tps23861_port_enable(struct tps23861_data *data, int channel) | |
202 | { | |
203 | unsigned int regval = 0; | |
204 | int err; | |
205 | ||
206 | regval |= BIT(channel); | |
207 | regval |= BIT(channel + 4); | |
208 | err = regmap_write(data->regmap, DETECT_CLASS_RESTART, regval); | |
209 | ||
210 | return err; | |
211 | } | |
212 | ||
213 | static umode_t tps23861_is_visible(const void *data, enum hwmon_sensor_types type, | |
214 | u32 attr, int channel) | |
215 | { | |
216 | switch (type) { | |
217 | case hwmon_temp: | |
218 | switch (attr) { | |
219 | case hwmon_temp_input: | |
220 | case hwmon_temp_label: | |
221 | return 0444; | |
222 | default: | |
223 | return 0; | |
224 | } | |
225 | case hwmon_in: | |
226 | switch (attr) { | |
227 | case hwmon_in_input: | |
228 | case hwmon_in_label: | |
229 | return 0444; | |
230 | case hwmon_in_enable: | |
231 | return 0200; | |
232 | default: | |
233 | return 0; | |
234 | } | |
235 | case hwmon_curr: | |
236 | switch (attr) { | |
237 | case hwmon_curr_input: | |
238 | case hwmon_curr_label: | |
239 | return 0444; | |
240 | default: | |
241 | return 0; | |
242 | } | |
243 | default: | |
244 | return 0; | |
245 | } | |
246 | } | |
247 | ||
248 | static int tps23861_write(struct device *dev, enum hwmon_sensor_types type, | |
249 | u32 attr, int channel, long val) | |
250 | { | |
251 | struct tps23861_data *data = dev_get_drvdata(dev); | |
252 | int err; | |
253 | ||
254 | switch (type) { | |
255 | case hwmon_in: | |
256 | switch (attr) { | |
257 | case hwmon_in_enable: | |
258 | if (val == 0) | |
259 | err = tps23861_port_disable(data, channel); | |
260 | else if (val == 1) | |
261 | err = tps23861_port_enable(data, channel); | |
262 | else | |
263 | err = -EINVAL; | |
264 | break; | |
265 | default: | |
266 | return -EOPNOTSUPP; | |
267 | } | |
268 | break; | |
269 | default: | |
270 | return -EOPNOTSUPP; | |
271 | } | |
272 | ||
273 | return err; | |
274 | } | |
275 | ||
276 | static int tps23861_read(struct device *dev, enum hwmon_sensor_types type, | |
277 | u32 attr, int channel, long *val) | |
278 | { | |
279 | struct tps23861_data *data = dev_get_drvdata(dev); | |
280 | int err; | |
281 | ||
282 | switch (type) { | |
283 | case hwmon_temp: | |
284 | switch (attr) { | |
285 | case hwmon_temp_input: | |
286 | err = tps23861_read_temp(data, val); | |
287 | break; | |
288 | default: | |
289 | return -EOPNOTSUPP; | |
290 | } | |
291 | break; | |
292 | case hwmon_in: | |
293 | switch (attr) { | |
294 | case hwmon_in_input: | |
295 | err = tps23861_read_voltage(data, channel, val); | |
296 | break; | |
297 | default: | |
298 | return -EOPNOTSUPP; | |
299 | } | |
300 | break; | |
301 | case hwmon_curr: | |
302 | switch (attr) { | |
303 | case hwmon_curr_input: | |
304 | err = tps23861_read_current(data, channel, val); | |
305 | break; | |
306 | default: | |
307 | return -EOPNOTSUPP; | |
308 | } | |
309 | break; | |
310 | default: | |
311 | return -EOPNOTSUPP; | |
312 | } | |
313 | ||
314 | return err; | |
315 | } | |
316 | ||
317 | static const char * const tps23861_port_label[] = { | |
318 | "Port1", | |
319 | "Port2", | |
320 | "Port3", | |
321 | "Port4", | |
322 | "Input", | |
323 | }; | |
324 | ||
325 | static int tps23861_read_string(struct device *dev, | |
326 | enum hwmon_sensor_types type, | |
327 | u32 attr, int channel, const char **str) | |
328 | { | |
329 | switch (type) { | |
330 | case hwmon_in: | |
331 | case hwmon_curr: | |
332 | *str = tps23861_port_label[channel]; | |
333 | break; | |
334 | case hwmon_temp: | |
335 | *str = "Die"; | |
336 | break; | |
337 | default: | |
338 | return -EOPNOTSUPP; | |
339 | } | |
340 | ||
341 | return 0; | |
342 | } | |
343 | ||
344 | static const struct hwmon_channel_info *tps23861_info[] = { | |
345 | HWMON_CHANNEL_INFO(chip, | |
346 | HWMON_C_REGISTER_TZ), | |
347 | HWMON_CHANNEL_INFO(temp, | |
348 | HWMON_T_INPUT | HWMON_T_LABEL), | |
349 | HWMON_CHANNEL_INFO(in, | |
350 | HWMON_I_INPUT | HWMON_I_ENABLE | HWMON_I_LABEL, | |
351 | HWMON_I_INPUT | HWMON_I_ENABLE | HWMON_I_LABEL, | |
352 | HWMON_I_INPUT | HWMON_I_ENABLE | HWMON_I_LABEL, | |
353 | HWMON_I_INPUT | HWMON_I_ENABLE | HWMON_I_LABEL, | |
354 | HWMON_I_INPUT | HWMON_I_LABEL), | |
355 | HWMON_CHANNEL_INFO(curr, | |
356 | HWMON_C_INPUT | HWMON_C_LABEL, | |
357 | HWMON_C_INPUT | HWMON_C_LABEL, | |
358 | HWMON_C_INPUT | HWMON_C_LABEL, | |
359 | HWMON_C_INPUT | HWMON_C_LABEL), | |
360 | NULL | |
361 | }; | |
362 | ||
363 | static const struct hwmon_ops tps23861_hwmon_ops = { | |
364 | .is_visible = tps23861_is_visible, | |
365 | .write = tps23861_write, | |
366 | .read = tps23861_read, | |
367 | .read_string = tps23861_read_string, | |
368 | }; | |
369 | ||
370 | static const struct hwmon_chip_info tps23861_chip_info = { | |
371 | .ops = &tps23861_hwmon_ops, | |
372 | .info = tps23861_info, | |
373 | }; | |
374 | ||
375 | static char *tps23861_port_operating_mode(struct tps23861_data *data, int port) | |
376 | { | |
377 | unsigned int regval; | |
378 | int mode; | |
379 | ||
380 | regmap_read(data->regmap, OPERATING_MODE, ®val); | |
381 | ||
382 | switch (port) { | |
383 | case 1: | |
384 | mode = FIELD_GET(OPERATING_MODE_PORT_1_MASK, regval); | |
385 | break; | |
386 | case 2: | |
387 | mode = FIELD_GET(OPERATING_MODE_PORT_2_MASK, regval); | |
388 | break; | |
389 | case 3: | |
390 | mode = FIELD_GET(OPERATING_MODE_PORT_3_MASK, regval); | |
391 | break; | |
392 | case 4: | |
393 | mode = FIELD_GET(OPERATING_MODE_PORT_4_MASK, regval); | |
394 | break; | |
395 | default: | |
396 | mode = -EINVAL; | |
397 | } | |
398 | ||
399 | switch (mode) { | |
400 | case OPERATING_MODE_OFF: | |
401 | return "Off"; | |
402 | case OPERATING_MODE_MANUAL: | |
403 | return "Manual"; | |
404 | case OPERATING_MODE_SEMI: | |
405 | return "Semi-Auto"; | |
406 | case OPERATING_MODE_AUTO: | |
407 | return "Auto"; | |
408 | default: | |
409 | return "Invalid"; | |
410 | } | |
411 | } | |
412 | ||
413 | static char *tps23861_port_detect_status(struct tps23861_data *data, int port) | |
414 | { | |
415 | unsigned int regval; | |
416 | ||
417 | regmap_read(data->regmap, | |
418 | PORT_1_STATUS + (port - 1), | |
419 | ®val); | |
420 | ||
421 | switch (FIELD_GET(PORT_STATUS_DETECT_MASK, regval)) { | |
422 | case PORT_DETECT_UNKNOWN: | |
423 | return "Unknown device"; | |
424 | case PORT_DETECT_SHORT: | |
425 | return "Short circuit"; | |
426 | case PORT_DETECT_RESISTANCE_LOW: | |
427 | return "Too low resistance"; | |
428 | case PORT_DETECT_RESISTANCE_OK: | |
429 | return "Valid resistance"; | |
430 | case PORT_DETECT_RESISTANCE_HIGH: | |
431 | return "Too high resistance"; | |
432 | case PORT_DETECT_OPEN_CIRCUIT: | |
433 | return "Open circuit"; | |
434 | case PORT_DETECT_MOSFET_FAULT: | |
435 | return "MOSFET fault"; | |
436 | case PORT_DETECT_LEGACY: | |
437 | return "Legacy device"; | |
438 | case PORT_DETECT_CAPACITANCE_INVALID_BEYOND: | |
439 | return "Invalid capacitance, beyond clamp voltage"; | |
440 | case PORT_DETECT_CAPACITANCE_INVALID_DELTA: | |
441 | return "Invalid capacitance, insufficient voltage delta"; | |
442 | case PORT_DETECT_CAPACITANCE_OUT_OF_RANGE: | |
443 | return "Valid capacitance, outside of legacy range"; | |
444 | case PORT_DETECT_RESERVED: | |
445 | case PORT_DETECT_RESERVED_2: | |
446 | default: | |
447 | return "Invalid"; | |
448 | } | |
449 | } | |
450 | ||
451 | static char *tps23861_port_class_status(struct tps23861_data *data, int port) | |
452 | { | |
453 | unsigned int regval; | |
454 | ||
455 | regmap_read(data->regmap, | |
456 | PORT_1_STATUS + (port - 1), | |
457 | ®val); | |
458 | ||
459 | switch (FIELD_GET(PORT_STATUS_CLASS_MASK, regval)) { | |
460 | case PORT_CLASS_UNKNOWN: | |
461 | return "Unknown"; | |
462 | case PORT_CLASS_RESERVED: | |
463 | case PORT_CLASS_0: | |
464 | return "0"; | |
465 | case PORT_CLASS_1: | |
466 | return "1"; | |
467 | case PORT_CLASS_2: | |
468 | return "2"; | |
469 | case PORT_CLASS_3: | |
470 | return "3"; | |
471 | case PORT_CLASS_4: | |
472 | return "4"; | |
473 | case PORT_CLASS_OVERCURRENT: | |
474 | return "Overcurrent"; | |
475 | case PORT_CLASS_MISMATCH: | |
476 | return "Mismatch"; | |
477 | default: | |
478 | return "Invalid"; | |
479 | } | |
480 | } | |
481 | ||
482 | static char *tps23861_port_poe_plus_status(struct tps23861_data *data, int port) | |
483 | { | |
484 | unsigned int regval; | |
485 | ||
486 | regmap_read(data->regmap, POE_PLUS, ®val); | |
487 | ||
488 | if (BIT(port + 3) & regval) | |
489 | return "Yes"; | |
490 | else | |
491 | return "No"; | |
492 | } | |
493 | ||
494 | static int tps23861_port_resistance(struct tps23861_data *data, int port) | |
495 | { | |
1f05f65b AG |
496 | unsigned int raw_val; |
497 | __le16 regval; | |
fff7b8ab RM |
498 | |
499 | regmap_bulk_read(data->regmap, | |
500 | PORT_1_RESISTANCE_LSB + PORT_N_RESISTANCE_LSB_OFFSET * (port - 1), | |
501 | ®val, | |
502 | 2); | |
503 | ||
1f05f65b AG |
504 | raw_val = le16_to_cpu(regval); |
505 | switch (FIELD_GET(PORT_RESISTANCE_RSN_MASK, raw_val)) { | |
fff7b8ab | 506 | case PORT_RESISTANCE_RSN_OTHER: |
1f05f65b | 507 | return (FIELD_GET(PORT_RESISTANCE_MASK, raw_val) * RESISTANCE_LSB) / 10000; |
fff7b8ab | 508 | case PORT_RESISTANCE_RSN_LOW: |
1f05f65b | 509 | return (FIELD_GET(PORT_RESISTANCE_MASK, raw_val) * RESISTANCE_LSB_LOW) / 10000; |
fff7b8ab RM |
510 | case PORT_RESISTANCE_RSN_SHORT: |
511 | case PORT_RESISTANCE_RSN_OPEN: | |
512 | default: | |
513 | return 0; | |
514 | } | |
515 | } | |
516 | ||
517 | static int tps23861_port_status_show(struct seq_file *s, void *data) | |
518 | { | |
519 | struct tps23861_data *priv = s->private; | |
520 | int i; | |
521 | ||
522 | for (i = 1; i < TPS23861_NUM_PORTS + 1; i++) { | |
523 | seq_printf(s, "Port: \t\t%d\n", i); | |
524 | seq_printf(s, "Operating mode: %s\n", tps23861_port_operating_mode(priv, i)); | |
525 | seq_printf(s, "Detected: \t%s\n", tps23861_port_detect_status(priv, i)); | |
526 | seq_printf(s, "Class: \t\t%s\n", tps23861_port_class_status(priv, i)); | |
527 | seq_printf(s, "PoE Plus: \t%s\n", tps23861_port_poe_plus_status(priv, i)); | |
528 | seq_printf(s, "Resistance: \t%d\n", tps23861_port_resistance(priv, i)); | |
529 | seq_putc(s, '\n'); | |
530 | } | |
531 | ||
532 | return 0; | |
533 | } | |
534 | ||
535 | DEFINE_SHOW_ATTRIBUTE(tps23861_port_status); | |
536 | ||
537 | static void tps23861_init_debugfs(struct tps23861_data *data) | |
538 | { | |
539 | data->debugfs_dir = debugfs_create_dir(data->client->name, NULL); | |
540 | ||
541 | debugfs_create_file("port_status", | |
542 | 0400, | |
543 | data->debugfs_dir, | |
544 | data, | |
545 | &tps23861_port_status_fops); | |
546 | } | |
547 | ||
548 | static int tps23861_probe(struct i2c_client *client) | |
549 | { | |
550 | struct device *dev = &client->dev; | |
551 | struct tps23861_data *data; | |
552 | struct device *hwmon_dev; | |
553 | u32 shunt_resistor; | |
554 | ||
555 | data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); | |
556 | if (!data) | |
557 | return -ENOMEM; | |
558 | ||
559 | data->client = client; | |
560 | i2c_set_clientdata(client, data); | |
561 | ||
562 | data->regmap = devm_regmap_init_i2c(client, &tps23861_regmap_config); | |
563 | if (IS_ERR(data->regmap)) { | |
564 | dev_err(dev, "failed to allocate register map\n"); | |
565 | return PTR_ERR(data->regmap); | |
566 | } | |
567 | ||
568 | if (!of_property_read_u32(dev->of_node, "shunt-resistor-micro-ohms", &shunt_resistor)) | |
569 | data->shunt_resistor = shunt_resistor; | |
570 | else | |
571 | data->shunt_resistor = SHUNT_RESISTOR_DEFAULT; | |
572 | ||
b325d352 RM |
573 | if (data->shunt_resistor == SHUNT_RESISTOR_DEFAULT) |
574 | regmap_clear_bits(data->regmap, | |
575 | TPS23861_GENERAL_MASK_1, | |
576 | TPS23861_CURRENT_SHUNT_MASK); | |
577 | else | |
578 | regmap_set_bits(data->regmap, | |
579 | TPS23861_GENERAL_MASK_1, | |
580 | TPS23861_CURRENT_SHUNT_MASK); | |
581 | ||
fff7b8ab RM |
582 | hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name, |
583 | data, &tps23861_chip_info, | |
584 | NULL); | |
585 | if (IS_ERR(hwmon_dev)) | |
586 | return PTR_ERR(hwmon_dev); | |
587 | ||
588 | tps23861_init_debugfs(data); | |
589 | ||
590 | return 0; | |
591 | } | |
592 | ||
593 | static int tps23861_remove(struct i2c_client *client) | |
594 | { | |
595 | struct tps23861_data *data = i2c_get_clientdata(client); | |
596 | ||
597 | debugfs_remove_recursive(data->debugfs_dir); | |
598 | ||
599 | return 0; | |
600 | } | |
601 | ||
602 | static const struct of_device_id __maybe_unused tps23861_of_match[] = { | |
603 | { .compatible = "ti,tps23861", }, | |
604 | { }, | |
605 | }; | |
606 | MODULE_DEVICE_TABLE(of, tps23861_of_match); | |
607 | ||
608 | static struct i2c_driver tps23861_driver = { | |
609 | .probe_new = tps23861_probe, | |
610 | .remove = tps23861_remove, | |
611 | .driver = { | |
612 | .name = "tps23861", | |
613 | .of_match_table = of_match_ptr(tps23861_of_match), | |
614 | }, | |
615 | }; | |
616 | module_i2c_driver(tps23861_driver); | |
617 | ||
618 | MODULE_LICENSE("GPL"); | |
619 | MODULE_AUTHOR("Robert Marko <robert.marko@sartura.hr>"); | |
620 | MODULE_DESCRIPTION("TI TPS23861 PoE PSE"); |