123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779 |
- #include <linux/bitops.h>
- #include <linux/err.h>
- #include <linux/i2c.h>
- #include <linux/hwmon.h>
- #include <linux/init.h>
- #include <linux/module.h>
- #include <linux/mutex.h>
- #include <linux/regmap.h>
- #include <linux/slab.h>
- static const unsigned short normal_i2c[] = { 0x48, 0x49, 0x4a, 0x4c, 0x4d,
- 0x4e, 0x4f, I2C_CLIENT_END };
- enum chips { tmp401, tmp411, tmp431, tmp432, tmp435 };
- #define TMP401_STATUS 0x02
- #define TMP401_CONFIG 0x03
- #define TMP401_CONVERSION_RATE 0x04
- #define TMP4XX_N_FACTOR_REG 0x18
- #define TMP43X_BETA_RANGE 0x25
- #define TMP401_TEMP_CRIT_HYST 0x21
- #define TMP401_MANUFACTURER_ID_REG 0xFE
- #define TMP401_DEVICE_ID_REG 0xFF
- static const u8 TMP401_TEMP_MSB[7][3] = {
- { 0x00, 0x01, 0x23 },
- { 0x06, 0x08, 0x16 },
- { 0x05, 0x07, 0x15 },
- { 0x20, 0x19, 0x1a },
- { 0x30, 0x34, 0x00 },
- { 0x32, 0xf6, 0x00 },
- };
- static const u8 TMP432_STATUS_REG[] = {
- 0x1b, 0x36, 0x35, 0x37 };
- #define TMP401_CONFIG_RANGE BIT(2)
- #define TMP401_CONFIG_SHUTDOWN BIT(6)
- #define TMP401_STATUS_LOCAL_CRIT BIT(0)
- #define TMP401_STATUS_REMOTE_CRIT BIT(1)
- #define TMP401_STATUS_REMOTE_OPEN BIT(2)
- #define TMP401_STATUS_REMOTE_LOW BIT(3)
- #define TMP401_STATUS_REMOTE_HIGH BIT(4)
- #define TMP401_STATUS_LOCAL_LOW BIT(5)
- #define TMP401_STATUS_LOCAL_HIGH BIT(6)
- #define TMP432_STATUS_LOCAL BIT(0)
- #define TMP432_STATUS_REMOTE1 BIT(1)
- #define TMP432_STATUS_REMOTE2 BIT(2)
- #define TMP401_MANUFACTURER_ID 0x55
- #define TMP401_DEVICE_ID 0x11
- #define TMP411A_DEVICE_ID 0x12
- #define TMP411B_DEVICE_ID 0x13
- #define TMP411C_DEVICE_ID 0x10
- #define TMP431_DEVICE_ID 0x31
- #define TMP432_DEVICE_ID 0x32
- #define TMP435_DEVICE_ID 0x35
- static const struct i2c_device_id tmp401_id[] = {
- { "tmp401", tmp401 },
- { "tmp411", tmp411 },
- { "tmp431", tmp431 },
- { "tmp432", tmp432 },
- { "tmp435", tmp435 },
- { }
- };
- MODULE_DEVICE_TABLE(i2c, tmp401_id);
- struct tmp401_data {
- struct i2c_client *client;
- struct regmap *regmap;
- struct mutex update_lock;
- enum chips kind;
- bool extended_range;
-
- u32 chip_channel_config[4];
- struct hwmon_channel_info chip_info;
- u32 temp_channel_config[4];
- struct hwmon_channel_info temp_info;
- const struct hwmon_channel_info *info[3];
- struct hwmon_chip_info chip;
- };
- static bool tmp401_regmap_is_volatile(struct device *dev, unsigned int reg)
- {
- switch (reg) {
- case 0:
- case 1:
- case 2:
- case 0x10:
- case 0x15:
- case 0x1b:
- case 0x23 ... 0x24:
- case 0x30 ... 0x37:
- return true;
- default:
- return false;
- }
- }
- static int tmp401_reg_read(void *context, unsigned int reg, unsigned int *val)
- {
- struct tmp401_data *data = context;
- struct i2c_client *client = data->client;
- int regval;
- switch (reg) {
- case 0:
- case 1:
- case 5:
- case 6:
- case 7:
- case 8:
- case 0x15:
- case 0x16:
- case 0x23:
- case 0x30:
- case 0x32:
- case 0x34:
- case 0xf6:
-
- if (reg == 0xf6)
- reg = 0x36;
- regval = i2c_smbus_read_word_swapped(client, reg);
- if (regval < 0)
- return regval;
- *val = regval;
- break;
- case 0x19:
- case 0x1a:
- case 0x20:
- regval = i2c_smbus_read_byte_data(client, reg);
- if (regval < 0)
- return regval;
- *val = regval << 8;
- break;
- case 0x1b:
- case 0x35 ... 0x37:
- if (data->kind == tmp432) {
- regval = i2c_smbus_read_byte_data(client, reg);
- if (regval < 0)
- return regval;
- *val = regval;
- break;
- }
-
- regval = i2c_smbus_read_byte_data(client, TMP401_STATUS);
- if (regval < 0)
- return regval;
- *val = 0;
- switch (reg) {
- case 0x1b:
- if (regval & TMP401_STATUS_REMOTE_OPEN)
- *val |= BIT(1);
- break;
- case 0x35:
- if (regval & TMP401_STATUS_LOCAL_HIGH)
- *val |= BIT(0);
- if (regval & TMP401_STATUS_REMOTE_HIGH)
- *val |= BIT(1);
- break;
- case 0x36:
- if (regval & TMP401_STATUS_LOCAL_LOW)
- *val |= BIT(0);
- if (regval & TMP401_STATUS_REMOTE_LOW)
- *val |= BIT(1);
- break;
- case 0x37:
- if (regval & TMP401_STATUS_LOCAL_CRIT)
- *val |= BIT(0);
- if (regval & TMP401_STATUS_REMOTE_CRIT)
- *val |= BIT(1);
- break;
- }
- break;
- default:
- regval = i2c_smbus_read_byte_data(client, reg);
- if (regval < 0)
- return regval;
- *val = regval;
- break;
- }
- return 0;
- }
- static int tmp401_reg_write(void *context, unsigned int reg, unsigned int val)
- {
- struct tmp401_data *data = context;
- struct i2c_client *client = data->client;
- switch (reg) {
- case 0x05:
- case 0x06:
- case 0x07:
- case 0x08:
- reg += 6;
- fallthrough;
- case 0x15:
- case 0x16:
- return i2c_smbus_write_word_swapped(client, reg, val);
- case 0x19:
- case 0x1a:
- case 0x20:
- return i2c_smbus_write_byte_data(client, reg, val >> 8);
- case TMP401_CONVERSION_RATE:
- case TMP401_CONFIG:
- reg += 6;
- fallthrough;
- default:
- return i2c_smbus_write_byte_data(client, reg, val);
- }
- }
- static const struct regmap_config tmp401_regmap_config = {
- .reg_bits = 8,
- .val_bits = 16,
- .cache_type = REGCACHE_RBTREE,
- .volatile_reg = tmp401_regmap_is_volatile,
- .reg_read = tmp401_reg_read,
- .reg_write = tmp401_reg_write,
- };
- static int tmp401_register_to_temp(u16 reg, bool extended)
- {
- int temp = reg;
- if (extended)
- temp -= 64 * 256;
- return DIV_ROUND_CLOSEST(temp * 125, 32);
- }
- static u16 tmp401_temp_to_register(long temp, bool extended, int zbits)
- {
- if (extended) {
- temp = clamp_val(temp, -64000, 191000);
- temp += 64000;
- } else {
- temp = clamp_val(temp, 0, 127000);
- }
- return DIV_ROUND_CLOSEST(temp * (1 << (8 - zbits)), 1000) << zbits;
- }
- static const u8 tmp401_temp_reg_index[] = {
- [hwmon_temp_input] = 0,
- [hwmon_temp_min] = 1,
- [hwmon_temp_max] = 2,
- [hwmon_temp_crit] = 3,
- [hwmon_temp_lowest] = 4,
- [hwmon_temp_highest] = 5,
- };
- static const u8 tmp401_status_reg_index[] = {
- [hwmon_temp_fault] = 0,
- [hwmon_temp_min_alarm] = 1,
- [hwmon_temp_max_alarm] = 2,
- [hwmon_temp_crit_alarm] = 3,
- };
- static int tmp401_temp_read(struct device *dev, u32 attr, int channel, long *val)
- {
- struct tmp401_data *data = dev_get_drvdata(dev);
- struct regmap *regmap = data->regmap;
- unsigned int regval;
- int reg, ret;
- switch (attr) {
- case hwmon_temp_input:
- case hwmon_temp_min:
- case hwmon_temp_max:
- case hwmon_temp_crit:
- case hwmon_temp_lowest:
- case hwmon_temp_highest:
- reg = TMP401_TEMP_MSB[tmp401_temp_reg_index[attr]][channel];
- ret = regmap_read(regmap, reg, ®val);
- if (ret < 0)
- return ret;
- *val = tmp401_register_to_temp(regval, data->extended_range);
- break;
- case hwmon_temp_crit_hyst:
- mutex_lock(&data->update_lock);
- reg = TMP401_TEMP_MSB[3][channel];
- ret = regmap_read(regmap, reg, ®val);
- if (ret < 0)
- goto unlock;
- *val = tmp401_register_to_temp(regval, data->extended_range);
- ret = regmap_read(regmap, TMP401_TEMP_CRIT_HYST, ®val);
- if (ret < 0)
- goto unlock;
- *val -= regval * 1000;
- unlock:
- mutex_unlock(&data->update_lock);
- if (ret < 0)
- return ret;
- break;
- case hwmon_temp_fault:
- case hwmon_temp_min_alarm:
- case hwmon_temp_max_alarm:
- case hwmon_temp_crit_alarm:
- reg = TMP432_STATUS_REG[tmp401_status_reg_index[attr]];
- ret = regmap_read(regmap, reg, ®val);
- if (ret < 0)
- return ret;
- *val = !!(regval & BIT(channel));
- break;
- default:
- return -EOPNOTSUPP;
- }
- return 0;
- }
- static int tmp401_temp_write(struct device *dev, u32 attr, int channel,
- long val)
- {
- struct tmp401_data *data = dev_get_drvdata(dev);
- struct regmap *regmap = data->regmap;
- unsigned int regval;
- int reg, ret, temp;
- mutex_lock(&data->update_lock);
- switch (attr) {
- case hwmon_temp_min:
- case hwmon_temp_max:
- case hwmon_temp_crit:
- reg = TMP401_TEMP_MSB[tmp401_temp_reg_index[attr]][channel];
- regval = tmp401_temp_to_register(val, data->extended_range,
- attr == hwmon_temp_crit ? 8 : 4);
- ret = regmap_write(regmap, reg, regval);
- break;
- case hwmon_temp_crit_hyst:
- if (data->extended_range)
- val = clamp_val(val, -64000, 191000);
- else
- val = clamp_val(val, 0, 127000);
- reg = TMP401_TEMP_MSB[3][channel];
- ret = regmap_read(regmap, reg, ®val);
- if (ret < 0)
- break;
- temp = tmp401_register_to_temp(regval, data->extended_range);
- val = clamp_val(val, temp - 255000, temp);
- regval = ((temp - val) + 500) / 1000;
- ret = regmap_write(regmap, TMP401_TEMP_CRIT_HYST, regval);
- break;
- default:
- ret = -EOPNOTSUPP;
- break;
- }
- mutex_unlock(&data->update_lock);
- return ret;
- }
- static int tmp401_chip_read(struct device *dev, u32 attr, int channel, long *val)
- {
- struct tmp401_data *data = dev_get_drvdata(dev);
- u32 regval;
- int ret;
- switch (attr) {
- case hwmon_chip_update_interval:
- ret = regmap_read(data->regmap, TMP401_CONVERSION_RATE, ®val);
- if (ret < 0)
- return ret;
- *val = (1 << (7 - regval)) * 125;
- break;
- case hwmon_chip_temp_reset_history:
- *val = 0;
- break;
- default:
- return -EOPNOTSUPP;
- }
- return 0;
- }
- static int tmp401_set_convrate(struct regmap *regmap, long val)
- {
- int rate;
-
- val = clamp_val(val, 125, 16000);
- rate = 7 - __fls(val * 4 / (125 * 3));
- return regmap_write(regmap, TMP401_CONVERSION_RATE, rate);
- }
- static int tmp401_chip_write(struct device *dev, u32 attr, int channel, long val)
- {
- struct tmp401_data *data = dev_get_drvdata(dev);
- struct regmap *regmap = data->regmap;
- int err;
- mutex_lock(&data->update_lock);
- switch (attr) {
- case hwmon_chip_update_interval:
- err = tmp401_set_convrate(regmap, val);
- break;
- case hwmon_chip_temp_reset_history:
- if (val != 1) {
- err = -EINVAL;
- break;
- }
-
- err = regmap_write(regmap, 0x30, 0);
- break;
- default:
- err = -EOPNOTSUPP;
- break;
- }
- mutex_unlock(&data->update_lock);
- return err;
- }
- static int tmp401_read(struct device *dev, enum hwmon_sensor_types type,
- u32 attr, int channel, long *val)
- {
- switch (type) {
- case hwmon_chip:
- return tmp401_chip_read(dev, attr, channel, val);
- case hwmon_temp:
- return tmp401_temp_read(dev, attr, channel, val);
- default:
- return -EOPNOTSUPP;
- }
- }
- static int tmp401_write(struct device *dev, enum hwmon_sensor_types type,
- u32 attr, int channel, long val)
- {
- switch (type) {
- case hwmon_chip:
- return tmp401_chip_write(dev, attr, channel, val);
- case hwmon_temp:
- return tmp401_temp_write(dev, attr, channel, val);
- default:
- return -EOPNOTSUPP;
- }
- }
- static umode_t tmp401_is_visible(const void *data, enum hwmon_sensor_types type,
- u32 attr, int channel)
- {
- switch (type) {
- case hwmon_chip:
- switch (attr) {
- case hwmon_chip_update_interval:
- case hwmon_chip_temp_reset_history:
- return 0644;
- default:
- break;
- }
- break;
- case hwmon_temp:
- switch (attr) {
- case hwmon_temp_input:
- case hwmon_temp_min_alarm:
- case hwmon_temp_max_alarm:
- case hwmon_temp_crit_alarm:
- case hwmon_temp_fault:
- case hwmon_temp_lowest:
- case hwmon_temp_highest:
- return 0444;
- case hwmon_temp_min:
- case hwmon_temp_max:
- case hwmon_temp_crit:
- case hwmon_temp_crit_hyst:
- return 0644;
- default:
- break;
- }
- break;
- default:
- break;
- }
- return 0;
- }
- static const struct hwmon_ops tmp401_ops = {
- .is_visible = tmp401_is_visible,
- .read = tmp401_read,
- .write = tmp401_write,
- };
- static int tmp401_init_client(struct tmp401_data *data)
- {
- struct regmap *regmap = data->regmap;
- u32 config, config_orig;
- int ret;
- u32 val = 0;
- s32 nfactor = 0;
-
- ret = regmap_write(regmap, TMP401_CONVERSION_RATE, 5);
- if (ret < 0)
- return ret;
-
- ret = regmap_read(regmap, TMP401_CONFIG, &config);
- if (ret < 0)
- return ret;
- config_orig = config;
- config &= ~TMP401_CONFIG_SHUTDOWN;
- if (of_property_read_bool(data->client->dev.of_node, "ti,extended-range-enable")) {
-
- config |= TMP401_CONFIG_RANGE;
- }
- data->extended_range = !!(config & TMP401_CONFIG_RANGE);
- if (config != config_orig) {
- ret = regmap_write(regmap, TMP401_CONFIG, config);
- if (ret < 0)
- return ret;
- }
- ret = of_property_read_u32(data->client->dev.of_node, "ti,n-factor", &nfactor);
- if (!ret) {
- if (data->kind == tmp401) {
- dev_err(&data->client->dev, "ti,tmp401 does not support n-factor correction\n");
- return -EINVAL;
- }
- if (nfactor < -128 || nfactor > 127) {
- dev_err(&data->client->dev, "n-factor is invalid (%d)\n", nfactor);
- return -EINVAL;
- }
- ret = regmap_write(regmap, TMP4XX_N_FACTOR_REG, (unsigned int)nfactor);
- if (ret < 0)
- return ret;
- }
- ret = of_property_read_u32(data->client->dev.of_node, "ti,beta-compensation", &val);
- if (!ret) {
- if (data->kind == tmp401 || data->kind == tmp411) {
- dev_err(&data->client->dev, "ti,tmp401 or ti,tmp411 does not support beta compensation\n");
- return -EINVAL;
- }
- if (val > 15) {
- dev_err(&data->client->dev, "beta-compensation is invalid (%u)\n", val);
- return -EINVAL;
- }
- ret = regmap_write(regmap, TMP43X_BETA_RANGE, val);
- if (ret < 0)
- return ret;
- }
- return 0;
- }
- static int tmp401_detect(struct i2c_client *client,
- struct i2c_board_info *info)
- {
- enum chips kind;
- struct i2c_adapter *adapter = client->adapter;
- u8 reg;
- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
- return -ENODEV;
-
- reg = i2c_smbus_read_byte_data(client, TMP401_MANUFACTURER_ID_REG);
- if (reg != TMP401_MANUFACTURER_ID)
- return -ENODEV;
- reg = i2c_smbus_read_byte_data(client, TMP401_DEVICE_ID_REG);
- switch (reg) {
- case TMP401_DEVICE_ID:
- if (client->addr != 0x4c)
- return -ENODEV;
- kind = tmp401;
- break;
- case TMP411A_DEVICE_ID:
- if (client->addr != 0x4c)
- return -ENODEV;
- kind = tmp411;
- break;
- case TMP411B_DEVICE_ID:
- if (client->addr != 0x4d)
- return -ENODEV;
- kind = tmp411;
- break;
- case TMP411C_DEVICE_ID:
- if (client->addr != 0x4e)
- return -ENODEV;
- kind = tmp411;
- break;
- case TMP431_DEVICE_ID:
- if (client->addr != 0x4c && client->addr != 0x4d)
- return -ENODEV;
- kind = tmp431;
- break;
- case TMP432_DEVICE_ID:
- if (client->addr != 0x4c && client->addr != 0x4d)
- return -ENODEV;
- kind = tmp432;
- break;
- case TMP435_DEVICE_ID:
- kind = tmp435;
- break;
- default:
- return -ENODEV;
- }
- reg = i2c_smbus_read_byte_data(client, TMP401_CONFIG);
- if (reg & 0x1b)
- return -ENODEV;
- reg = i2c_smbus_read_byte_data(client, TMP401_CONVERSION_RATE);
-
- if (reg > 15)
- return -ENODEV;
- strscpy(info->type, tmp401_id[kind].name, I2C_NAME_SIZE);
- return 0;
- }
- static int tmp401_probe(struct i2c_client *client)
- {
- static const char * const names[] = {
- "TMP401", "TMP411", "TMP431", "TMP432", "TMP435"
- };
- struct device *dev = &client->dev;
- struct hwmon_channel_info *info;
- struct device *hwmon_dev;
- struct tmp401_data *data;
- int status;
- data = devm_kzalloc(dev, sizeof(struct tmp401_data), GFP_KERNEL);
- if (!data)
- return -ENOMEM;
- data->client = client;
- mutex_init(&data->update_lock);
- data->kind = i2c_match_id(tmp401_id, client)->driver_data;
- data->regmap = devm_regmap_init(dev, NULL, data, &tmp401_regmap_config);
- if (IS_ERR(data->regmap))
- return PTR_ERR(data->regmap);
-
- data->chip.ops = &tmp401_ops;
- data->chip.info = data->info;
- data->info[0] = &data->chip_info;
- data->info[1] = &data->temp_info;
- info = &data->chip_info;
- info->type = hwmon_chip;
- info->config = data->chip_channel_config;
- data->chip_channel_config[0] = HWMON_C_UPDATE_INTERVAL;
- info = &data->temp_info;
- info->type = hwmon_temp;
- info->config = data->temp_channel_config;
- data->temp_channel_config[0] = HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX |
- HWMON_T_CRIT | HWMON_T_CRIT_HYST | HWMON_T_MIN_ALARM |
- HWMON_T_MAX_ALARM | HWMON_T_CRIT_ALARM;
- data->temp_channel_config[1] = HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX |
- HWMON_T_CRIT | HWMON_T_CRIT_HYST | HWMON_T_MIN_ALARM |
- HWMON_T_MAX_ALARM | HWMON_T_CRIT_ALARM | HWMON_T_FAULT;
- if (data->kind == tmp411) {
- data->temp_channel_config[0] |= HWMON_T_HIGHEST | HWMON_T_LOWEST;
- data->temp_channel_config[1] |= HWMON_T_HIGHEST | HWMON_T_LOWEST;
- data->chip_channel_config[0] |= HWMON_C_TEMP_RESET_HISTORY;
- }
- if (data->kind == tmp432) {
- data->temp_channel_config[2] = HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX |
- HWMON_T_CRIT | HWMON_T_CRIT_HYST | HWMON_T_MIN_ALARM |
- HWMON_T_MAX_ALARM | HWMON_T_CRIT_ALARM | HWMON_T_FAULT;
- }
-
- status = tmp401_init_client(data);
- if (status < 0)
- return status;
- hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name, data,
- &data->chip, NULL);
- if (IS_ERR(hwmon_dev))
- return PTR_ERR(hwmon_dev);
- dev_info(dev, "Detected TI %s chip\n", names[data->kind]);
- return 0;
- }
- static const struct of_device_id __maybe_unused tmp4xx_of_match[] = {
- { .compatible = "ti,tmp401", },
- { .compatible = "ti,tmp411", },
- { .compatible = "ti,tmp431", },
- { .compatible = "ti,tmp432", },
- { .compatible = "ti,tmp435", },
- { },
- };
- MODULE_DEVICE_TABLE(of, tmp4xx_of_match);
- static struct i2c_driver tmp401_driver = {
- .class = I2C_CLASS_HWMON,
- .driver = {
- .name = "tmp401",
- .of_match_table = of_match_ptr(tmp4xx_of_match),
- },
- .probe_new = tmp401_probe,
- .id_table = tmp401_id,
- .detect = tmp401_detect,
- .address_list = normal_i2c,
- };
- module_i2c_driver(tmp401_driver);
- MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
- MODULE_DESCRIPTION("Texas Instruments TMP401 temperature sensor driver");
- MODULE_LICENSE("GPL");
|