19948a064SJiri Pirko // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
29948a064SJiri Pirko /* Copyright (c) 2015-2018 Mellanox Technologies. All rights reserved */
389309da3SJiri Pirko
489309da3SJiri Pirko #include <linux/kernel.h>
589309da3SJiri Pirko #include <linux/types.h>
689309da3SJiri Pirko #include <linux/device.h>
789309da3SJiri Pirko #include <linux/sysfs.h>
889309da3SJiri Pirko #include <linux/hwmon.h>
989309da3SJiri Pirko #include <linux/err.h>
105c42eaa0SVadim Pasternak #include <linux/sfp.h>
1189309da3SJiri Pirko
1289309da3SJiri Pirko #include "core.h"
135c42eaa0SVadim Pasternak #include "core_env.h"
1489309da3SJiri Pirko
1502bed4e8SAmit Cohen #define MLXSW_HWMON_SENSORS_MAX_COUNT 64
1602bed4e8SAmit Cohen #define MLXSW_HWMON_MODULES_MAX_COUNT 64
1702bed4e8SAmit Cohen #define MLXSW_HWMON_GEARBOXES_MAX_COUNT 32
1802bed4e8SAmit Cohen
1902bed4e8SAmit Cohen #define MLXSW_HWMON_ATTR_PER_SENSOR 3
2091df5d3aSAmit Cohen #define MLXSW_HWMON_ATTR_PER_MODULE 7
2102bed4e8SAmit Cohen #define MLXSW_HWMON_ATTR_PER_GEARBOX 4
2299a03b31SVadim Pasternak #define MLXSW_HWMON_DEV_NAME_LEN_MAX 16
2302bed4e8SAmit Cohen
2402bed4e8SAmit Cohen #define MLXSW_HWMON_ATTR_COUNT (MLXSW_HWMON_SENSORS_MAX_COUNT * MLXSW_HWMON_ATTR_PER_SENSOR + \
2502bed4e8SAmit Cohen MLXSW_HWMON_MODULES_MAX_COUNT * MLXSW_HWMON_ATTR_PER_MODULE + \
2602bed4e8SAmit Cohen MLXSW_HWMON_GEARBOXES_MAX_COUNT * MLXSW_HWMON_ATTR_PER_GEARBOX + \
2752581961SJiri Pirko MLXSW_MFCR_TACHOS_MAX + MLXSW_MFCR_PWMS_MAX)
2889309da3SJiri Pirko
2989309da3SJiri Pirko struct mlxsw_hwmon_attr {
3089309da3SJiri Pirko struct device_attribute dev_attr;
31b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev;
3289309da3SJiri Pirko unsigned int type_index;
33e7bc73cbSJiri Pirko char name[32];
3489309da3SJiri Pirko };
3589309da3SJiri Pirko
mlxsw_hwmon_get_attr_index(int index,int count)362e265a8bSVadim Pasternak static int mlxsw_hwmon_get_attr_index(int index, int count)
372e265a8bSVadim Pasternak {
382e265a8bSVadim Pasternak if (index >= count)
392e265a8bSVadim Pasternak return index % count + MLXSW_REG_MTMP_GBOX_INDEX_MIN;
402e265a8bSVadim Pasternak
412e265a8bSVadim Pasternak return index;
422e265a8bSVadim Pasternak }
432e265a8bSVadim Pasternak
44b890ad41SVadim Pasternak struct mlxsw_hwmon_dev {
4599a03b31SVadim Pasternak char name[MLXSW_HWMON_DEV_NAME_LEN_MAX];
46b890ad41SVadim Pasternak struct mlxsw_hwmon *hwmon;
4789309da3SJiri Pirko struct device *hwmon_dev;
4889309da3SJiri Pirko struct attribute_group group;
4989309da3SJiri Pirko const struct attribute_group *groups[2];
5089309da3SJiri Pirko struct attribute *attrs[MLXSW_HWMON_ATTR_COUNT + 1];
5189309da3SJiri Pirko struct mlxsw_hwmon_attr hwmon_attrs[MLXSW_HWMON_ATTR_COUNT];
5289309da3SJiri Pirko unsigned int attrs_count;
535c42eaa0SVadim Pasternak u8 sensor_count;
54ea30a92aSVadim Pasternak u8 module_sensor_max;
55fd27849dSVadim Pasternak u8 slot_index;
5699a03b31SVadim Pasternak bool active;
5789309da3SJiri Pirko };
5889309da3SJiri Pirko
59b890ad41SVadim Pasternak struct mlxsw_hwmon {
60b890ad41SVadim Pasternak struct mlxsw_core *core;
61b890ad41SVadim Pasternak const struct mlxsw_bus_info *bus_info;
62b890ad41SVadim Pasternak struct mlxsw_hwmon_dev line_cards[];
63b890ad41SVadim Pasternak };
64b890ad41SVadim Pasternak
mlxsw_hwmon_temp_show(struct device * dev,struct device_attribute * attr,char * buf)6589309da3SJiri Pirko static ssize_t mlxsw_hwmon_temp_show(struct device *dev,
6689309da3SJiri Pirko struct device_attribute *attr,
6789309da3SJiri Pirko char *buf)
6889309da3SJiri Pirko {
69bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
7089309da3SJiri Pirko container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
71b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
72b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
7389309da3SJiri Pirko char mtmp_pl[MLXSW_REG_MTMP_LEN];
74f485cc36SVadim Pasternak int temp, index;
7589309da3SJiri Pirko int err;
7689309da3SJiri Pirko
77bed8f419SVadim Pasternak index = mlxsw_hwmon_get_attr_index(mlxsw_hwmon_attr->type_index,
78b890ad41SVadim Pasternak mlxsw_hwmon_dev->module_sensor_max);
79fd27849dSVadim Pasternak mlxsw_reg_mtmp_pack(mtmp_pl, mlxsw_hwmon_dev->slot_index, index, false,
80fd27849dSVadim Pasternak false);
8189309da3SJiri Pirko err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mtmp), mtmp_pl);
8289309da3SJiri Pirko if (err) {
8389309da3SJiri Pirko dev_err(mlxsw_hwmon->bus_info->dev, "Failed to query temp sensor\n");
8489309da3SJiri Pirko return err;
8589309da3SJiri Pirko }
86314dbb19SMykola Kostenok mlxsw_reg_mtmp_unpack(mtmp_pl, &temp, NULL, NULL, NULL, NULL);
87f485cc36SVadim Pasternak return sprintf(buf, "%d\n", temp);
8889309da3SJiri Pirko }
8989309da3SJiri Pirko
mlxsw_hwmon_temp_max_show(struct device * dev,struct device_attribute * attr,char * buf)9089309da3SJiri Pirko static ssize_t mlxsw_hwmon_temp_max_show(struct device *dev,
9189309da3SJiri Pirko struct device_attribute *attr,
9289309da3SJiri Pirko char *buf)
9389309da3SJiri Pirko {
94bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
9589309da3SJiri Pirko container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
96b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
97b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
9889309da3SJiri Pirko char mtmp_pl[MLXSW_REG_MTMP_LEN];
99f485cc36SVadim Pasternak int temp_max, index;
10089309da3SJiri Pirko int err;
10189309da3SJiri Pirko
102bed8f419SVadim Pasternak index = mlxsw_hwmon_get_attr_index(mlxsw_hwmon_attr->type_index,
103b890ad41SVadim Pasternak mlxsw_hwmon_dev->module_sensor_max);
104fd27849dSVadim Pasternak mlxsw_reg_mtmp_pack(mtmp_pl, mlxsw_hwmon_dev->slot_index, index, false,
105fd27849dSVadim Pasternak false);
10689309da3SJiri Pirko err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mtmp), mtmp_pl);
10789309da3SJiri Pirko if (err) {
10889309da3SJiri Pirko dev_err(mlxsw_hwmon->bus_info->dev, "Failed to query temp sensor\n");
10989309da3SJiri Pirko return err;
11089309da3SJiri Pirko }
111314dbb19SMykola Kostenok mlxsw_reg_mtmp_unpack(mtmp_pl, NULL, &temp_max, NULL, NULL, NULL);
112f485cc36SVadim Pasternak return sprintf(buf, "%d\n", temp_max);
11389309da3SJiri Pirko }
11489309da3SJiri Pirko
mlxsw_hwmon_temp_rst_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)115e7bc73cbSJiri Pirko static ssize_t mlxsw_hwmon_temp_rst_store(struct device *dev,
116e7bc73cbSJiri Pirko struct device_attribute *attr,
117e7bc73cbSJiri Pirko const char *buf, size_t len)
118e7bc73cbSJiri Pirko {
119bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
120e7bc73cbSJiri Pirko container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
121b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
122b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
123b890ad41SVadim Pasternak char mtmp_pl[MLXSW_REG_MTMP_LEN];
124e7bc73cbSJiri Pirko unsigned long val;
1252e265a8bSVadim Pasternak int index;
126e7bc73cbSJiri Pirko int err;
127e7bc73cbSJiri Pirko
128e7bc73cbSJiri Pirko err = kstrtoul(buf, 10, &val);
129e7bc73cbSJiri Pirko if (err)
130e7bc73cbSJiri Pirko return err;
131e7bc73cbSJiri Pirko if (val != 1)
132e7bc73cbSJiri Pirko return -EINVAL;
133e7bc73cbSJiri Pirko
134bed8f419SVadim Pasternak index = mlxsw_hwmon_get_attr_index(mlxsw_hwmon_attr->type_index,
135b890ad41SVadim Pasternak mlxsw_hwmon_dev->module_sensor_max);
136fb1292f8SAmit Cohen
137fd27849dSVadim Pasternak mlxsw_reg_mtmp_slot_index_set(mtmp_pl, mlxsw_hwmon_dev->slot_index);
138fb1292f8SAmit Cohen mlxsw_reg_mtmp_sensor_index_set(mtmp_pl, index);
139fb1292f8SAmit Cohen err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mtmp), mtmp_pl);
140fb1292f8SAmit Cohen if (err)
141fb1292f8SAmit Cohen return err;
142fb1292f8SAmit Cohen mlxsw_reg_mtmp_mte_set(mtmp_pl, true);
143fb1292f8SAmit Cohen mlxsw_reg_mtmp_mtr_set(mtmp_pl, true);
144e7bc73cbSJiri Pirko err = mlxsw_reg_write(mlxsw_hwmon->core, MLXSW_REG(mtmp), mtmp_pl);
145e7bc73cbSJiri Pirko if (err) {
146e7bc73cbSJiri Pirko dev_err(mlxsw_hwmon->bus_info->dev, "Failed to reset temp sensor history\n");
147e7bc73cbSJiri Pirko return err;
148e7bc73cbSJiri Pirko }
149719255d0SDan Carpenter return len;
150e7bc73cbSJiri Pirko }
151e7bc73cbSJiri Pirko
mlxsw_hwmon_fan_rpm_show(struct device * dev,struct device_attribute * attr,char * buf)15252581961SJiri Pirko static ssize_t mlxsw_hwmon_fan_rpm_show(struct device *dev,
15352581961SJiri Pirko struct device_attribute *attr,
15452581961SJiri Pirko char *buf)
15552581961SJiri Pirko {
156bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
15752581961SJiri Pirko container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
158b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
159b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
16052581961SJiri Pirko char mfsm_pl[MLXSW_REG_MFSM_LEN];
16152581961SJiri Pirko int err;
16252581961SJiri Pirko
163bed8f419SVadim Pasternak mlxsw_reg_mfsm_pack(mfsm_pl, mlxsw_hwmon_attr->type_index);
16452581961SJiri Pirko err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mfsm), mfsm_pl);
16552581961SJiri Pirko if (err) {
16652581961SJiri Pirko dev_err(mlxsw_hwmon->bus_info->dev, "Failed to query fan\n");
16752581961SJiri Pirko return err;
16852581961SJiri Pirko }
16952581961SJiri Pirko return sprintf(buf, "%u\n", mlxsw_reg_mfsm_rpm_get(mfsm_pl));
17052581961SJiri Pirko }
17152581961SJiri Pirko
mlxsw_hwmon_fan_fault_show(struct device * dev,struct device_attribute * attr,char * buf)1722c6a33cdSVadim Pasternak static ssize_t mlxsw_hwmon_fan_fault_show(struct device *dev,
1732c6a33cdSVadim Pasternak struct device_attribute *attr,
1742c6a33cdSVadim Pasternak char *buf)
1752c6a33cdSVadim Pasternak {
176bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
1772c6a33cdSVadim Pasternak container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
178b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
179b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
1802c6a33cdSVadim Pasternak char fore_pl[MLXSW_REG_FORE_LEN];
1812c6a33cdSVadim Pasternak bool fault;
1822c6a33cdSVadim Pasternak int err;
1832c6a33cdSVadim Pasternak
1842c6a33cdSVadim Pasternak err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(fore), fore_pl);
1852c6a33cdSVadim Pasternak if (err) {
1862c6a33cdSVadim Pasternak dev_err(mlxsw_hwmon->bus_info->dev, "Failed to query fan\n");
1872c6a33cdSVadim Pasternak return err;
1882c6a33cdSVadim Pasternak }
189bed8f419SVadim Pasternak mlxsw_reg_fore_unpack(fore_pl, mlxsw_hwmon_attr->type_index, &fault);
1902c6a33cdSVadim Pasternak
1912c6a33cdSVadim Pasternak return sprintf(buf, "%u\n", fault);
1922c6a33cdSVadim Pasternak }
1932c6a33cdSVadim Pasternak
mlxsw_hwmon_pwm_show(struct device * dev,struct device_attribute * attr,char * buf)19452581961SJiri Pirko static ssize_t mlxsw_hwmon_pwm_show(struct device *dev,
19552581961SJiri Pirko struct device_attribute *attr,
19652581961SJiri Pirko char *buf)
19752581961SJiri Pirko {
198bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
19952581961SJiri Pirko container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
200b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
201b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
20252581961SJiri Pirko char mfsc_pl[MLXSW_REG_MFSC_LEN];
20352581961SJiri Pirko int err;
20452581961SJiri Pirko
205bed8f419SVadim Pasternak mlxsw_reg_mfsc_pack(mfsc_pl, mlxsw_hwmon_attr->type_index, 0);
20652581961SJiri Pirko err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mfsc), mfsc_pl);
20752581961SJiri Pirko if (err) {
20852581961SJiri Pirko dev_err(mlxsw_hwmon->bus_info->dev, "Failed to query PWM\n");
20952581961SJiri Pirko return err;
21052581961SJiri Pirko }
21152581961SJiri Pirko return sprintf(buf, "%u\n",
21252581961SJiri Pirko mlxsw_reg_mfsc_pwm_duty_cycle_get(mfsc_pl));
21352581961SJiri Pirko }
21452581961SJiri Pirko
mlxsw_hwmon_pwm_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)21552581961SJiri Pirko static ssize_t mlxsw_hwmon_pwm_store(struct device *dev,
21652581961SJiri Pirko struct device_attribute *attr,
21752581961SJiri Pirko const char *buf, size_t len)
21852581961SJiri Pirko {
219bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
22052581961SJiri Pirko container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
221b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
222b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
22352581961SJiri Pirko char mfsc_pl[MLXSW_REG_MFSC_LEN];
22452581961SJiri Pirko unsigned long val;
22552581961SJiri Pirko int err;
22652581961SJiri Pirko
22752581961SJiri Pirko err = kstrtoul(buf, 10, &val);
22852581961SJiri Pirko if (err)
22952581961SJiri Pirko return err;
23052581961SJiri Pirko if (val > 255)
23152581961SJiri Pirko return -EINVAL;
23252581961SJiri Pirko
233bed8f419SVadim Pasternak mlxsw_reg_mfsc_pack(mfsc_pl, mlxsw_hwmon_attr->type_index, val);
23452581961SJiri Pirko err = mlxsw_reg_write(mlxsw_hwmon->core, MLXSW_REG(mfsc), mfsc_pl);
23552581961SJiri Pirko if (err) {
23652581961SJiri Pirko dev_err(mlxsw_hwmon->bus_info->dev, "Failed to write PWM\n");
23752581961SJiri Pirko return err;
23852581961SJiri Pirko }
239515123e2SDan Carpenter return len;
24052581961SJiri Pirko }
24152581961SJiri Pirko
mlxsw_hwmon_module_temp_get(struct device * dev,struct device_attribute * attr,int * p_temp)242ad38d47bSAmit Cohen static int mlxsw_hwmon_module_temp_get(struct device *dev,
2435c42eaa0SVadim Pasternak struct device_attribute *attr,
244ad38d47bSAmit Cohen int *p_temp)
2455c42eaa0SVadim Pasternak {
246bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
2475c42eaa0SVadim Pasternak container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
248b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
249b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
250e4e93d6dSVadim Pasternak char mtmp_pl[MLXSW_REG_MTMP_LEN];
2515c42eaa0SVadim Pasternak u8 module;
2525c42eaa0SVadim Pasternak int err;
2535c42eaa0SVadim Pasternak
254b890ad41SVadim Pasternak module = mlxsw_hwmon_attr->type_index - mlxsw_hwmon_dev->sensor_count;
255fd27849dSVadim Pasternak mlxsw_reg_mtmp_pack(mtmp_pl, mlxsw_hwmon_dev->slot_index,
256d30bed29SVadim Pasternak MLXSW_REG_MTMP_MODULE_INDEX_MIN + module, false,
257d30bed29SVadim Pasternak false);
258e4e93d6dSVadim Pasternak err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mtmp), mtmp_pl);
259ad38d47bSAmit Cohen if (err) {
260ad38d47bSAmit Cohen dev_err(dev, "Failed to query module temperature\n");
261ad38d47bSAmit Cohen return err;
262ad38d47bSAmit Cohen }
263314dbb19SMykola Kostenok mlxsw_reg_mtmp_unpack(mtmp_pl, p_temp, NULL, NULL, NULL, NULL);
264ad38d47bSAmit Cohen
265ad38d47bSAmit Cohen return 0;
266ad38d47bSAmit Cohen }
267ad38d47bSAmit Cohen
mlxsw_hwmon_module_temp_show(struct device * dev,struct device_attribute * attr,char * buf)268ad38d47bSAmit Cohen static ssize_t mlxsw_hwmon_module_temp_show(struct device *dev,
269ad38d47bSAmit Cohen struct device_attribute *attr,
270ad38d47bSAmit Cohen char *buf)
271ad38d47bSAmit Cohen {
272ad38d47bSAmit Cohen int err, temp;
273ad38d47bSAmit Cohen
274ad38d47bSAmit Cohen err = mlxsw_hwmon_module_temp_get(dev, attr, &temp);
275e4e93d6dSVadim Pasternak if (err)
2765c42eaa0SVadim Pasternak return err;
2775c42eaa0SVadim Pasternak
278f485cc36SVadim Pasternak return sprintf(buf, "%d\n", temp);
2795c42eaa0SVadim Pasternak }
2805c42eaa0SVadim Pasternak
mlxsw_hwmon_module_temp_fault_show(struct device * dev,struct device_attribute * attr,char * buf)2815c42eaa0SVadim Pasternak static ssize_t mlxsw_hwmon_module_temp_fault_show(struct device *dev,
2825c42eaa0SVadim Pasternak struct device_attribute *attr,
2835c42eaa0SVadim Pasternak char *buf)
2845c42eaa0SVadim Pasternak {
285bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
2865c42eaa0SVadim Pasternak container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
287b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
288b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
2895c42eaa0SVadim Pasternak char mtbr_pl[MLXSW_REG_MTBR_LEN] = {0};
2905c42eaa0SVadim Pasternak u8 module, fault;
2915c42eaa0SVadim Pasternak u16 temp;
2925c42eaa0SVadim Pasternak int err;
2935c42eaa0SVadim Pasternak
294b890ad41SVadim Pasternak module = mlxsw_hwmon_attr->type_index - mlxsw_hwmon_dev->sensor_count;
295fd27849dSVadim Pasternak mlxsw_reg_mtbr_pack(mtbr_pl, mlxsw_hwmon_dev->slot_index,
296fd27849dSVadim Pasternak MLXSW_REG_MTBR_BASE_MODULE_INDEX + module, 1);
2975c42eaa0SVadim Pasternak err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mtbr), mtbr_pl);
2985c42eaa0SVadim Pasternak if (err) {
29959e6158aSColin Ian King dev_err(dev, "Failed to query module temperature sensor\n");
3005c42eaa0SVadim Pasternak return err;
3015c42eaa0SVadim Pasternak }
3025c42eaa0SVadim Pasternak
3035c42eaa0SVadim Pasternak mlxsw_reg_mtbr_temp_unpack(mtbr_pl, 0, &temp, NULL);
3045c42eaa0SVadim Pasternak
3055c42eaa0SVadim Pasternak /* Update status and temperature cache. */
3065c42eaa0SVadim Pasternak switch (temp) {
3075c42eaa0SVadim Pasternak case MLXSW_REG_MTBR_BAD_SENS_INFO:
3085c42eaa0SVadim Pasternak /* Untrusted cable is connected. Reading temperature from its
3095c42eaa0SVadim Pasternak * sensor is faulty.
3105c42eaa0SVadim Pasternak */
3115c42eaa0SVadim Pasternak fault = 1;
3125c42eaa0SVadim Pasternak break;
313df561f66SGustavo A. R. Silva case MLXSW_REG_MTBR_NO_CONN:
314df561f66SGustavo A. R. Silva case MLXSW_REG_MTBR_NO_TEMP_SENS:
3155c42eaa0SVadim Pasternak case MLXSW_REG_MTBR_INDEX_NA:
3165c42eaa0SVadim Pasternak default:
3175c42eaa0SVadim Pasternak fault = 0;
3185c42eaa0SVadim Pasternak break;
3195c42eaa0SVadim Pasternak }
3205c42eaa0SVadim Pasternak
3215c42eaa0SVadim Pasternak return sprintf(buf, "%u\n", fault);
3225c42eaa0SVadim Pasternak }
3235c42eaa0SVadim Pasternak
mlxsw_hwmon_module_temp_critical_get(struct device * dev,struct device_attribute * attr,int * p_temp)324ad38d47bSAmit Cohen static int mlxsw_hwmon_module_temp_critical_get(struct device *dev,
325ad38d47bSAmit Cohen struct device_attribute *attr,
326ad38d47bSAmit Cohen int *p_temp)
3275c42eaa0SVadim Pasternak {
328bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
3295c42eaa0SVadim Pasternak container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
330b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
331b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
3325c42eaa0SVadim Pasternak u8 module;
3335c42eaa0SVadim Pasternak int err;
3345c42eaa0SVadim Pasternak
335b890ad41SVadim Pasternak module = mlxsw_hwmon_attr->type_index - mlxsw_hwmon_dev->sensor_count;
336fd27849dSVadim Pasternak err = mlxsw_env_module_temp_thresholds_get(mlxsw_hwmon->core,
337fd27849dSVadim Pasternak mlxsw_hwmon_dev->slot_index,
33834945452SVadim Pasternak module, SFP_TEMP_HIGH_WARN,
33934945452SVadim Pasternak p_temp);
3405c42eaa0SVadim Pasternak if (err) {
34159e6158aSColin Ian King dev_err(dev, "Failed to query module temperature thresholds\n");
3425c42eaa0SVadim Pasternak return err;
3435c42eaa0SVadim Pasternak }
3445c42eaa0SVadim Pasternak
345ad38d47bSAmit Cohen return 0;
346ad38d47bSAmit Cohen }
347ad38d47bSAmit Cohen
348ad38d47bSAmit Cohen static ssize_t
mlxsw_hwmon_module_temp_critical_show(struct device * dev,struct device_attribute * attr,char * buf)349ad38d47bSAmit Cohen mlxsw_hwmon_module_temp_critical_show(struct device *dev,
350ad38d47bSAmit Cohen struct device_attribute *attr, char *buf)
351ad38d47bSAmit Cohen {
352ad38d47bSAmit Cohen int err, temp;
353ad38d47bSAmit Cohen
354ad38d47bSAmit Cohen err = mlxsw_hwmon_module_temp_critical_get(dev, attr, &temp);
355ad38d47bSAmit Cohen if (err)
356ad38d47bSAmit Cohen return err;
357ad38d47bSAmit Cohen
3585c42eaa0SVadim Pasternak return sprintf(buf, "%u\n", temp);
3595c42eaa0SVadim Pasternak }
3605c42eaa0SVadim Pasternak
mlxsw_hwmon_module_temp_emergency_get(struct device * dev,struct device_attribute * attr,int * p_temp)361ad38d47bSAmit Cohen static int mlxsw_hwmon_module_temp_emergency_get(struct device *dev,
362ad38d47bSAmit Cohen struct device_attribute *attr,
363ad38d47bSAmit Cohen int *p_temp)
364ad38d47bSAmit Cohen {
365bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
366ad38d47bSAmit Cohen container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
367b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
368b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
369ad38d47bSAmit Cohen u8 module;
370ad38d47bSAmit Cohen int err;
371ad38d47bSAmit Cohen
372b890ad41SVadim Pasternak module = mlxsw_hwmon_attr->type_index - mlxsw_hwmon_dev->sensor_count;
373fd27849dSVadim Pasternak err = mlxsw_env_module_temp_thresholds_get(mlxsw_hwmon->core,
374fd27849dSVadim Pasternak mlxsw_hwmon_dev->slot_index,
37534945452SVadim Pasternak module, SFP_TEMP_HIGH_ALARM,
37634945452SVadim Pasternak p_temp);
377ad38d47bSAmit Cohen if (err) {
378ad38d47bSAmit Cohen dev_err(dev, "Failed to query module temperature thresholds\n");
379ad38d47bSAmit Cohen return err;
380ad38d47bSAmit Cohen }
381ad38d47bSAmit Cohen
382ad38d47bSAmit Cohen return 0;
383ad38d47bSAmit Cohen }
384ad38d47bSAmit Cohen
3855c42eaa0SVadim Pasternak static ssize_t
mlxsw_hwmon_module_temp_emergency_show(struct device * dev,struct device_attribute * attr,char * buf)3865c42eaa0SVadim Pasternak mlxsw_hwmon_module_temp_emergency_show(struct device *dev,
3875c42eaa0SVadim Pasternak struct device_attribute *attr,
3885c42eaa0SVadim Pasternak char *buf)
3895c42eaa0SVadim Pasternak {
390ad38d47bSAmit Cohen int err, temp;
3915c42eaa0SVadim Pasternak
392ad38d47bSAmit Cohen err = mlxsw_hwmon_module_temp_emergency_get(dev, attr, &temp);
393ad38d47bSAmit Cohen if (err)
3945c42eaa0SVadim Pasternak return err;
3955c42eaa0SVadim Pasternak
3965c42eaa0SVadim Pasternak return sprintf(buf, "%u\n", temp);
3975c42eaa0SVadim Pasternak }
3985c42eaa0SVadim Pasternak
399a53779deSVadim Pasternak static ssize_t
mlxsw_hwmon_module_temp_label_show(struct device * dev,struct device_attribute * attr,char * buf)400a53779deSVadim Pasternak mlxsw_hwmon_module_temp_label_show(struct device *dev,
401a53779deSVadim Pasternak struct device_attribute *attr,
402a53779deSVadim Pasternak char *buf)
403a53779deSVadim Pasternak {
404bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
405a53779deSVadim Pasternak container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
406a53779deSVadim Pasternak
407a53779deSVadim Pasternak return sprintf(buf, "front panel %03u\n",
408*3fc134a0SVadim Pasternak mlxsw_hwmon_attr->type_index + 1 -
409*3fc134a0SVadim Pasternak mlxsw_hwmon_attr->mlxsw_hwmon_dev->sensor_count);
410a53779deSVadim Pasternak }
411a53779deSVadim Pasternak
4122e265a8bSVadim Pasternak static ssize_t
mlxsw_hwmon_gbox_temp_label_show(struct device * dev,struct device_attribute * attr,char * buf)4132e265a8bSVadim Pasternak mlxsw_hwmon_gbox_temp_label_show(struct device *dev,
4142e265a8bSVadim Pasternak struct device_attribute *attr,
4152e265a8bSVadim Pasternak char *buf)
4162e265a8bSVadim Pasternak {
417bed8f419SVadim Pasternak struct mlxsw_hwmon_attr *mlxsw_hwmon_attr =
4182e265a8bSVadim Pasternak container_of(attr, struct mlxsw_hwmon_attr, dev_attr);
419b890ad41SVadim Pasternak struct mlxsw_hwmon_dev *mlxsw_hwmon_dev = mlxsw_hwmon_attr->mlxsw_hwmon_dev;
420bed8f419SVadim Pasternak int index = mlxsw_hwmon_attr->type_index -
421b890ad41SVadim Pasternak mlxsw_hwmon_dev->module_sensor_max + 1;
4222e265a8bSVadim Pasternak
4232e265a8bSVadim Pasternak return sprintf(buf, "gearbox %03u\n", index);
4242e265a8bSVadim Pasternak }
4252e265a8bSVadim Pasternak
mlxsw_hwmon_temp_critical_alarm_show(struct device * dev,struct device_attribute * attr,char * buf)42691df5d3aSAmit Cohen static ssize_t mlxsw_hwmon_temp_critical_alarm_show(struct device *dev,
42791df5d3aSAmit Cohen struct device_attribute *attr,
42891df5d3aSAmit Cohen char *buf)
42991df5d3aSAmit Cohen {
43091df5d3aSAmit Cohen int err, temp, emergency_temp, critic_temp;
43191df5d3aSAmit Cohen
43291df5d3aSAmit Cohen err = mlxsw_hwmon_module_temp_get(dev, attr, &temp);
43391df5d3aSAmit Cohen if (err)
43491df5d3aSAmit Cohen return err;
43591df5d3aSAmit Cohen
43691df5d3aSAmit Cohen if (temp <= 0)
43791df5d3aSAmit Cohen return sprintf(buf, "%d\n", false);
43891df5d3aSAmit Cohen
43991df5d3aSAmit Cohen err = mlxsw_hwmon_module_temp_emergency_get(dev, attr, &emergency_temp);
44091df5d3aSAmit Cohen if (err)
44191df5d3aSAmit Cohen return err;
44291df5d3aSAmit Cohen
44391df5d3aSAmit Cohen if (temp >= emergency_temp)
44491df5d3aSAmit Cohen return sprintf(buf, "%d\n", false);
44591df5d3aSAmit Cohen
44691df5d3aSAmit Cohen err = mlxsw_hwmon_module_temp_critical_get(dev, attr, &critic_temp);
44791df5d3aSAmit Cohen if (err)
44891df5d3aSAmit Cohen return err;
44991df5d3aSAmit Cohen
45091df5d3aSAmit Cohen return sprintf(buf, "%d\n", temp >= critic_temp);
45191df5d3aSAmit Cohen }
45291df5d3aSAmit Cohen
mlxsw_hwmon_temp_emergency_alarm_show(struct device * dev,struct device_attribute * attr,char * buf)45391df5d3aSAmit Cohen static ssize_t mlxsw_hwmon_temp_emergency_alarm_show(struct device *dev,
45491df5d3aSAmit Cohen struct device_attribute *attr,
45591df5d3aSAmit Cohen char *buf)
45691df5d3aSAmit Cohen {
45791df5d3aSAmit Cohen int err, temp, emergency_temp;
45891df5d3aSAmit Cohen
45991df5d3aSAmit Cohen err = mlxsw_hwmon_module_temp_get(dev, attr, &temp);
46091df5d3aSAmit Cohen if (err)
46191df5d3aSAmit Cohen return err;
46291df5d3aSAmit Cohen
46391df5d3aSAmit Cohen if (temp <= 0)
46491df5d3aSAmit Cohen return sprintf(buf, "%d\n", false);
46591df5d3aSAmit Cohen
46691df5d3aSAmit Cohen err = mlxsw_hwmon_module_temp_emergency_get(dev, attr, &emergency_temp);
46791df5d3aSAmit Cohen if (err)
46891df5d3aSAmit Cohen return err;
46991df5d3aSAmit Cohen
47091df5d3aSAmit Cohen return sprintf(buf, "%d\n", temp >= emergency_temp);
47191df5d3aSAmit Cohen }
47291df5d3aSAmit Cohen
47389309da3SJiri Pirko enum mlxsw_hwmon_attr_type {
47489309da3SJiri Pirko MLXSW_HWMON_ATTR_TYPE_TEMP,
47589309da3SJiri Pirko MLXSW_HWMON_ATTR_TYPE_TEMP_MAX,
476e7bc73cbSJiri Pirko MLXSW_HWMON_ATTR_TYPE_TEMP_RST,
47752581961SJiri Pirko MLXSW_HWMON_ATTR_TYPE_FAN_RPM,
4782c6a33cdSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_FAN_FAULT,
47952581961SJiri Pirko MLXSW_HWMON_ATTR_TYPE_PWM,
4805c42eaa0SVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE,
4815c42eaa0SVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_FAULT,
4825c42eaa0SVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_CRIT,
4835c42eaa0SVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_EMERG,
484a53779deSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_LABEL,
4852e265a8bSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_GBOX_LABEL,
48691df5d3aSAmit Cohen MLXSW_HWMON_ATTR_TYPE_TEMP_CRIT_ALARM,
48791df5d3aSAmit Cohen MLXSW_HWMON_ATTR_TYPE_TEMP_EMERGENCY_ALARM,
48889309da3SJiri Pirko };
48989309da3SJiri Pirko
mlxsw_hwmon_attr_add(struct mlxsw_hwmon_dev * mlxsw_hwmon_dev,enum mlxsw_hwmon_attr_type attr_type,unsigned int type_index,unsigned int num)490b890ad41SVadim Pasternak static void mlxsw_hwmon_attr_add(struct mlxsw_hwmon_dev *mlxsw_hwmon_dev,
49189309da3SJiri Pirko enum mlxsw_hwmon_attr_type attr_type,
492b890ad41SVadim Pasternak unsigned int type_index, unsigned int num)
493b890ad41SVadim Pasternak {
49489309da3SJiri Pirko struct mlxsw_hwmon_attr *mlxsw_hwmon_attr;
49589309da3SJiri Pirko unsigned int attr_index;
49689309da3SJiri Pirko
497b890ad41SVadim Pasternak attr_index = mlxsw_hwmon_dev->attrs_count;
498b890ad41SVadim Pasternak mlxsw_hwmon_attr = &mlxsw_hwmon_dev->hwmon_attrs[attr_index];
49989309da3SJiri Pirko
50089309da3SJiri Pirko switch (attr_type) {
50189309da3SJiri Pirko case MLXSW_HWMON_ATTR_TYPE_TEMP:
50289309da3SJiri Pirko mlxsw_hwmon_attr->dev_attr.show = mlxsw_hwmon_temp_show;
503d3757ba4SJoe Perches mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
50489309da3SJiri Pirko snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
50589309da3SJiri Pirko "temp%u_input", num + 1);
50689309da3SJiri Pirko break;
50789309da3SJiri Pirko case MLXSW_HWMON_ATTR_TYPE_TEMP_MAX:
50889309da3SJiri Pirko mlxsw_hwmon_attr->dev_attr.show = mlxsw_hwmon_temp_max_show;
509d3757ba4SJoe Perches mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
51089309da3SJiri Pirko snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
51189309da3SJiri Pirko "temp%u_highest", num + 1);
51289309da3SJiri Pirko break;
513e7bc73cbSJiri Pirko case MLXSW_HWMON_ATTR_TYPE_TEMP_RST:
514e7bc73cbSJiri Pirko mlxsw_hwmon_attr->dev_attr.store = mlxsw_hwmon_temp_rst_store;
515d3757ba4SJoe Perches mlxsw_hwmon_attr->dev_attr.attr.mode = 0200;
516e7bc73cbSJiri Pirko snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
517e7bc73cbSJiri Pirko "temp%u_reset_history", num + 1);
518e7bc73cbSJiri Pirko break;
51952581961SJiri Pirko case MLXSW_HWMON_ATTR_TYPE_FAN_RPM:
52052581961SJiri Pirko mlxsw_hwmon_attr->dev_attr.show = mlxsw_hwmon_fan_rpm_show;
521d3757ba4SJoe Perches mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
52252581961SJiri Pirko snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
52352581961SJiri Pirko "fan%u_input", num + 1);
52452581961SJiri Pirko break;
5252c6a33cdSVadim Pasternak case MLXSW_HWMON_ATTR_TYPE_FAN_FAULT:
5262c6a33cdSVadim Pasternak mlxsw_hwmon_attr->dev_attr.show = mlxsw_hwmon_fan_fault_show;
5272c6a33cdSVadim Pasternak mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
5282c6a33cdSVadim Pasternak snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
5292c6a33cdSVadim Pasternak "fan%u_fault", num + 1);
5302c6a33cdSVadim Pasternak break;
53152581961SJiri Pirko case MLXSW_HWMON_ATTR_TYPE_PWM:
53252581961SJiri Pirko mlxsw_hwmon_attr->dev_attr.show = mlxsw_hwmon_pwm_show;
53352581961SJiri Pirko mlxsw_hwmon_attr->dev_attr.store = mlxsw_hwmon_pwm_store;
534d3757ba4SJoe Perches mlxsw_hwmon_attr->dev_attr.attr.mode = 0644;
53552581961SJiri Pirko snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
53652581961SJiri Pirko "pwm%u", num + 1);
53752581961SJiri Pirko break;
5385c42eaa0SVadim Pasternak case MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE:
5395c42eaa0SVadim Pasternak mlxsw_hwmon_attr->dev_attr.show = mlxsw_hwmon_module_temp_show;
5405c42eaa0SVadim Pasternak mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
5415c42eaa0SVadim Pasternak snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
5425c42eaa0SVadim Pasternak "temp%u_input", num + 1);
5435c42eaa0SVadim Pasternak break;
5445c42eaa0SVadim Pasternak case MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_FAULT:
5455c42eaa0SVadim Pasternak mlxsw_hwmon_attr->dev_attr.show =
5465c42eaa0SVadim Pasternak mlxsw_hwmon_module_temp_fault_show;
5475c42eaa0SVadim Pasternak mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
5485c42eaa0SVadim Pasternak snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
5495c42eaa0SVadim Pasternak "temp%u_fault", num + 1);
5505c42eaa0SVadim Pasternak break;
5515c42eaa0SVadim Pasternak case MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_CRIT:
5525c42eaa0SVadim Pasternak mlxsw_hwmon_attr->dev_attr.show =
5535c42eaa0SVadim Pasternak mlxsw_hwmon_module_temp_critical_show;
5545c42eaa0SVadim Pasternak mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
5555c42eaa0SVadim Pasternak snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
5565c42eaa0SVadim Pasternak "temp%u_crit", num + 1);
5575c42eaa0SVadim Pasternak break;
5585c42eaa0SVadim Pasternak case MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_EMERG:
5595c42eaa0SVadim Pasternak mlxsw_hwmon_attr->dev_attr.show =
5605c42eaa0SVadim Pasternak mlxsw_hwmon_module_temp_emergency_show;
5615c42eaa0SVadim Pasternak mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
5625c42eaa0SVadim Pasternak snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
5635c42eaa0SVadim Pasternak "temp%u_emergency", num + 1);
5645c42eaa0SVadim Pasternak break;
565a53779deSVadim Pasternak case MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_LABEL:
566a53779deSVadim Pasternak mlxsw_hwmon_attr->dev_attr.show =
567a53779deSVadim Pasternak mlxsw_hwmon_module_temp_label_show;
568a53779deSVadim Pasternak mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
569a53779deSVadim Pasternak snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
570a53779deSVadim Pasternak "temp%u_label", num + 1);
571a53779deSVadim Pasternak break;
5722e265a8bSVadim Pasternak case MLXSW_HWMON_ATTR_TYPE_TEMP_GBOX_LABEL:
5732e265a8bSVadim Pasternak mlxsw_hwmon_attr->dev_attr.show =
5742e265a8bSVadim Pasternak mlxsw_hwmon_gbox_temp_label_show;
5752e265a8bSVadim Pasternak mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
5762e265a8bSVadim Pasternak snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
5772e265a8bSVadim Pasternak "temp%u_label", num + 1);
5782e265a8bSVadim Pasternak break;
57991df5d3aSAmit Cohen case MLXSW_HWMON_ATTR_TYPE_TEMP_CRIT_ALARM:
58091df5d3aSAmit Cohen mlxsw_hwmon_attr->dev_attr.show =
58191df5d3aSAmit Cohen mlxsw_hwmon_temp_critical_alarm_show;
58291df5d3aSAmit Cohen mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
58391df5d3aSAmit Cohen snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
58491df5d3aSAmit Cohen "temp%u_crit_alarm", num + 1);
58591df5d3aSAmit Cohen break;
58691df5d3aSAmit Cohen case MLXSW_HWMON_ATTR_TYPE_TEMP_EMERGENCY_ALARM:
58791df5d3aSAmit Cohen mlxsw_hwmon_attr->dev_attr.show =
58891df5d3aSAmit Cohen mlxsw_hwmon_temp_emergency_alarm_show;
58991df5d3aSAmit Cohen mlxsw_hwmon_attr->dev_attr.attr.mode = 0444;
59091df5d3aSAmit Cohen snprintf(mlxsw_hwmon_attr->name, sizeof(mlxsw_hwmon_attr->name),
59191df5d3aSAmit Cohen "temp%u_emergency_alarm", num + 1);
59291df5d3aSAmit Cohen break;
59389309da3SJiri Pirko default:
5946b20da4dSJiri Pirko WARN_ON(1);
59589309da3SJiri Pirko }
59689309da3SJiri Pirko
59789309da3SJiri Pirko mlxsw_hwmon_attr->type_index = type_index;
598b890ad41SVadim Pasternak mlxsw_hwmon_attr->mlxsw_hwmon_dev = mlxsw_hwmon_dev;
59989309da3SJiri Pirko mlxsw_hwmon_attr->dev_attr.attr.name = mlxsw_hwmon_attr->name;
60089309da3SJiri Pirko sysfs_attr_init(&mlxsw_hwmon_attr->dev_attr.attr);
60189309da3SJiri Pirko
602b890ad41SVadim Pasternak mlxsw_hwmon_dev->attrs[attr_index] = &mlxsw_hwmon_attr->dev_attr.attr;
603b890ad41SVadim Pasternak mlxsw_hwmon_dev->attrs_count++;
60489309da3SJiri Pirko }
60589309da3SJiri Pirko
mlxsw_hwmon_temp_init(struct mlxsw_hwmon_dev * mlxsw_hwmon_dev)606b890ad41SVadim Pasternak static int mlxsw_hwmon_temp_init(struct mlxsw_hwmon_dev *mlxsw_hwmon_dev)
60789309da3SJiri Pirko {
608b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
6095b090740SElad Raz char mtcap_pl[MLXSW_REG_MTCAP_LEN] = {0};
61089309da3SJiri Pirko int i;
61189309da3SJiri Pirko int err;
61289309da3SJiri Pirko
61389309da3SJiri Pirko err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mtcap), mtcap_pl);
61489309da3SJiri Pirko if (err) {
61589309da3SJiri Pirko dev_err(mlxsw_hwmon->bus_info->dev, "Failed to get number of temp sensors\n");
61689309da3SJiri Pirko return err;
61789309da3SJiri Pirko }
618b890ad41SVadim Pasternak mlxsw_hwmon_dev->sensor_count = mlxsw_reg_mtcap_sensor_count_get(mtcap_pl);
619b890ad41SVadim Pasternak for (i = 0; i < mlxsw_hwmon_dev->sensor_count; i++) {
620fb1292f8SAmit Cohen char mtmp_pl[MLXSW_REG_MTMP_LEN] = {0};
621fb1292f8SAmit Cohen
622fd27849dSVadim Pasternak mlxsw_reg_mtmp_slot_index_set(mtmp_pl,
623fd27849dSVadim Pasternak mlxsw_hwmon_dev->slot_index);
624fb1292f8SAmit Cohen mlxsw_reg_mtmp_sensor_index_set(mtmp_pl, i);
625fb1292f8SAmit Cohen err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mtmp),
626fb1292f8SAmit Cohen mtmp_pl);
627fb1292f8SAmit Cohen if (err)
628fb1292f8SAmit Cohen return err;
629fb1292f8SAmit Cohen mlxsw_reg_mtmp_mte_set(mtmp_pl, true);
630fb1292f8SAmit Cohen mlxsw_reg_mtmp_mtr_set(mtmp_pl, true);
63189309da3SJiri Pirko err = mlxsw_reg_write(mlxsw_hwmon->core,
63289309da3SJiri Pirko MLXSW_REG(mtmp), mtmp_pl);
63389309da3SJiri Pirko if (err) {
63489309da3SJiri Pirko dev_err(mlxsw_hwmon->bus_info->dev, "Failed to setup temp sensor number %d\n",
63589309da3SJiri Pirko i);
63689309da3SJiri Pirko return err;
63789309da3SJiri Pirko }
638b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
63989309da3SJiri Pirko MLXSW_HWMON_ATTR_TYPE_TEMP, i, i);
640b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
64189309da3SJiri Pirko MLXSW_HWMON_ATTR_TYPE_TEMP_MAX, i, i);
642b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
643e7bc73cbSJiri Pirko MLXSW_HWMON_ATTR_TYPE_TEMP_RST, i, i);
64489309da3SJiri Pirko }
64589309da3SJiri Pirko return 0;
64689309da3SJiri Pirko }
64789309da3SJiri Pirko
mlxsw_hwmon_fans_init(struct mlxsw_hwmon_dev * mlxsw_hwmon_dev)648b890ad41SVadim Pasternak static int mlxsw_hwmon_fans_init(struct mlxsw_hwmon_dev *mlxsw_hwmon_dev)
64952581961SJiri Pirko {
650b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
6515b090740SElad Raz char mfcr_pl[MLXSW_REG_MFCR_LEN] = {0};
65252581961SJiri Pirko enum mlxsw_reg_mfcr_pwm_frequency freq;
65352581961SJiri Pirko unsigned int type_index;
65452581961SJiri Pirko unsigned int num;
65552581961SJiri Pirko u16 tacho_active;
65652581961SJiri Pirko u8 pwm_active;
65752581961SJiri Pirko int err;
65852581961SJiri Pirko
65952581961SJiri Pirko err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mfcr), mfcr_pl);
66052581961SJiri Pirko if (err) {
66152581961SJiri Pirko dev_err(mlxsw_hwmon->bus_info->dev, "Failed to get to probe PWMs and Tachometers\n");
66252581961SJiri Pirko return err;
66352581961SJiri Pirko }
66452581961SJiri Pirko mlxsw_reg_mfcr_unpack(mfcr_pl, &freq, &tacho_active, &pwm_active);
66552581961SJiri Pirko num = 0;
66652581961SJiri Pirko for (type_index = 0; type_index < MLXSW_MFCR_TACHOS_MAX; type_index++) {
6672c6a33cdSVadim Pasternak if (tacho_active & BIT(type_index)) {
668b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
66952581961SJiri Pirko MLXSW_HWMON_ATTR_TYPE_FAN_RPM,
6702c6a33cdSVadim Pasternak type_index, num);
671b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
6722c6a33cdSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_FAN_FAULT,
67352581961SJiri Pirko type_index, num++);
67452581961SJiri Pirko }
6752c6a33cdSVadim Pasternak }
67652581961SJiri Pirko num = 0;
67752581961SJiri Pirko for (type_index = 0; type_index < MLXSW_MFCR_PWMS_MAX; type_index++) {
67852581961SJiri Pirko if (pwm_active & BIT(type_index))
679b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
68052581961SJiri Pirko MLXSW_HWMON_ATTR_TYPE_PWM,
68152581961SJiri Pirko type_index, num++);
68252581961SJiri Pirko }
68352581961SJiri Pirko return 0;
68452581961SJiri Pirko }
68552581961SJiri Pirko
mlxsw_hwmon_module_init(struct mlxsw_hwmon_dev * mlxsw_hwmon_dev)686b890ad41SVadim Pasternak static int mlxsw_hwmon_module_init(struct mlxsw_hwmon_dev *mlxsw_hwmon_dev)
6875c42eaa0SVadim Pasternak {
688b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
689ea30a92aSVadim Pasternak char mgpir_pl[MLXSW_REG_MGPIR_LEN];
690ea30a92aSVadim Pasternak u8 module_sensor_max;
691ea30a92aSVadim Pasternak int i, err;
6925c42eaa0SVadim Pasternak
693fd27849dSVadim Pasternak mlxsw_reg_mgpir_pack(mgpir_pl, mlxsw_hwmon_dev->slot_index);
694ea30a92aSVadim Pasternak err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mgpir), mgpir_pl);
695ea30a92aSVadim Pasternak if (err)
696ea30a92aSVadim Pasternak return err;
697ea30a92aSVadim Pasternak
698ea30a92aSVadim Pasternak mlxsw_reg_mgpir_unpack(mgpir_pl, NULL, NULL, NULL,
699b691602cSVadim Pasternak &module_sensor_max, NULL);
700ea30a92aSVadim Pasternak
7015c42eaa0SVadim Pasternak /* Add extra attributes for module temperature. Sensor index is
7025c42eaa0SVadim Pasternak * assigned to sensor_count value, while all indexed before
7035c42eaa0SVadim Pasternak * sensor_count are already utilized by the sensors connected through
7045c42eaa0SVadim Pasternak * mtmp register by mlxsw_hwmon_temp_init().
7055c42eaa0SVadim Pasternak */
706b890ad41SVadim Pasternak mlxsw_hwmon_dev->module_sensor_max = mlxsw_hwmon_dev->sensor_count +
707ea30a92aSVadim Pasternak module_sensor_max;
708b890ad41SVadim Pasternak for (i = mlxsw_hwmon_dev->sensor_count;
709b890ad41SVadim Pasternak i < mlxsw_hwmon_dev->module_sensor_max; i++) {
710b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
711ea30a92aSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE, i, i);
712b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
7135c42eaa0SVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_FAULT,
714ea30a92aSVadim Pasternak i, i);
715b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
716ea30a92aSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_CRIT, i,
717ea30a92aSVadim Pasternak i);
718b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
7195c42eaa0SVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_EMERG,
720ea30a92aSVadim Pasternak i, i);
721b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
722a53779deSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MODULE_LABEL,
723ea30a92aSVadim Pasternak i, i);
724b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
72591df5d3aSAmit Cohen MLXSW_HWMON_ATTR_TYPE_TEMP_CRIT_ALARM,
72691df5d3aSAmit Cohen i, i);
727b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
72891df5d3aSAmit Cohen MLXSW_HWMON_ATTR_TYPE_TEMP_EMERGENCY_ALARM,
72991df5d3aSAmit Cohen i, i);
7305c42eaa0SVadim Pasternak }
7312e265a8bSVadim Pasternak
7322e265a8bSVadim Pasternak return 0;
7332e265a8bSVadim Pasternak }
7342e265a8bSVadim Pasternak
mlxsw_hwmon_gearbox_init(struct mlxsw_hwmon_dev * mlxsw_hwmon_dev)735b890ad41SVadim Pasternak static int mlxsw_hwmon_gearbox_init(struct mlxsw_hwmon_dev *mlxsw_hwmon_dev)
7362e265a8bSVadim Pasternak {
737b890ad41SVadim Pasternak struct mlxsw_hwmon *mlxsw_hwmon = mlxsw_hwmon_dev->hwmon;
73836844c85SVadim Pasternak enum mlxsw_reg_mgpir_device_type device_type;
7392e265a8bSVadim Pasternak int index, max_index, sensor_index;
7402e265a8bSVadim Pasternak char mgpir_pl[MLXSW_REG_MGPIR_LEN];
7412e265a8bSVadim Pasternak char mtmp_pl[MLXSW_REG_MTMP_LEN];
7422e265a8bSVadim Pasternak u8 gbox_num;
7432e265a8bSVadim Pasternak int err;
7442e265a8bSVadim Pasternak
745fd27849dSVadim Pasternak mlxsw_reg_mgpir_pack(mgpir_pl, mlxsw_hwmon_dev->slot_index);
7462e265a8bSVadim Pasternak err = mlxsw_reg_query(mlxsw_hwmon->core, MLXSW_REG(mgpir), mgpir_pl);
7472e265a8bSVadim Pasternak if (err)
7482e265a8bSVadim Pasternak return err;
7492e265a8bSVadim Pasternak
750b691602cSVadim Pasternak mlxsw_reg_mgpir_unpack(mgpir_pl, &gbox_num, &device_type, NULL, NULL,
751b691602cSVadim Pasternak NULL);
75236844c85SVadim Pasternak if (device_type != MLXSW_REG_MGPIR_DEVICE_TYPE_GEARBOX_DIE ||
75336844c85SVadim Pasternak !gbox_num)
7542e265a8bSVadim Pasternak return 0;
7552e265a8bSVadim Pasternak
756b890ad41SVadim Pasternak index = mlxsw_hwmon_dev->module_sensor_max;
757b890ad41SVadim Pasternak max_index = mlxsw_hwmon_dev->module_sensor_max + gbox_num;
7582e265a8bSVadim Pasternak while (index < max_index) {
759b890ad41SVadim Pasternak sensor_index = index % mlxsw_hwmon_dev->module_sensor_max +
7602e265a8bSVadim Pasternak MLXSW_REG_MTMP_GBOX_INDEX_MIN;
761fd27849dSVadim Pasternak mlxsw_reg_mtmp_pack(mtmp_pl, mlxsw_hwmon_dev->slot_index,
762fd27849dSVadim Pasternak sensor_index, true, true);
7632e265a8bSVadim Pasternak err = mlxsw_reg_write(mlxsw_hwmon->core,
7642e265a8bSVadim Pasternak MLXSW_REG(mtmp), mtmp_pl);
7652e265a8bSVadim Pasternak if (err) {
7662e265a8bSVadim Pasternak dev_err(mlxsw_hwmon->bus_info->dev, "Failed to setup temp sensor number %d\n",
7672e265a8bSVadim Pasternak sensor_index);
7682e265a8bSVadim Pasternak return err;
7692e265a8bSVadim Pasternak }
770b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
771b890ad41SVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP, index, index);
772b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
7732e265a8bSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_MAX, index,
7742e265a8bSVadim Pasternak index);
775b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
7762e265a8bSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_RST, index,
7772e265a8bSVadim Pasternak index);
778b890ad41SVadim Pasternak mlxsw_hwmon_attr_add(mlxsw_hwmon_dev,
7792e265a8bSVadim Pasternak MLXSW_HWMON_ATTR_TYPE_TEMP_GBOX_LABEL,
7802e265a8bSVadim Pasternak index, index);
7812e265a8bSVadim Pasternak index++;
7822e265a8bSVadim Pasternak }
7835c42eaa0SVadim Pasternak
7845c42eaa0SVadim Pasternak return 0;
7855c42eaa0SVadim Pasternak }
7865c42eaa0SVadim Pasternak
78799a03b31SVadim Pasternak static void
mlxsw_hwmon_got_active(struct mlxsw_core * mlxsw_core,u8 slot_index,void * priv)78899a03b31SVadim Pasternak mlxsw_hwmon_got_active(struct mlxsw_core *mlxsw_core, u8 slot_index,
78999a03b31SVadim Pasternak void *priv)
79099a03b31SVadim Pasternak {
79199a03b31SVadim Pasternak struct mlxsw_hwmon *hwmon = priv;
79299a03b31SVadim Pasternak struct mlxsw_hwmon_dev *linecard;
79399a03b31SVadim Pasternak struct device *dev;
79499a03b31SVadim Pasternak int err;
79599a03b31SVadim Pasternak
79699a03b31SVadim Pasternak dev = hwmon->bus_info->dev;
79799a03b31SVadim Pasternak linecard = &hwmon->line_cards[slot_index];
79899a03b31SVadim Pasternak if (linecard->active)
79999a03b31SVadim Pasternak return;
80099a03b31SVadim Pasternak /* For the main board, module sensor indexes start from 1, sensor index
80199a03b31SVadim Pasternak * 0 is used for the ASIC. Use the same numbering for line cards.
80299a03b31SVadim Pasternak */
80399a03b31SVadim Pasternak linecard->sensor_count = 1;
80499a03b31SVadim Pasternak linecard->slot_index = slot_index;
80599a03b31SVadim Pasternak linecard->hwmon = hwmon;
80699a03b31SVadim Pasternak err = mlxsw_hwmon_module_init(linecard);
80799a03b31SVadim Pasternak if (err) {
80899a03b31SVadim Pasternak dev_err(dev, "Failed to configure hwmon objects for line card modules in slot %d\n",
80999a03b31SVadim Pasternak slot_index);
81099a03b31SVadim Pasternak return;
81199a03b31SVadim Pasternak }
81299a03b31SVadim Pasternak
81399a03b31SVadim Pasternak err = mlxsw_hwmon_gearbox_init(linecard);
81499a03b31SVadim Pasternak if (err) {
81599a03b31SVadim Pasternak dev_err(dev, "Failed to configure hwmon objects for line card gearboxes in slot %d\n",
81699a03b31SVadim Pasternak slot_index);
81799a03b31SVadim Pasternak return;
81899a03b31SVadim Pasternak }
81999a03b31SVadim Pasternak
82099a03b31SVadim Pasternak linecard->groups[0] = &linecard->group;
82199a03b31SVadim Pasternak linecard->group.attrs = linecard->attrs;
82299a03b31SVadim Pasternak sprintf(linecard->name, "%s#%02u", "linecard", slot_index);
82399a03b31SVadim Pasternak linecard->hwmon_dev =
82499a03b31SVadim Pasternak hwmon_device_register_with_groups(dev, linecard->name,
82599a03b31SVadim Pasternak linecard, linecard->groups);
82699a03b31SVadim Pasternak if (IS_ERR(linecard->hwmon_dev)) {
82799a03b31SVadim Pasternak dev_err(dev, "Failed to register hwmon objects for line card in slot %d\n",
82899a03b31SVadim Pasternak slot_index);
82999a03b31SVadim Pasternak return;
83099a03b31SVadim Pasternak }
83199a03b31SVadim Pasternak
83299a03b31SVadim Pasternak linecard->active = true;
83399a03b31SVadim Pasternak }
83499a03b31SVadim Pasternak
83599a03b31SVadim Pasternak static void
mlxsw_hwmon_got_inactive(struct mlxsw_core * mlxsw_core,u8 slot_index,void * priv)83699a03b31SVadim Pasternak mlxsw_hwmon_got_inactive(struct mlxsw_core *mlxsw_core, u8 slot_index,
83799a03b31SVadim Pasternak void *priv)
83899a03b31SVadim Pasternak {
83999a03b31SVadim Pasternak struct mlxsw_hwmon *hwmon = priv;
84099a03b31SVadim Pasternak struct mlxsw_hwmon_dev *linecard;
84199a03b31SVadim Pasternak
84299a03b31SVadim Pasternak linecard = &hwmon->line_cards[slot_index];
84399a03b31SVadim Pasternak if (!linecard->active)
84499a03b31SVadim Pasternak return;
84599a03b31SVadim Pasternak linecard->active = false;
84699a03b31SVadim Pasternak hwmon_device_unregister(linecard->hwmon_dev);
84799a03b31SVadim Pasternak /* Reset attributes counter */
84899a03b31SVadim Pasternak linecard->attrs_count = 0;
84999a03b31SVadim Pasternak }
85099a03b31SVadim Pasternak
85199a03b31SVadim Pasternak static struct mlxsw_linecards_event_ops mlxsw_hwmon_event_ops = {
85299a03b31SVadim Pasternak .got_active = mlxsw_hwmon_got_active,
85399a03b31SVadim Pasternak .got_inactive = mlxsw_hwmon_got_inactive,
85499a03b31SVadim Pasternak };
85599a03b31SVadim Pasternak
mlxsw_hwmon_init(struct mlxsw_core * mlxsw_core,const struct mlxsw_bus_info * mlxsw_bus_info,struct mlxsw_hwmon ** p_hwmon)85689309da3SJiri Pirko int mlxsw_hwmon_init(struct mlxsw_core *mlxsw_core,
85789309da3SJiri Pirko const struct mlxsw_bus_info *mlxsw_bus_info,
85889309da3SJiri Pirko struct mlxsw_hwmon **p_hwmon)
85989309da3SJiri Pirko {
860b890ad41SVadim Pasternak char mgpir_pl[MLXSW_REG_MGPIR_LEN];
86189309da3SJiri Pirko struct mlxsw_hwmon *mlxsw_hwmon;
86289309da3SJiri Pirko struct device *hwmon_dev;
863b890ad41SVadim Pasternak u8 num_of_slots;
86489309da3SJiri Pirko int err;
86589309da3SJiri Pirko
866b890ad41SVadim Pasternak mlxsw_reg_mgpir_pack(mgpir_pl, 0);
867b890ad41SVadim Pasternak err = mlxsw_reg_query(mlxsw_core, MLXSW_REG(mgpir), mgpir_pl);
868b890ad41SVadim Pasternak if (err)
869b890ad41SVadim Pasternak return err;
870b890ad41SVadim Pasternak
871b890ad41SVadim Pasternak mlxsw_reg_mgpir_unpack(mgpir_pl, NULL, NULL, NULL, NULL,
872b890ad41SVadim Pasternak &num_of_slots);
873b890ad41SVadim Pasternak
874b890ad41SVadim Pasternak mlxsw_hwmon = kzalloc(struct_size(mlxsw_hwmon, line_cards,
875b890ad41SVadim Pasternak num_of_slots + 1), GFP_KERNEL);
87689309da3SJiri Pirko if (!mlxsw_hwmon)
87789309da3SJiri Pirko return -ENOMEM;
878b890ad41SVadim Pasternak
87989309da3SJiri Pirko mlxsw_hwmon->core = mlxsw_core;
88089309da3SJiri Pirko mlxsw_hwmon->bus_info = mlxsw_bus_info;
881b890ad41SVadim Pasternak mlxsw_hwmon->line_cards[0].hwmon = mlxsw_hwmon;
882fd27849dSVadim Pasternak mlxsw_hwmon->line_cards[0].slot_index = 0;
88389309da3SJiri Pirko
884b890ad41SVadim Pasternak err = mlxsw_hwmon_temp_init(&mlxsw_hwmon->line_cards[0]);
88589309da3SJiri Pirko if (err)
88689309da3SJiri Pirko goto err_temp_init;
88789309da3SJiri Pirko
888b890ad41SVadim Pasternak err = mlxsw_hwmon_fans_init(&mlxsw_hwmon->line_cards[0]);
88952581961SJiri Pirko if (err)
89052581961SJiri Pirko goto err_fans_init;
89152581961SJiri Pirko
892b890ad41SVadim Pasternak err = mlxsw_hwmon_module_init(&mlxsw_hwmon->line_cards[0]);
8935c42eaa0SVadim Pasternak if (err)
8945c42eaa0SVadim Pasternak goto err_temp_module_init;
8955c42eaa0SVadim Pasternak
896b890ad41SVadim Pasternak err = mlxsw_hwmon_gearbox_init(&mlxsw_hwmon->line_cards[0]);
8972e265a8bSVadim Pasternak if (err)
8982e265a8bSVadim Pasternak goto err_temp_gearbox_init;
8992e265a8bSVadim Pasternak
900b890ad41SVadim Pasternak mlxsw_hwmon->line_cards[0].groups[0] = &mlxsw_hwmon->line_cards[0].group;
901b890ad41SVadim Pasternak mlxsw_hwmon->line_cards[0].group.attrs = mlxsw_hwmon->line_cards[0].attrs;
90289309da3SJiri Pirko
9039b3bc7dbSIdo Schimmel hwmon_dev = hwmon_device_register_with_groups(mlxsw_bus_info->dev,
904b890ad41SVadim Pasternak "mlxsw",
905b890ad41SVadim Pasternak &mlxsw_hwmon->line_cards[0],
906b890ad41SVadim Pasternak mlxsw_hwmon->line_cards[0].groups);
90789309da3SJiri Pirko if (IS_ERR(hwmon_dev)) {
90889309da3SJiri Pirko err = PTR_ERR(hwmon_dev);
90989309da3SJiri Pirko goto err_hwmon_register;
91089309da3SJiri Pirko }
91189309da3SJiri Pirko
91299a03b31SVadim Pasternak err = mlxsw_linecards_event_ops_register(mlxsw_hwmon->core,
91399a03b31SVadim Pasternak &mlxsw_hwmon_event_ops,
91499a03b31SVadim Pasternak mlxsw_hwmon);
91599a03b31SVadim Pasternak if (err)
91699a03b31SVadim Pasternak goto err_linecards_event_ops_register;
91799a03b31SVadim Pasternak
918b890ad41SVadim Pasternak mlxsw_hwmon->line_cards[0].hwmon_dev = hwmon_dev;
91999a03b31SVadim Pasternak mlxsw_hwmon->line_cards[0].active = true;
92089309da3SJiri Pirko *p_hwmon = mlxsw_hwmon;
92189309da3SJiri Pirko return 0;
92289309da3SJiri Pirko
92399a03b31SVadim Pasternak err_linecards_event_ops_register:
92499a03b31SVadim Pasternak hwmon_device_unregister(mlxsw_hwmon->line_cards[0].hwmon_dev);
92589309da3SJiri Pirko err_hwmon_register:
9262e265a8bSVadim Pasternak err_temp_gearbox_init:
9275c42eaa0SVadim Pasternak err_temp_module_init:
92852581961SJiri Pirko err_fans_init:
92989309da3SJiri Pirko err_temp_init:
9309b3bc7dbSIdo Schimmel kfree(mlxsw_hwmon);
93189309da3SJiri Pirko return err;
93289309da3SJiri Pirko }
9339b3bc7dbSIdo Schimmel
mlxsw_hwmon_fini(struct mlxsw_hwmon * mlxsw_hwmon)9349b3bc7dbSIdo Schimmel void mlxsw_hwmon_fini(struct mlxsw_hwmon *mlxsw_hwmon)
9359b3bc7dbSIdo Schimmel {
93699a03b31SVadim Pasternak mlxsw_hwmon->line_cards[0].active = false;
93799a03b31SVadim Pasternak mlxsw_linecards_event_ops_unregister(mlxsw_hwmon->core,
93899a03b31SVadim Pasternak &mlxsw_hwmon_event_ops, mlxsw_hwmon);
939b890ad41SVadim Pasternak hwmon_device_unregister(mlxsw_hwmon->line_cards[0].hwmon_dev);
9409b3bc7dbSIdo Schimmel kfree(mlxsw_hwmon);
9419b3bc7dbSIdo Schimmel }
942