hwmon: (ftsteutates) Convert to devm_hwmon_device_register_with_info()
Convert driver to use devm_hwmon_device_register_with_info() to reduce module size by ~30%. Tested on a Fujitsu DS3401-B1. Signed-off-by: Armin Wolf <W_Armin@gmx.de> Link: https://lore.kernel.org/r/20230105225107.58308-2-W_Armin@gmx.de Signed-off-by: Guenter Roeck <linux@roeck-us.net>
This commit is contained in:
Armin Wolf
Guenter Roeck
parent
ff9dedd2da
commit
dea60ff028
@ -17,7 +17,6 @@
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/sysfs.h>
|
||||
#include <linux/uaccess.h>
|
||||
#include <linux/watchdog.h>
|
||||
|
||||
#define FTS_DEVICE_ID_REG 0x0000
|
||||
@ -340,118 +339,6 @@ static int fts_watchdog_init(struct fts_data *data)
|
||||
return devm_watchdog_register_device(&data->client->dev, &data->wdd);
|
||||
}
|
||||
|
||||
/*****************************************************************************/
|
||||
/* SysFS handler functions */
|
||||
/*****************************************************************************/
|
||||
static ssize_t in_value_show(struct device *dev,
|
||||
struct device_attribute *devattr, char *buf)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int index = to_sensor_dev_attr(devattr)->index;
|
||||
int value, err;
|
||||
|
||||
err = fts_update_device(data);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
value = DIV_ROUND_CLOSEST(data->volt[index] * 3300, 255);
|
||||
|
||||
return sprintf(buf, "%d\n", value);
|
||||
}
|
||||
|
||||
static ssize_t temp_value_show(struct device *dev,
|
||||
struct device_attribute *devattr, char *buf)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int index = to_sensor_dev_attr(devattr)->index;
|
||||
int value, err;
|
||||
|
||||
err = fts_update_device(data);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
value = (data->temp_input[index] - 64) * 1000;
|
||||
|
||||
return sprintf(buf, "%d\n", value);
|
||||
}
|
||||
|
||||
static ssize_t temp_fault_show(struct device *dev,
|
||||
struct device_attribute *devattr, char *buf)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int index = to_sensor_dev_attr(devattr)->index;
|
||||
int err;
|
||||
|
||||
err = fts_update_device(data);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
/* 00h Temperature = Sensor Error */
|
||||
return sprintf(buf, "%d\n", data->temp_input[index] == 0);
|
||||
}
|
||||
|
||||
static ssize_t temp_alarm_show(struct device *dev,
|
||||
struct device_attribute *devattr, char *buf)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int index = to_sensor_dev_attr(devattr)->index;
|
||||
int err;
|
||||
|
||||
err = fts_update_device(data);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
return sprintf(buf, "%u\n", !!(data->temp_alarm & BIT(index)));
|
||||
}
|
||||
|
||||
static ssize_t
|
||||
temp_alarm_store(struct device *dev, struct device_attribute *devattr,
|
||||
const char *buf, size_t count)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int index = to_sensor_dev_attr(devattr)->index;
|
||||
long ret;
|
||||
|
||||
ret = fts_update_device(data);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (kstrtoul(buf, 10, &ret) || ret != 0)
|
||||
return -EINVAL;
|
||||
|
||||
mutex_lock(&data->update_lock);
|
||||
ret = fts_read_byte(data->client, FTS_REG_TEMP_CONTROL(index));
|
||||
if (ret < 0)
|
||||
goto error;
|
||||
|
||||
ret = fts_write_byte(data->client, FTS_REG_TEMP_CONTROL(index),
|
||||
ret | 0x1);
|
||||
if (ret < 0)
|
||||
goto error;
|
||||
|
||||
data->valid = false;
|
||||
ret = count;
|
||||
error:
|
||||
mutex_unlock(&data->update_lock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static ssize_t fan_value_show(struct device *dev,
|
||||
struct device_attribute *devattr, char *buf)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int index = to_sensor_dev_attr(devattr)->index;
|
||||
int value, err;
|
||||
|
||||
err = fts_update_device(data);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
value = data->fan_input[index] * 60;
|
||||
|
||||
return sprintf(buf, "%d\n", value);
|
||||
}
|
||||
|
||||
static ssize_t fan_source_show(struct device *dev,
|
||||
struct device_attribute *devattr, char *buf)
|
||||
{
|
||||
@ -466,172 +353,6 @@ static ssize_t fan_source_show(struct device *dev,
|
||||
return sprintf(buf, "%u\n", data->fan_source[index]);
|
||||
}
|
||||
|
||||
static ssize_t fan_alarm_show(struct device *dev,
|
||||
struct device_attribute *devattr, char *buf)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int index = to_sensor_dev_attr(devattr)->index;
|
||||
int err;
|
||||
|
||||
err = fts_update_device(data);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
return sprintf(buf, "%d\n", !!(data->fan_alarm & BIT(index)));
|
||||
}
|
||||
|
||||
static ssize_t
|
||||
fan_alarm_store(struct device *dev, struct device_attribute *devattr,
|
||||
const char *buf, size_t count)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int index = to_sensor_dev_attr(devattr)->index;
|
||||
long ret;
|
||||
|
||||
ret = fts_update_device(data);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (kstrtoul(buf, 10, &ret) || ret != 0)
|
||||
return -EINVAL;
|
||||
|
||||
mutex_lock(&data->update_lock);
|
||||
ret = fts_read_byte(data->client, FTS_REG_FAN_CONTROL(index));
|
||||
if (ret < 0)
|
||||
goto error;
|
||||
|
||||
ret = fts_write_byte(data->client, FTS_REG_FAN_CONTROL(index),
|
||||
ret | 0x1);
|
||||
if (ret < 0)
|
||||
goto error;
|
||||
|
||||
data->valid = false;
|
||||
ret = count;
|
||||
error:
|
||||
mutex_unlock(&data->update_lock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*****************************************************************************/
|
||||
/* SysFS structs */
|
||||
/*****************************************************************************/
|
||||
|
||||
/* Temperature sensors */
|
||||
static SENSOR_DEVICE_ATTR_RO(temp1_input, temp_value, 0);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp2_input, temp_value, 1);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp3_input, temp_value, 2);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp4_input, temp_value, 3);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp5_input, temp_value, 4);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp6_input, temp_value, 5);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp7_input, temp_value, 6);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp8_input, temp_value, 7);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp9_input, temp_value, 8);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp10_input, temp_value, 9);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp11_input, temp_value, 10);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp12_input, temp_value, 11);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp13_input, temp_value, 12);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp14_input, temp_value, 13);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp15_input, temp_value, 14);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp16_input, temp_value, 15);
|
||||
|
||||
static SENSOR_DEVICE_ATTR_RO(temp1_fault, temp_fault, 0);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp2_fault, temp_fault, 1);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp3_fault, temp_fault, 2);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp4_fault, temp_fault, 3);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp5_fault, temp_fault, 4);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp6_fault, temp_fault, 5);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp7_fault, temp_fault, 6);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp8_fault, temp_fault, 7);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp9_fault, temp_fault, 8);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp10_fault, temp_fault, 9);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp11_fault, temp_fault, 10);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp12_fault, temp_fault, 11);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp13_fault, temp_fault, 12);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp14_fault, temp_fault, 13);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp15_fault, temp_fault, 14);
|
||||
static SENSOR_DEVICE_ATTR_RO(temp16_fault, temp_fault, 15);
|
||||
|
||||
static SENSOR_DEVICE_ATTR_RW(temp1_alarm, temp_alarm, 0);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp2_alarm, temp_alarm, 1);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp3_alarm, temp_alarm, 2);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp4_alarm, temp_alarm, 3);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp5_alarm, temp_alarm, 4);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp6_alarm, temp_alarm, 5);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp7_alarm, temp_alarm, 6);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp8_alarm, temp_alarm, 7);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp9_alarm, temp_alarm, 8);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp10_alarm, temp_alarm, 9);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp11_alarm, temp_alarm, 10);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp12_alarm, temp_alarm, 11);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp13_alarm, temp_alarm, 12);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp14_alarm, temp_alarm, 13);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp15_alarm, temp_alarm, 14);
|
||||
static SENSOR_DEVICE_ATTR_RW(temp16_alarm, temp_alarm, 15);
|
||||
|
||||
static struct attribute *fts_temp_attrs[] = {
|
||||
&sensor_dev_attr_temp1_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp2_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp3_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp4_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp5_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp6_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp7_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp8_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp9_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp10_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp11_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp12_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp13_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp14_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp15_input.dev_attr.attr,
|
||||
&sensor_dev_attr_temp16_input.dev_attr.attr,
|
||||
|
||||
&sensor_dev_attr_temp1_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp2_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp3_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp4_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp5_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp6_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp7_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp8_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp9_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp10_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp11_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp12_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp13_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp14_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp15_fault.dev_attr.attr,
|
||||
&sensor_dev_attr_temp16_fault.dev_attr.attr,
|
||||
|
||||
&sensor_dev_attr_temp1_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp2_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp3_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp4_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp5_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp6_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp7_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp8_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp9_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp10_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp11_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp12_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp13_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp14_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp15_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_temp16_alarm.dev_attr.attr,
|
||||
NULL
|
||||
};
|
||||
|
||||
/* Fans */
|
||||
static SENSOR_DEVICE_ATTR_RO(fan1_input, fan_value, 0);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan2_input, fan_value, 1);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan3_input, fan_value, 2);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan4_input, fan_value, 3);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan5_input, fan_value, 4);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan6_input, fan_value, 5);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan7_input, fan_value, 6);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan8_input, fan_value, 7);
|
||||
|
||||
static SENSOR_DEVICE_ATTR_RO(fan1_source, fan_source, 0);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan2_source, fan_source, 1);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan3_source, fan_source, 2);
|
||||
@ -641,25 +362,7 @@ static SENSOR_DEVICE_ATTR_RO(fan6_source, fan_source, 5);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan7_source, fan_source, 6);
|
||||
static SENSOR_DEVICE_ATTR_RO(fan8_source, fan_source, 7);
|
||||
|
||||
static SENSOR_DEVICE_ATTR_RW(fan1_alarm, fan_alarm, 0);
|
||||
static SENSOR_DEVICE_ATTR_RW(fan2_alarm, fan_alarm, 1);
|
||||
static SENSOR_DEVICE_ATTR_RW(fan3_alarm, fan_alarm, 2);
|
||||
static SENSOR_DEVICE_ATTR_RW(fan4_alarm, fan_alarm, 3);
|
||||
static SENSOR_DEVICE_ATTR_RW(fan5_alarm, fan_alarm, 4);
|
||||
static SENSOR_DEVICE_ATTR_RW(fan6_alarm, fan_alarm, 5);
|
||||
static SENSOR_DEVICE_ATTR_RW(fan7_alarm, fan_alarm, 6);
|
||||
static SENSOR_DEVICE_ATTR_RW(fan8_alarm, fan_alarm, 7);
|
||||
|
||||
static struct attribute *fts_fan_attrs[] = {
|
||||
&sensor_dev_attr_fan1_input.dev_attr.attr,
|
||||
&sensor_dev_attr_fan2_input.dev_attr.attr,
|
||||
&sensor_dev_attr_fan3_input.dev_attr.attr,
|
||||
&sensor_dev_attr_fan4_input.dev_attr.attr,
|
||||
&sensor_dev_attr_fan5_input.dev_attr.attr,
|
||||
&sensor_dev_attr_fan6_input.dev_attr.attr,
|
||||
&sensor_dev_attr_fan7_input.dev_attr.attr,
|
||||
&sensor_dev_attr_fan8_input.dev_attr.attr,
|
||||
|
||||
&sensor_dev_attr_fan1_source.dev_attr.attr,
|
||||
&sensor_dev_attr_fan2_source.dev_attr.attr,
|
||||
&sensor_dev_attr_fan3_source.dev_attr.attr,
|
||||
@ -668,50 +371,225 @@ static struct attribute *fts_fan_attrs[] = {
|
||||
&sensor_dev_attr_fan6_source.dev_attr.attr,
|
||||
&sensor_dev_attr_fan7_source.dev_attr.attr,
|
||||
&sensor_dev_attr_fan8_source.dev_attr.attr,
|
||||
|
||||
&sensor_dev_attr_fan1_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_fan2_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_fan3_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_fan4_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_fan5_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_fan6_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_fan7_alarm.dev_attr.attr,
|
||||
&sensor_dev_attr_fan8_alarm.dev_attr.attr,
|
||||
NULL
|
||||
};
|
||||
|
||||
/* Voltages */
|
||||
static SENSOR_DEVICE_ATTR_RO(in1_input, in_value, 0);
|
||||
static SENSOR_DEVICE_ATTR_RO(in2_input, in_value, 1);
|
||||
static SENSOR_DEVICE_ATTR_RO(in3_input, in_value, 2);
|
||||
static SENSOR_DEVICE_ATTR_RO(in4_input, in_value, 3);
|
||||
static struct attribute *fts_voltage_attrs[] = {
|
||||
&sensor_dev_attr_in1_input.dev_attr.attr,
|
||||
&sensor_dev_attr_in2_input.dev_attr.attr,
|
||||
&sensor_dev_attr_in3_input.dev_attr.attr,
|
||||
&sensor_dev_attr_in4_input.dev_attr.attr,
|
||||
NULL
|
||||
};
|
||||
|
||||
static const struct attribute_group fts_voltage_attr_group = {
|
||||
.attrs = fts_voltage_attrs
|
||||
};
|
||||
|
||||
static const struct attribute_group fts_temp_attr_group = {
|
||||
.attrs = fts_temp_attrs
|
||||
};
|
||||
|
||||
static const struct attribute_group fts_fan_attr_group = {
|
||||
static const struct attribute_group fts_attr_group = {
|
||||
.attrs = fts_fan_attrs
|
||||
};
|
||||
|
||||
static const struct attribute_group *fts_attr_groups[] = {
|
||||
&fts_voltage_attr_group,
|
||||
&fts_temp_attr_group,
|
||||
&fts_fan_attr_group,
|
||||
&fts_attr_group,
|
||||
NULL
|
||||
};
|
||||
|
||||
static umode_t fts_is_visible(const void *devdata, enum hwmon_sensor_types type, u32 attr,
|
||||
int channel)
|
||||
{
|
||||
switch (type) {
|
||||
case hwmon_temp:
|
||||
switch (attr) {
|
||||
case hwmon_temp_input:
|
||||
case hwmon_temp_fault:
|
||||
return 0444;
|
||||
case hwmon_temp_alarm:
|
||||
return 0644;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case hwmon_fan:
|
||||
switch (attr) {
|
||||
case hwmon_fan_input:
|
||||
return 0444;
|
||||
case hwmon_fan_alarm:
|
||||
return 0644;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case hwmon_in:
|
||||
return 0444;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int fts_read(struct device *dev, enum hwmon_sensor_types type, u32 attr, int channel,
|
||||
long *val)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int ret = fts_update_device(data);
|
||||
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
switch (type) {
|
||||
case hwmon_temp:
|
||||
switch (attr) {
|
||||
case hwmon_temp_input:
|
||||
*val = (data->temp_input[channel] - 64) * 1000;
|
||||
|
||||
return 0;
|
||||
case hwmon_temp_alarm:
|
||||
*val = !!(data->temp_alarm & BIT(channel));
|
||||
|
||||
return 0;
|
||||
case hwmon_temp_fault:
|
||||
/* 00h Temperature = Sensor Error */;
|
||||
*val = (data->temp_input[channel] == 0);
|
||||
|
||||
return 0;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case hwmon_fan:
|
||||
switch (attr) {
|
||||
case hwmon_fan_input:
|
||||
*val = data->fan_input[channel] * 60;
|
||||
|
||||
return 0;
|
||||
case hwmon_fan_alarm:
|
||||
*val = !!(data->fan_alarm & BIT(channel));
|
||||
|
||||
return 0;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case hwmon_in:
|
||||
switch (attr) {
|
||||
case hwmon_in_input:
|
||||
*val = DIV_ROUND_CLOSEST(data->volt[channel] * 3300, 255);
|
||||
|
||||
return 0;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
|
||||
static int fts_write(struct device *dev, enum hwmon_sensor_types type, u32 attr, int channel,
|
||||
long val)
|
||||
{
|
||||
struct fts_data *data = dev_get_drvdata(dev);
|
||||
int ret = fts_update_device(data);
|
||||
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
switch (type) {
|
||||
case hwmon_temp:
|
||||
switch (attr) {
|
||||
case hwmon_temp_alarm:
|
||||
if (val)
|
||||
return -EINVAL;
|
||||
|
||||
mutex_lock(&data->update_lock);
|
||||
ret = fts_read_byte(data->client, FTS_REG_TEMP_CONTROL(channel));
|
||||
if (ret >= 0)
|
||||
ret = fts_write_byte(data->client, FTS_REG_TEMP_CONTROL(channel),
|
||||
ret | 0x1);
|
||||
if (ret >= 0)
|
||||
data->valid = false;
|
||||
|
||||
mutex_unlock(&data->update_lock);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case hwmon_fan:
|
||||
switch (attr) {
|
||||
case hwmon_fan_alarm:
|
||||
if (val)
|
||||
return -EINVAL;
|
||||
|
||||
mutex_lock(&data->update_lock);
|
||||
ret = fts_read_byte(data->client, FTS_REG_FAN_CONTROL(channel));
|
||||
if (ret >= 0)
|
||||
ret = fts_write_byte(data->client, FTS_REG_FAN_CONTROL(channel),
|
||||
ret | 0x1);
|
||||
if (ret >= 0)
|
||||
data->valid = false;
|
||||
|
||||
mutex_unlock(&data->update_lock);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
|
||||
static const struct hwmon_ops fts_ops = {
|
||||
.is_visible = fts_is_visible,
|
||||
.read = fts_read,
|
||||
.write = fts_write,
|
||||
};
|
||||
|
||||
static const struct hwmon_channel_info *fts_info[] = {
|
||||
HWMON_CHANNEL_INFO(chip, HWMON_C_REGISTER_TZ),
|
||||
HWMON_CHANNEL_INFO(temp,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT,
|
||||
HWMON_T_INPUT | HWMON_T_ALARM | HWMON_T_FAULT
|
||||
),
|
||||
HWMON_CHANNEL_INFO(fan,
|
||||
HWMON_F_INPUT | HWMON_F_ALARM,
|
||||
HWMON_F_INPUT | HWMON_F_ALARM,
|
||||
HWMON_F_INPUT | HWMON_F_ALARM,
|
||||
HWMON_F_INPUT | HWMON_F_ALARM,
|
||||
HWMON_F_INPUT | HWMON_F_ALARM,
|
||||
HWMON_F_INPUT | HWMON_F_ALARM,
|
||||
HWMON_F_INPUT | HWMON_F_ALARM,
|
||||
HWMON_F_INPUT | HWMON_F_ALARM
|
||||
),
|
||||
HWMON_CHANNEL_INFO(in,
|
||||
HWMON_I_INPUT,
|
||||
HWMON_I_INPUT,
|
||||
HWMON_I_INPUT,
|
||||
HWMON_I_INPUT
|
||||
),
|
||||
NULL
|
||||
};
|
||||
|
||||
static const struct hwmon_chip_info fts_chip_info = {
|
||||
.ops = &fts_ops,
|
||||
.info = fts_info,
|
||||
};
|
||||
|
||||
/*****************************************************************************/
|
||||
/* Module initialization / remove functions */
|
||||
/*****************************************************************************/
|
||||
@ -793,10 +671,8 @@ static int fts_probe(struct i2c_client *client)
|
||||
return err;
|
||||
revision = err;
|
||||
|
||||
hwmon_dev = devm_hwmon_device_register_with_groups(&client->dev,
|
||||
"ftsteutates",
|
||||
data,
|
||||
fts_attr_groups);
|
||||
hwmon_dev = devm_hwmon_device_register_with_info(&client->dev, "ftsteutates", data,
|
||||
&fts_chip_info, fts_attr_groups);
|
||||
if (IS_ERR(hwmon_dev))
|
||||
return PTR_ERR(hwmon_dev);
|
||||
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user