forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
647 lines
18 KiB
647 lines
18 KiB
// SPDX-License-Identifier: GPL-2.0-or-later |
|
/* |
|
* lm80.c - From lm_sensors, Linux kernel modules for hardware |
|
* monitoring |
|
* Copyright (C) 1998, 1999 Frodo Looijaard <[email protected]> |
|
* and Philip Edelbrock <[email protected]> |
|
* |
|
* Ported to Linux 2.6 by Tiago Sousa <[email protected]> |
|
*/ |
|
|
|
#include <linux/module.h> |
|
#include <linux/init.h> |
|
#include <linux/slab.h> |
|
#include <linux/jiffies.h> |
|
#include <linux/i2c.h> |
|
#include <linux/hwmon.h> |
|
#include <linux/hwmon-sysfs.h> |
|
#include <linux/err.h> |
|
#include <linux/mutex.h> |
|
|
|
/* Addresses to scan */ |
|
static const unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, |
|
0x2e, 0x2f, I2C_CLIENT_END }; |
|
|
|
/* Many LM80 constants specified below */ |
|
|
|
/* The LM80 registers */ |
|
#define LM80_REG_IN_MAX(nr) (0x2a + (nr) * 2) |
|
#define LM80_REG_IN_MIN(nr) (0x2b + (nr) * 2) |
|
#define LM80_REG_IN(nr) (0x20 + (nr)) |
|
|
|
#define LM80_REG_FAN1 0x28 |
|
#define LM80_REG_FAN2 0x29 |
|
#define LM80_REG_FAN_MIN(nr) (0x3b + (nr)) |
|
|
|
#define LM80_REG_TEMP 0x27 |
|
#define LM80_REG_TEMP_HOT_MAX 0x38 |
|
#define LM80_REG_TEMP_HOT_HYST 0x39 |
|
#define LM80_REG_TEMP_OS_MAX 0x3a |
|
#define LM80_REG_TEMP_OS_HYST 0x3b |
|
|
|
#define LM80_REG_CONFIG 0x00 |
|
#define LM80_REG_ALARM1 0x01 |
|
#define LM80_REG_ALARM2 0x02 |
|
#define LM80_REG_MASK1 0x03 |
|
#define LM80_REG_MASK2 0x04 |
|
#define LM80_REG_FANDIV 0x05 |
|
#define LM80_REG_RES 0x06 |
|
|
|
#define LM96080_REG_CONV_RATE 0x07 |
|
#define LM96080_REG_MAN_ID 0x3e |
|
#define LM96080_REG_DEV_ID 0x3f |
|
|
|
|
|
/* |
|
* Conversions. Rounding and limit checking is only done on the TO_REG |
|
* variants. Note that you should be a bit careful with which arguments |
|
* these macros are called: arguments may be evaluated more than once. |
|
* Fixing this is just not worth it. |
|
*/ |
|
|
|
#define IN_TO_REG(val) (clamp_val(((val) + 5) / 10, 0, 255)) |
|
#define IN_FROM_REG(val) ((val) * 10) |
|
|
|
static inline unsigned char FAN_TO_REG(unsigned rpm, unsigned div) |
|
{ |
|
if (rpm == 0) |
|
return 255; |
|
rpm = clamp_val(rpm, 1, 1000000); |
|
return clamp_val((1350000 + rpm * div / 2) / (rpm * div), 1, 254); |
|
} |
|
|
|
#define FAN_FROM_REG(val, div) ((val) == 0 ? -1 : \ |
|
(val) == 255 ? 0 : 1350000/((div) * (val))) |
|
|
|
#define TEMP_FROM_REG(reg) ((reg) * 125 / 32) |
|
#define TEMP_TO_REG(temp) (DIV_ROUND_CLOSEST(clamp_val((temp), \ |
|
-128000, 127000), 1000) << 8) |
|
|
|
#define DIV_FROM_REG(val) (1 << (val)) |
|
|
|
enum temp_index { |
|
t_input = 0, |
|
t_hot_max, |
|
t_hot_hyst, |
|
t_os_max, |
|
t_os_hyst, |
|
t_num_temp |
|
}; |
|
|
|
static const u8 temp_regs[t_num_temp] = { |
|
[t_input] = LM80_REG_TEMP, |
|
[t_hot_max] = LM80_REG_TEMP_HOT_MAX, |
|
[t_hot_hyst] = LM80_REG_TEMP_HOT_HYST, |
|
[t_os_max] = LM80_REG_TEMP_OS_MAX, |
|
[t_os_hyst] = LM80_REG_TEMP_OS_HYST, |
|
}; |
|
|
|
enum in_index { |
|
i_input = 0, |
|
i_max, |
|
i_min, |
|
i_num_in |
|
}; |
|
|
|
enum fan_index { |
|
f_input, |
|
f_min, |
|
f_num_fan |
|
}; |
|
|
|
/* |
|
* Client data (each client gets its own) |
|
*/ |
|
|
|
struct lm80_data { |
|
struct i2c_client *client; |
|
struct mutex update_lock; |
|
char error; /* !=0 if error occurred during last update */ |
|
char valid; /* !=0 if following fields are valid */ |
|
unsigned long last_updated; /* In jiffies */ |
|
|
|
u8 in[i_num_in][7]; /* Register value, 1st index is enum in_index */ |
|
u8 fan[f_num_fan][2]; /* Register value, 1st index enum fan_index */ |
|
u8 fan_div[2]; /* Register encoding, shifted right */ |
|
s16 temp[t_num_temp]; /* Register values, normalized to 16 bit */ |
|
u16 alarms; /* Register encoding, combined */ |
|
}; |
|
|
|
static int lm80_read_value(struct i2c_client *client, u8 reg) |
|
{ |
|
return i2c_smbus_read_byte_data(client, reg); |
|
} |
|
|
|
static int lm80_write_value(struct i2c_client *client, u8 reg, u8 value) |
|
{ |
|
return i2c_smbus_write_byte_data(client, reg, value); |
|
} |
|
|
|
/* Called when we have found a new LM80 and after read errors */ |
|
static void lm80_init_client(struct i2c_client *client) |
|
{ |
|
/* |
|
* Reset all except Watchdog values and last conversion values |
|
* This sets fan-divs to 2, among others. This makes most other |
|
* initializations unnecessary |
|
*/ |
|
lm80_write_value(client, LM80_REG_CONFIG, 0x80); |
|
/* Set 11-bit temperature resolution */ |
|
lm80_write_value(client, LM80_REG_RES, 0x08); |
|
|
|
/* Start monitoring */ |
|
lm80_write_value(client, LM80_REG_CONFIG, 0x01); |
|
} |
|
|
|
static struct lm80_data *lm80_update_device(struct device *dev) |
|
{ |
|
struct lm80_data *data = dev_get_drvdata(dev); |
|
struct i2c_client *client = data->client; |
|
int i; |
|
int rv; |
|
int prev_rv; |
|
struct lm80_data *ret = data; |
|
|
|
mutex_lock(&data->update_lock); |
|
|
|
if (data->error) |
|
lm80_init_client(client); |
|
|
|
if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) { |
|
dev_dbg(dev, "Starting lm80 update\n"); |
|
for (i = 0; i <= 6; i++) { |
|
rv = lm80_read_value(client, LM80_REG_IN(i)); |
|
if (rv < 0) |
|
goto abort; |
|
data->in[i_input][i] = rv; |
|
|
|
rv = lm80_read_value(client, LM80_REG_IN_MIN(i)); |
|
if (rv < 0) |
|
goto abort; |
|
data->in[i_min][i] = rv; |
|
|
|
rv = lm80_read_value(client, LM80_REG_IN_MAX(i)); |
|
if (rv < 0) |
|
goto abort; |
|
data->in[i_max][i] = rv; |
|
} |
|
|
|
rv = lm80_read_value(client, LM80_REG_FAN1); |
|
if (rv < 0) |
|
goto abort; |
|
data->fan[f_input][0] = rv; |
|
|
|
rv = lm80_read_value(client, LM80_REG_FAN_MIN(1)); |
|
if (rv < 0) |
|
goto abort; |
|
data->fan[f_min][0] = rv; |
|
|
|
rv = lm80_read_value(client, LM80_REG_FAN2); |
|
if (rv < 0) |
|
goto abort; |
|
data->fan[f_input][1] = rv; |
|
|
|
rv = lm80_read_value(client, LM80_REG_FAN_MIN(2)); |
|
if (rv < 0) |
|
goto abort; |
|
data->fan[f_min][1] = rv; |
|
|
|
prev_rv = rv = lm80_read_value(client, LM80_REG_TEMP); |
|
if (rv < 0) |
|
goto abort; |
|
rv = lm80_read_value(client, LM80_REG_RES); |
|
if (rv < 0) |
|
goto abort; |
|
data->temp[t_input] = (prev_rv << 8) | (rv & 0xf0); |
|
|
|
for (i = t_input + 1; i < t_num_temp; i++) { |
|
rv = lm80_read_value(client, temp_regs[i]); |
|
if (rv < 0) |
|
goto abort; |
|
data->temp[i] = rv << 8; |
|
} |
|
|
|
rv = lm80_read_value(client, LM80_REG_FANDIV); |
|
if (rv < 0) |
|
goto abort; |
|
data->fan_div[0] = (rv >> 2) & 0x03; |
|
data->fan_div[1] = (rv >> 4) & 0x03; |
|
|
|
prev_rv = rv = lm80_read_value(client, LM80_REG_ALARM1); |
|
if (rv < 0) |
|
goto abort; |
|
rv = lm80_read_value(client, LM80_REG_ALARM2); |
|
if (rv < 0) |
|
goto abort; |
|
data->alarms = prev_rv + (rv << 8); |
|
|
|
data->last_updated = jiffies; |
|
data->valid = 1; |
|
data->error = 0; |
|
} |
|
goto done; |
|
|
|
abort: |
|
ret = ERR_PTR(rv); |
|
data->valid = 0; |
|
data->error = 1; |
|
|
|
done: |
|
mutex_unlock(&data->update_lock); |
|
|
|
return ret; |
|
} |
|
|
|
/* |
|
* Sysfs stuff |
|
*/ |
|
|
|
static ssize_t in_show(struct device *dev, struct device_attribute *attr, |
|
char *buf) |
|
{ |
|
struct lm80_data *data = lm80_update_device(dev); |
|
int index = to_sensor_dev_attr_2(attr)->index; |
|
int nr = to_sensor_dev_attr_2(attr)->nr; |
|
|
|
if (IS_ERR(data)) |
|
return PTR_ERR(data); |
|
return sprintf(buf, "%d\n", IN_FROM_REG(data->in[nr][index])); |
|
} |
|
|
|
static ssize_t in_store(struct device *dev, struct device_attribute *attr, |
|
const char *buf, size_t count) |
|
{ |
|
struct lm80_data *data = dev_get_drvdata(dev); |
|
struct i2c_client *client = data->client; |
|
int index = to_sensor_dev_attr_2(attr)->index; |
|
int nr = to_sensor_dev_attr_2(attr)->nr; |
|
long val; |
|
u8 reg; |
|
int err = kstrtol(buf, 10, &val); |
|
if (err < 0) |
|
return err; |
|
|
|
reg = nr == i_min ? LM80_REG_IN_MIN(index) : LM80_REG_IN_MAX(index); |
|
|
|
mutex_lock(&data->update_lock); |
|
data->in[nr][index] = IN_TO_REG(val); |
|
lm80_write_value(client, reg, data->in[nr][index]); |
|
mutex_unlock(&data->update_lock); |
|
return count; |
|
} |
|
|
|
static ssize_t fan_show(struct device *dev, struct device_attribute *attr, |
|
char *buf) |
|
{ |
|
int index = to_sensor_dev_attr_2(attr)->index; |
|
int nr = to_sensor_dev_attr_2(attr)->nr; |
|
struct lm80_data *data = lm80_update_device(dev); |
|
if (IS_ERR(data)) |
|
return PTR_ERR(data); |
|
return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr][index], |
|
DIV_FROM_REG(data->fan_div[index]))); |
|
} |
|
|
|
static ssize_t fan_div_show(struct device *dev, struct device_attribute *attr, |
|
char *buf) |
|
{ |
|
int nr = to_sensor_dev_attr(attr)->index; |
|
struct lm80_data *data = lm80_update_device(dev); |
|
if (IS_ERR(data)) |
|
return PTR_ERR(data); |
|
return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr])); |
|
} |
|
|
|
static ssize_t fan_store(struct device *dev, struct device_attribute *attr, |
|
const char *buf, size_t count) |
|
{ |
|
int index = to_sensor_dev_attr_2(attr)->index; |
|
int nr = to_sensor_dev_attr_2(attr)->nr; |
|
struct lm80_data *data = dev_get_drvdata(dev); |
|
struct i2c_client *client = data->client; |
|
unsigned long val; |
|
int err = kstrtoul(buf, 10, &val); |
|
if (err < 0) |
|
return err; |
|
|
|
mutex_lock(&data->update_lock); |
|
data->fan[nr][index] = FAN_TO_REG(val, |
|
DIV_FROM_REG(data->fan_div[index])); |
|
lm80_write_value(client, LM80_REG_FAN_MIN(index + 1), |
|
data->fan[nr][index]); |
|
mutex_unlock(&data->update_lock); |
|
return count; |
|
} |
|
|
|
/* |
|
* Note: we save and restore the fan minimum here, because its value is |
|
* determined in part by the fan divisor. This follows the principle of |
|
* least surprise; the user doesn't expect the fan minimum to change just |
|
* because the divisor changed. |
|
*/ |
|
static ssize_t fan_div_store(struct device *dev, |
|
struct device_attribute *attr, const char *buf, |
|
size_t count) |
|
{ |
|
int nr = to_sensor_dev_attr(attr)->index; |
|
struct lm80_data *data = dev_get_drvdata(dev); |
|
struct i2c_client *client = data->client; |
|
unsigned long min, val; |
|
u8 reg; |
|
int rv; |
|
|
|
rv = kstrtoul(buf, 10, &val); |
|
if (rv < 0) |
|
return rv; |
|
|
|
/* Save fan_min */ |
|
mutex_lock(&data->update_lock); |
|
min = FAN_FROM_REG(data->fan[f_min][nr], |
|
DIV_FROM_REG(data->fan_div[nr])); |
|
|
|
switch (val) { |
|
case 1: |
|
data->fan_div[nr] = 0; |
|
break; |
|
case 2: |
|
data->fan_div[nr] = 1; |
|
break; |
|
case 4: |
|
data->fan_div[nr] = 2; |
|
break; |
|
case 8: |
|
data->fan_div[nr] = 3; |
|
break; |
|
default: |
|
dev_err(dev, |
|
"fan_div value %ld not supported. Choose one of 1, 2, 4 or 8!\n", |
|
val); |
|
mutex_unlock(&data->update_lock); |
|
return -EINVAL; |
|
} |
|
|
|
rv = lm80_read_value(client, LM80_REG_FANDIV); |
|
if (rv < 0) { |
|
mutex_unlock(&data->update_lock); |
|
return rv; |
|
} |
|
reg = (rv & ~(3 << (2 * (nr + 1)))) |
|
| (data->fan_div[nr] << (2 * (nr + 1))); |
|
lm80_write_value(client, LM80_REG_FANDIV, reg); |
|
|
|
/* Restore fan_min */ |
|
data->fan[f_min][nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr])); |
|
lm80_write_value(client, LM80_REG_FAN_MIN(nr + 1), |
|
data->fan[f_min][nr]); |
|
mutex_unlock(&data->update_lock); |
|
|
|
return count; |
|
} |
|
|
|
static ssize_t temp_show(struct device *dev, struct device_attribute *devattr, |
|
char *buf) |
|
{ |
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
|
struct lm80_data *data = lm80_update_device(dev); |
|
if (IS_ERR(data)) |
|
return PTR_ERR(data); |
|
return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[attr->index])); |
|
} |
|
|
|
static ssize_t temp_store(struct device *dev, |
|
struct device_attribute *devattr, const char *buf, |
|
size_t count) |
|
{ |
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
|
struct lm80_data *data = dev_get_drvdata(dev); |
|
struct i2c_client *client = data->client; |
|
int nr = attr->index; |
|
long val; |
|
int err = kstrtol(buf, 10, &val); |
|
if (err < 0) |
|
return err; |
|
|
|
mutex_lock(&data->update_lock); |
|
data->temp[nr] = TEMP_TO_REG(val); |
|
lm80_write_value(client, temp_regs[nr], data->temp[nr] >> 8); |
|
mutex_unlock(&data->update_lock); |
|
return count; |
|
} |
|
|
|
static ssize_t alarms_show(struct device *dev, struct device_attribute *attr, |
|
char *buf) |
|
{ |
|
struct lm80_data *data = lm80_update_device(dev); |
|
if (IS_ERR(data)) |
|
return PTR_ERR(data); |
|
return sprintf(buf, "%u\n", data->alarms); |
|
} |
|
|
|
static ssize_t alarm_show(struct device *dev, struct device_attribute *attr, |
|
char *buf) |
|
{ |
|
int bitnr = to_sensor_dev_attr(attr)->index; |
|
struct lm80_data *data = lm80_update_device(dev); |
|
if (IS_ERR(data)) |
|
return PTR_ERR(data); |
|
return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); |
|
} |
|
|
|
static SENSOR_DEVICE_ATTR_2_RW(in0_min, in, i_min, 0); |
|
static SENSOR_DEVICE_ATTR_2_RW(in1_min, in, i_min, 1); |
|
static SENSOR_DEVICE_ATTR_2_RW(in2_min, in, i_min, 2); |
|
static SENSOR_DEVICE_ATTR_2_RW(in3_min, in, i_min, 3); |
|
static SENSOR_DEVICE_ATTR_2_RW(in4_min, in, i_min, 4); |
|
static SENSOR_DEVICE_ATTR_2_RW(in5_min, in, i_min, 5); |
|
static SENSOR_DEVICE_ATTR_2_RW(in6_min, in, i_min, 6); |
|
static SENSOR_DEVICE_ATTR_2_RW(in0_max, in, i_max, 0); |
|
static SENSOR_DEVICE_ATTR_2_RW(in1_max, in, i_max, 1); |
|
static SENSOR_DEVICE_ATTR_2_RW(in2_max, in, i_max, 2); |
|
static SENSOR_DEVICE_ATTR_2_RW(in3_max, in, i_max, 3); |
|
static SENSOR_DEVICE_ATTR_2_RW(in4_max, in, i_max, 4); |
|
static SENSOR_DEVICE_ATTR_2_RW(in5_max, in, i_max, 5); |
|
static SENSOR_DEVICE_ATTR_2_RW(in6_max, in, i_max, 6); |
|
static SENSOR_DEVICE_ATTR_2_RO(in0_input, in, i_input, 0); |
|
static SENSOR_DEVICE_ATTR_2_RO(in1_input, in, i_input, 1); |
|
static SENSOR_DEVICE_ATTR_2_RO(in2_input, in, i_input, 2); |
|
static SENSOR_DEVICE_ATTR_2_RO(in3_input, in, i_input, 3); |
|
static SENSOR_DEVICE_ATTR_2_RO(in4_input, in, i_input, 4); |
|
static SENSOR_DEVICE_ATTR_2_RO(in5_input, in, i_input, 5); |
|
static SENSOR_DEVICE_ATTR_2_RO(in6_input, in, i_input, 6); |
|
static SENSOR_DEVICE_ATTR_2_RW(fan1_min, fan, f_min, 0); |
|
static SENSOR_DEVICE_ATTR_2_RW(fan2_min, fan, f_min, 1); |
|
static SENSOR_DEVICE_ATTR_2_RO(fan1_input, fan, f_input, 0); |
|
static SENSOR_DEVICE_ATTR_2_RO(fan2_input, fan, f_input, 1); |
|
static SENSOR_DEVICE_ATTR_RW(fan1_div, fan_div, 0); |
|
static SENSOR_DEVICE_ATTR_RW(fan2_div, fan_div, 1); |
|
static SENSOR_DEVICE_ATTR_RO(temp1_input, temp, t_input); |
|
static SENSOR_DEVICE_ATTR_RW(temp1_max, temp, t_hot_max); |
|
static SENSOR_DEVICE_ATTR_RW(temp1_max_hyst, temp, t_hot_hyst); |
|
static SENSOR_DEVICE_ATTR_RW(temp1_crit, temp, t_os_max); |
|
static SENSOR_DEVICE_ATTR_RW(temp1_crit_hyst, temp, t_os_hyst); |
|
static DEVICE_ATTR_RO(alarms); |
|
static SENSOR_DEVICE_ATTR_RO(in0_alarm, alarm, 0); |
|
static SENSOR_DEVICE_ATTR_RO(in1_alarm, alarm, 1); |
|
static SENSOR_DEVICE_ATTR_RO(in2_alarm, alarm, 2); |
|
static SENSOR_DEVICE_ATTR_RO(in3_alarm, alarm, 3); |
|
static SENSOR_DEVICE_ATTR_RO(in4_alarm, alarm, 4); |
|
static SENSOR_DEVICE_ATTR_RO(in5_alarm, alarm, 5); |
|
static SENSOR_DEVICE_ATTR_RO(in6_alarm, alarm, 6); |
|
static SENSOR_DEVICE_ATTR_RO(fan1_alarm, alarm, 10); |
|
static SENSOR_DEVICE_ATTR_RO(fan2_alarm, alarm, 11); |
|
static SENSOR_DEVICE_ATTR_RO(temp1_max_alarm, alarm, 8); |
|
static SENSOR_DEVICE_ATTR_RO(temp1_crit_alarm, alarm, 13); |
|
|
|
/* |
|
* Real code |
|
*/ |
|
|
|
static struct attribute *lm80_attrs[] = { |
|
&sensor_dev_attr_in0_min.dev_attr.attr, |
|
&sensor_dev_attr_in1_min.dev_attr.attr, |
|
&sensor_dev_attr_in2_min.dev_attr.attr, |
|
&sensor_dev_attr_in3_min.dev_attr.attr, |
|
&sensor_dev_attr_in4_min.dev_attr.attr, |
|
&sensor_dev_attr_in5_min.dev_attr.attr, |
|
&sensor_dev_attr_in6_min.dev_attr.attr, |
|
&sensor_dev_attr_in0_max.dev_attr.attr, |
|
&sensor_dev_attr_in1_max.dev_attr.attr, |
|
&sensor_dev_attr_in2_max.dev_attr.attr, |
|
&sensor_dev_attr_in3_max.dev_attr.attr, |
|
&sensor_dev_attr_in4_max.dev_attr.attr, |
|
&sensor_dev_attr_in5_max.dev_attr.attr, |
|
&sensor_dev_attr_in6_max.dev_attr.attr, |
|
&sensor_dev_attr_in0_input.dev_attr.attr, |
|
&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, |
|
&sensor_dev_attr_in5_input.dev_attr.attr, |
|
&sensor_dev_attr_in6_input.dev_attr.attr, |
|
&sensor_dev_attr_fan1_min.dev_attr.attr, |
|
&sensor_dev_attr_fan2_min.dev_attr.attr, |
|
&sensor_dev_attr_fan1_input.dev_attr.attr, |
|
&sensor_dev_attr_fan2_input.dev_attr.attr, |
|
&sensor_dev_attr_fan1_div.dev_attr.attr, |
|
&sensor_dev_attr_fan2_div.dev_attr.attr, |
|
&sensor_dev_attr_temp1_input.dev_attr.attr, |
|
&sensor_dev_attr_temp1_max.dev_attr.attr, |
|
&sensor_dev_attr_temp1_max_hyst.dev_attr.attr, |
|
&sensor_dev_attr_temp1_crit.dev_attr.attr, |
|
&sensor_dev_attr_temp1_crit_hyst.dev_attr.attr, |
|
&dev_attr_alarms.attr, |
|
&sensor_dev_attr_in0_alarm.dev_attr.attr, |
|
&sensor_dev_attr_in1_alarm.dev_attr.attr, |
|
&sensor_dev_attr_in2_alarm.dev_attr.attr, |
|
&sensor_dev_attr_in3_alarm.dev_attr.attr, |
|
&sensor_dev_attr_in4_alarm.dev_attr.attr, |
|
&sensor_dev_attr_in5_alarm.dev_attr.attr, |
|
&sensor_dev_attr_in6_alarm.dev_attr.attr, |
|
&sensor_dev_attr_fan1_alarm.dev_attr.attr, |
|
&sensor_dev_attr_fan2_alarm.dev_attr.attr, |
|
&sensor_dev_attr_temp1_max_alarm.dev_attr.attr, |
|
&sensor_dev_attr_temp1_crit_alarm.dev_attr.attr, |
|
NULL |
|
}; |
|
ATTRIBUTE_GROUPS(lm80); |
|
|
|
/* Return 0 if detection is successful, -ENODEV otherwise */ |
|
static int lm80_detect(struct i2c_client *client, struct i2c_board_info *info) |
|
{ |
|
struct i2c_adapter *adapter = client->adapter; |
|
int i, cur, man_id, dev_id; |
|
const char *name = NULL; |
|
|
|
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) |
|
return -ENODEV; |
|
|
|
/* First check for unused bits, common to both chip types */ |
|
if ((lm80_read_value(client, LM80_REG_ALARM2) & 0xc0) |
|
|| (lm80_read_value(client, LM80_REG_CONFIG) & 0x80)) |
|
return -ENODEV; |
|
|
|
/* |
|
* The LM96080 has manufacturer and stepping/die rev registers so we |
|
* can just check that. The LM80 does not have such registers so we |
|
* have to use a more expensive trick. |
|
*/ |
|
man_id = lm80_read_value(client, LM96080_REG_MAN_ID); |
|
dev_id = lm80_read_value(client, LM96080_REG_DEV_ID); |
|
if (man_id == 0x01 && dev_id == 0x08) { |
|
/* Check more unused bits for confirmation */ |
|
if (lm80_read_value(client, LM96080_REG_CONV_RATE) & 0xfe) |
|
return -ENODEV; |
|
|
|
name = "lm96080"; |
|
} else { |
|
/* Check 6-bit addressing */ |
|
for (i = 0x2a; i <= 0x3d; i++) { |
|
cur = i2c_smbus_read_byte_data(client, i); |
|
if ((i2c_smbus_read_byte_data(client, i + 0x40) != cur) |
|
|| (i2c_smbus_read_byte_data(client, i + 0x80) != cur) |
|
|| (i2c_smbus_read_byte_data(client, i + 0xc0) != cur)) |
|
return -ENODEV; |
|
} |
|
|
|
name = "lm80"; |
|
} |
|
|
|
strlcpy(info->type, name, I2C_NAME_SIZE); |
|
|
|
return 0; |
|
} |
|
|
|
static int lm80_probe(struct i2c_client *client) |
|
{ |
|
struct device *dev = &client->dev; |
|
struct device *hwmon_dev; |
|
struct lm80_data *data; |
|
|
|
data = devm_kzalloc(dev, sizeof(struct lm80_data), GFP_KERNEL); |
|
if (!data) |
|
return -ENOMEM; |
|
|
|
data->client = client; |
|
mutex_init(&data->update_lock); |
|
|
|
/* Initialize the LM80 chip */ |
|
lm80_init_client(client); |
|
|
|
/* A few vars need to be filled upon startup */ |
|
data->fan[f_min][0] = lm80_read_value(client, LM80_REG_FAN_MIN(1)); |
|
data->fan[f_min][1] = lm80_read_value(client, LM80_REG_FAN_MIN(2)); |
|
|
|
hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name, |
|
data, lm80_groups); |
|
|
|
return PTR_ERR_OR_ZERO(hwmon_dev); |
|
} |
|
|
|
/* |
|
* Driver data (common to all clients) |
|
*/ |
|
|
|
static const struct i2c_device_id lm80_id[] = { |
|
{ "lm80", 0 }, |
|
{ "lm96080", 1 }, |
|
{ } |
|
}; |
|
MODULE_DEVICE_TABLE(i2c, lm80_id); |
|
|
|
static struct i2c_driver lm80_driver = { |
|
.class = I2C_CLASS_HWMON, |
|
.driver = { |
|
.name = "lm80", |
|
}, |
|
.probe_new = lm80_probe, |
|
.id_table = lm80_id, |
|
.detect = lm80_detect, |
|
.address_list = normal_i2c, |
|
}; |
|
|
|
module_i2c_driver(lm80_driver); |
|
|
|
MODULE_AUTHOR("Frodo Looijaard <[email protected]> and " |
|
"Philip Edelbrock <[email protected]>"); |
|
MODULE_DESCRIPTION("LM80 driver"); |
|
MODULE_LICENSE("GPL");
|
|
|