| // SPDX-License-Identifier: GPL-2.0-only |
| /* |
| * Driver for Texas Instruments INA219, INA226 power monitor chips |
| * |
| * INA219: |
| * Zero Drift Bi-Directional Current/Power Monitor with I2C Interface |
| * Datasheet: https://www.ti.com/product/ina219 |
| * |
| * INA220: |
| * Bi-Directional Current/Power Monitor with I2C Interface |
| * Datasheet: https://www.ti.com/product/ina220 |
| * |
| * INA226: |
| * Bi-Directional Current/Power Monitor with I2C Interface |
| * Datasheet: https://www.ti.com/product/ina226 |
| * |
| * INA230: |
| * Bi-directional Current/Power Monitor with I2C Interface |
| * Datasheet: https://www.ti.com/product/ina230 |
| * |
| * Copyright (C) 2012 Lothar Felten <lothar.felten@gmail.com> |
| * Thanks to Jan Volkering |
| */ |
| |
| #include <linux/bitfield.h> |
| #include <linux/bits.h> |
| #include <linux/delay.h> |
| #include <linux/device.h> |
| #include <linux/err.h> |
| #include <linux/hwmon.h> |
| #include <linux/i2c.h> |
| #include <linux/init.h> |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/property.h> |
| #include <linux/regmap.h> |
| #include <linux/slab.h> |
| #include <linux/sysfs.h> |
| #include <linux/util_macros.h> |
| |
| /* common register definitions */ |
| #define INA2XX_CONFIG 0x00 |
| #define INA2XX_SHUNT_VOLTAGE 0x01 /* readonly */ |
| #define INA2XX_BUS_VOLTAGE 0x02 /* readonly */ |
| #define INA2XX_POWER 0x03 /* readonly */ |
| #define INA2XX_CURRENT 0x04 /* readonly */ |
| #define INA2XX_CALIBRATION 0x05 |
| |
| /* INA226 register definitions */ |
| #define INA226_MASK_ENABLE 0x06 |
| #define INA226_ALERT_LIMIT 0x07 |
| #define INA226_DIE_ID 0xFF |
| |
| /* SY24655 register definitions */ |
| #define SY24655_EIN 0x0A |
| #define SY24655_ACCUM_CONFIG 0x0D |
| #define INA2XX_MAX_REGISTERS 0x0D |
| |
| /* settings - depend on use case */ |
| #define INA219_CONFIG_DEFAULT 0x399F /* PGA=8 */ |
| #define INA226_CONFIG_DEFAULT 0x4527 /* averages=16 */ |
| #define INA260_CONFIG_DEFAULT 0x6527 /* averages=16 */ |
| #define SY24655_CONFIG_DEFAULT 0x4527 /* averages=16 */ |
| |
| /* (only for sy24655) */ |
| #define SY24655_ACCUM_CONFIG_DEFAULT 0x044C /* continuous mode, clear after read*/ |
| |
| /* worst case is 68.10 ms (~14.6Hz, ina219) */ |
| #define INA2XX_CONVERSION_RATE 15 |
| #define INA2XX_MAX_DELAY 69 /* worst case delay in ms */ |
| |
| #define INA2XX_RSHUNT_DEFAULT 10000 |
| #define INA260_RSHUNT 2000 |
| |
| /* bit mask for reading the averaging setting in the configuration register */ |
| #define INA226_AVG_RD_MASK GENMASK(11, 9) |
| |
| #define INA226_READ_AVG(reg) FIELD_GET(INA226_AVG_RD_MASK, reg) |
| |
| #define INA226_ALERT_LATCH_ENABLE BIT(0) |
| #define INA226_ALERT_POLARITY BIT(1) |
| |
| /* bit number of alert functions in Mask/Enable Register */ |
| #define INA226_SHUNT_OVER_VOLTAGE_MASK BIT(15) |
| #define INA226_SHUNT_UNDER_VOLTAGE_MASK BIT(14) |
| #define INA226_BUS_OVER_VOLTAGE_MASK BIT(13) |
| #define INA226_BUS_UNDER_VOLTAGE_MASK BIT(12) |
| #define INA226_POWER_OVER_LIMIT_MASK BIT(11) |
| |
| /* bit mask for alert config bits of Mask/Enable Register */ |
| #define INA226_ALERT_CONFIG_MASK GENMASK(15, 10) |
| #define INA226_ALERT_FUNCTION_FLAG BIT(4) |
| |
| /* |
| * Both bus voltage and shunt voltage conversion times for ina226 are set |
| * to 0b0100 on POR, which translates to 2200 microseconds in total. |
| */ |
| #define INA226_TOTAL_CONV_TIME_DEFAULT 2200 |
| |
| static bool ina2xx_writeable_reg(struct device *dev, unsigned int reg) |
| { |
| switch (reg) { |
| case INA2XX_CONFIG: |
| case INA2XX_CALIBRATION: |
| case INA226_MASK_ENABLE: |
| case INA226_ALERT_LIMIT: |
| case SY24655_ACCUM_CONFIG: |
| return true; |
| default: |
| return false; |
| } |
| } |
| |
| static bool ina2xx_volatile_reg(struct device *dev, unsigned int reg) |
| { |
| switch (reg) { |
| case INA2XX_SHUNT_VOLTAGE: |
| case INA2XX_BUS_VOLTAGE: |
| case INA2XX_POWER: |
| case INA2XX_CURRENT: |
| return true; |
| default: |
| return false; |
| } |
| } |
| |
| static const struct regmap_config ina2xx_regmap_config = { |
| .reg_bits = 8, |
| .val_bits = 16, |
| .use_single_write = true, |
| .use_single_read = true, |
| .max_register = INA2XX_MAX_REGISTERS, |
| .cache_type = REGCACHE_MAPLE, |
| .volatile_reg = ina2xx_volatile_reg, |
| .writeable_reg = ina2xx_writeable_reg, |
| }; |
| |
| enum ina2xx_ids { ina219, ina226, ina260, sy24655 }; |
| |
| struct ina2xx_config { |
| u16 config_default; |
| bool has_alerts; /* chip supports alerts and limits */ |
| bool has_ishunt; /* chip has internal shunt resistor */ |
| bool has_power_average; /* chip has internal shunt resistor */ |
| int calibration_value; |
| int shunt_div; |
| int bus_voltage_shift; |
| int bus_voltage_lsb; /* uV */ |
| int power_lsb_factor; |
| }; |
| |
| struct ina2xx_data { |
| const struct ina2xx_config *config; |
| enum ina2xx_ids chip; |
| |
| long rshunt; |
| long current_lsb_uA; |
| long power_lsb_uW; |
| struct mutex config_lock; |
| struct regmap *regmap; |
| struct i2c_client *client; |
| }; |
| |
| static const struct ina2xx_config ina2xx_config[] = { |
| [ina219] = { |
| .config_default = INA219_CONFIG_DEFAULT, |
| .calibration_value = 4096, |
| .shunt_div = 100, |
| .bus_voltage_shift = 3, |
| .bus_voltage_lsb = 4000, |
| .power_lsb_factor = 20, |
| .has_alerts = false, |
| .has_ishunt = false, |
| .has_power_average = false, |
| }, |
| [ina226] = { |
| .config_default = INA226_CONFIG_DEFAULT, |
| .calibration_value = 2048, |
| .shunt_div = 400, |
| .bus_voltage_shift = 0, |
| .bus_voltage_lsb = 1250, |
| .power_lsb_factor = 25, |
| .has_alerts = true, |
| .has_ishunt = false, |
| .has_power_average = false, |
| }, |
| [ina260] = { |
| .config_default = INA260_CONFIG_DEFAULT, |
| .shunt_div = 400, |
| .bus_voltage_shift = 0, |
| .bus_voltage_lsb = 1250, |
| .power_lsb_factor = 8, |
| .has_alerts = true, |
| .has_ishunt = true, |
| .has_power_average = false, |
| }, |
| [sy24655] = { |
| .config_default = SY24655_CONFIG_DEFAULT, |
| .calibration_value = 4096, |
| .shunt_div = 400, |
| .bus_voltage_shift = 0, |
| .bus_voltage_lsb = 1250, |
| .power_lsb_factor = 25, |
| .has_alerts = true, |
| .has_ishunt = false, |
| .has_power_average = true, |
| }, |
| }; |
| |
| /* |
| * Available averaging rates for ina226. The indices correspond with |
| * the bit values expected by the chip (according to the ina226 datasheet, |
| * table 3 AVG bit settings, found at |
| * https://www.ti.com/lit/ds/symlink/ina226.pdf. |
| */ |
| static const int ina226_avg_tab[] = { 1, 4, 16, 64, 128, 256, 512, 1024 }; |
| |
| static int ina226_reg_to_interval(u16 config) |
| { |
| int avg = ina226_avg_tab[INA226_READ_AVG(config)]; |
| |
| /* |
| * Multiply the total conversion time by the number of averages. |
| * Return the result in milliseconds. |
| */ |
| return DIV_ROUND_CLOSEST(avg * INA226_TOTAL_CONV_TIME_DEFAULT, 1000); |
| } |
| |
| /* |
| * Return the new, shifted AVG field value of CONFIG register, |
| * to use with regmap_update_bits |
| */ |
| static u16 ina226_interval_to_reg(long interval) |
| { |
| int avg, avg_bits; |
| |
| /* |
| * The maximum supported interval is 1,024 * (2 * 8.244ms) ~= 16.8s. |
| * Clamp to 32 seconds before calculations to avoid overflows. |
| */ |
| interval = clamp_val(interval, 0, 32000); |
| |
| avg = DIV_ROUND_CLOSEST(interval * 1000, |
| INA226_TOTAL_CONV_TIME_DEFAULT); |
| avg_bits = find_closest(avg, ina226_avg_tab, |
| ARRAY_SIZE(ina226_avg_tab)); |
| |
| return FIELD_PREP(INA226_AVG_RD_MASK, avg_bits); |
| } |
| |
| static int ina2xx_get_value(struct ina2xx_data *data, u8 reg, |
| unsigned int regval) |
| { |
| int val; |
| |
| switch (reg) { |
| case INA2XX_SHUNT_VOLTAGE: |
| /* signed register */ |
| val = DIV_ROUND_CLOSEST((s16)regval, data->config->shunt_div); |
| break; |
| case INA2XX_BUS_VOLTAGE: |
| val = (regval >> data->config->bus_voltage_shift) * |
| data->config->bus_voltage_lsb; |
| val = DIV_ROUND_CLOSEST(val, 1000); |
| break; |
| case INA2XX_POWER: |
| val = regval * data->power_lsb_uW; |
| break; |
| case INA2XX_CURRENT: |
| /* signed register, result in mA */ |
| val = (s16)regval * data->current_lsb_uA; |
| val = DIV_ROUND_CLOSEST(val, 1000); |
| break; |
| case INA2XX_CALIBRATION: |
| val = regval; |
| break; |
| default: |
| /* programmer goofed */ |
| WARN_ON_ONCE(1); |
| val = 0; |
| break; |
| } |
| |
| return val; |
| } |
| |
| /* |
| * Read and convert register value from chip. If the register value is 0, |
| * check if the chip has been power cycled or reset. If so, re-initialize it. |
| */ |
| static int ina2xx_read_init(struct device *dev, int reg, long *val) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| struct regmap *regmap = data->regmap; |
| unsigned int regval; |
| int ret, retry; |
| |
| if (data->config->has_ishunt) { |
| /* No calibration needed */ |
| ret = regmap_read(regmap, reg, ®val); |
| if (ret < 0) |
| return ret; |
| *val = ina2xx_get_value(data, reg, regval); |
| return 0; |
| } |
| |
| for (retry = 5; retry; retry--) { |
| ret = regmap_read(regmap, reg, ®val); |
| if (ret < 0) |
| return ret; |
| |
| /* |
| * If the current value in the calibration register is 0, the |
| * power and current registers will also remain at 0. In case |
| * the chip has been reset let's check the calibration |
| * register and reinitialize if needed. |
| * We do that extra read of the calibration register if there |
| * is some hint of a chip reset. |
| */ |
| if (regval == 0) { |
| unsigned int cal; |
| |
| ret = regmap_read_bypassed(regmap, INA2XX_CALIBRATION, &cal); |
| if (ret < 0) |
| return ret; |
| |
| if (cal == 0) { |
| dev_warn(dev, "chip not calibrated, reinitializing\n"); |
| |
| regcache_mark_dirty(regmap); |
| regcache_sync(regmap); |
| |
| /* |
| * Let's make sure the power and current |
| * registers have been updated before trying |
| * again. |
| */ |
| msleep(INA2XX_MAX_DELAY); |
| continue; |
| } |
| } |
| *val = ina2xx_get_value(data, reg, regval); |
| return 0; |
| } |
| |
| /* |
| * If we're here then although all write operations succeeded, the |
| * chip still returns 0 in the calibration register. Nothing more we |
| * can do here. |
| */ |
| dev_err(dev, "unable to reinitialize the chip\n"); |
| return -ENODEV; |
| } |
| |
| /* |
| * Turns alert limit values into register values. |
| * Opposite of the formula in ina2xx_get_value(). |
| */ |
| static u16 ina226_alert_to_reg(struct ina2xx_data *data, int reg, long val) |
| { |
| switch (reg) { |
| case INA2XX_SHUNT_VOLTAGE: |
| val = clamp_val(val, 0, SHRT_MAX * data->config->shunt_div); |
| val *= data->config->shunt_div; |
| return clamp_val(val, 0, SHRT_MAX); |
| case INA2XX_BUS_VOLTAGE: |
| val = clamp_val(val, 0, 200000); |
| val = (val * 1000) << data->config->bus_voltage_shift; |
| val = DIV_ROUND_CLOSEST(val, data->config->bus_voltage_lsb); |
| return clamp_val(val, 0, USHRT_MAX); |
| case INA2XX_POWER: |
| val = clamp_val(val, 0, UINT_MAX - data->power_lsb_uW); |
| val = DIV_ROUND_CLOSEST(val, data->power_lsb_uW); |
| return clamp_val(val, 0, USHRT_MAX); |
| case INA2XX_CURRENT: |
| val = clamp_val(val, INT_MIN / 1000, INT_MAX / 1000); |
| /* signed register, result in mA */ |
| val = DIV_ROUND_CLOSEST(val * 1000, data->current_lsb_uA); |
| return clamp_val(val, SHRT_MIN, SHRT_MAX); |
| default: |
| /* programmer goofed */ |
| WARN_ON_ONCE(1); |
| return 0; |
| } |
| } |
| |
| static int ina226_alert_limit_read(struct ina2xx_data *data, u32 mask, int reg, long *val) |
| { |
| struct regmap *regmap = data->regmap; |
| int regval; |
| int ret; |
| |
| mutex_lock(&data->config_lock); |
| ret = regmap_read(regmap, INA226_MASK_ENABLE, ®val); |
| if (ret) |
| goto abort; |
| |
| if (regval & mask) { |
| ret = regmap_read(regmap, INA226_ALERT_LIMIT, ®val); |
| if (ret) |
| goto abort; |
| *val = ina2xx_get_value(data, reg, regval); |
| } else { |
| *val = 0; |
| } |
| abort: |
| mutex_unlock(&data->config_lock); |
| return ret; |
| } |
| |
| static int ina226_alert_limit_write(struct ina2xx_data *data, u32 mask, int reg, long val) |
| { |
| struct regmap *regmap = data->regmap; |
| int ret; |
| |
| if (val < 0) |
| return -EINVAL; |
| |
| /* |
| * Clear all alerts first to avoid accidentally triggering ALERT pin |
| * due to register write sequence. Then, only enable the alert |
| * if the value is non-zero. |
| */ |
| mutex_lock(&data->config_lock); |
| ret = regmap_update_bits(regmap, INA226_MASK_ENABLE, |
| INA226_ALERT_CONFIG_MASK, 0); |
| if (ret < 0) |
| goto abort; |
| |
| ret = regmap_write(regmap, INA226_ALERT_LIMIT, |
| ina226_alert_to_reg(data, reg, val)); |
| if (ret < 0) |
| goto abort; |
| |
| if (val) |
| ret = regmap_update_bits(regmap, INA226_MASK_ENABLE, |
| INA226_ALERT_CONFIG_MASK, mask); |
| abort: |
| mutex_unlock(&data->config_lock); |
| return ret; |
| } |
| |
| static int ina2xx_chip_read(struct device *dev, u32 attr, long *val) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| u32 regval; |
| int ret; |
| |
| switch (attr) { |
| case hwmon_chip_update_interval: |
| ret = regmap_read(data->regmap, INA2XX_CONFIG, ®val); |
| if (ret) |
| return ret; |
| |
| *val = ina226_reg_to_interval(regval); |
| break; |
| default: |
| return -EOPNOTSUPP; |
| } |
| return 0; |
| } |
| |
| static int ina226_alert_read(struct regmap *regmap, u32 mask, long *val) |
| { |
| unsigned int regval; |
| int ret; |
| |
| ret = regmap_read_bypassed(regmap, INA226_MASK_ENABLE, ®val); |
| if (ret) |
| return ret; |
| |
| *val = (regval & mask) && (regval & INA226_ALERT_FUNCTION_FLAG); |
| |
| return 0; |
| } |
| |
| static int ina2xx_in_read(struct device *dev, u32 attr, int channel, long *val) |
| { |
| int voltage_reg = channel ? INA2XX_BUS_VOLTAGE : INA2XX_SHUNT_VOLTAGE; |
| u32 under_voltage_mask = channel ? INA226_BUS_UNDER_VOLTAGE_MASK |
| : INA226_SHUNT_UNDER_VOLTAGE_MASK; |
| u32 over_voltage_mask = channel ? INA226_BUS_OVER_VOLTAGE_MASK |
| : INA226_SHUNT_OVER_VOLTAGE_MASK; |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| struct regmap *regmap = data->regmap; |
| unsigned int regval; |
| int ret; |
| |
| switch (attr) { |
| case hwmon_in_input: |
| ret = regmap_read(regmap, voltage_reg, ®val); |
| if (ret) |
| return ret; |
| *val = ina2xx_get_value(data, voltage_reg, regval); |
| break; |
| case hwmon_in_lcrit: |
| return ina226_alert_limit_read(data, under_voltage_mask, |
| voltage_reg, val); |
| case hwmon_in_crit: |
| return ina226_alert_limit_read(data, over_voltage_mask, |
| voltage_reg, val); |
| case hwmon_in_lcrit_alarm: |
| return ina226_alert_read(regmap, under_voltage_mask, val); |
| case hwmon_in_crit_alarm: |
| return ina226_alert_read(regmap, over_voltage_mask, val); |
| default: |
| return -EOPNOTSUPP; |
| } |
| return 0; |
| } |
| |
| /* |
| * Configuring the READ_EIN (bit 10) of the ACCUM_CONFIG register to 1 |
| * can clear accumulator and sample_count after reading the EIN register. |
| * This way, the average power between the last read and the current |
| * read can be obtained. By combining with accurate time data from |
| * outside, the energy consumption during that period can be calculated. |
| */ |
| static int sy24655_average_power_read(struct ina2xx_data *data, u8 reg, long *val) |
| { |
| u8 template[6]; |
| int ret; |
| long accumulator_24, sample_count; |
| |
| /* 48-bit register read */ |
| ret = i2c_smbus_read_i2c_block_data(data->client, reg, 6, template); |
| if (ret < 0) |
| return ret; |
| if (ret != 6) |
| return -EIO; |
| accumulator_24 = ((template[3] << 16) | |
| (template[4] << 8) | |
| template[5]); |
| sample_count = ((template[0] << 16) | |
| (template[1] << 8) | |
| template[2]); |
| if (sample_count <= 0) { |
| *val = 0; |
| return 0; |
| } |
| |
| *val = DIV_ROUND_CLOSEST(accumulator_24, sample_count) * data->power_lsb_uW; |
| |
| return 0; |
| } |
| |
| static int ina2xx_power_read(struct device *dev, u32 attr, long *val) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| |
| switch (attr) { |
| case hwmon_power_input: |
| return ina2xx_read_init(dev, INA2XX_POWER, val); |
| case hwmon_power_average: |
| return sy24655_average_power_read(data, SY24655_EIN, val); |
| case hwmon_power_crit: |
| return ina226_alert_limit_read(data, INA226_POWER_OVER_LIMIT_MASK, |
| INA2XX_POWER, val); |
| case hwmon_power_crit_alarm: |
| return ina226_alert_read(data->regmap, INA226_POWER_OVER_LIMIT_MASK, val); |
| default: |
| return -EOPNOTSUPP; |
| } |
| } |
| |
| static int ina2xx_curr_read(struct device *dev, u32 attr, long *val) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| struct regmap *regmap = data->regmap; |
| unsigned int regval; |
| int ret; |
| |
| /* |
| * While the chips supported by this driver do not directly support |
| * current limits, they do support setting shunt voltage limits. |
| * The shunt voltage divided by the shunt resistor value is the current. |
| * On top of that, calibration values are set such that in the shunt |
| * voltage register and the current register report the same values. |
| * That means we can report and configure current limits based on shunt |
| * voltage limits. |
| */ |
| switch (attr) { |
| case hwmon_curr_input: |
| /* |
| * Since the shunt voltage and the current register report the |
| * same values when the chip is calibrated, we can calculate |
| * the current directly from the shunt voltage without relying |
| * on chip calibration. |
| */ |
| ret = regmap_read(regmap, INA2XX_SHUNT_VOLTAGE, ®val); |
| if (ret) |
| return ret; |
| *val = ina2xx_get_value(data, INA2XX_CURRENT, regval); |
| return 0; |
| case hwmon_curr_lcrit: |
| return ina226_alert_limit_read(data, INA226_SHUNT_UNDER_VOLTAGE_MASK, |
| INA2XX_CURRENT, val); |
| case hwmon_curr_crit: |
| return ina226_alert_limit_read(data, INA226_SHUNT_OVER_VOLTAGE_MASK, |
| INA2XX_CURRENT, val); |
| case hwmon_curr_lcrit_alarm: |
| return ina226_alert_read(regmap, INA226_SHUNT_UNDER_VOLTAGE_MASK, val); |
| case hwmon_curr_crit_alarm: |
| return ina226_alert_read(regmap, INA226_SHUNT_OVER_VOLTAGE_MASK, val); |
| default: |
| return -EOPNOTSUPP; |
| } |
| } |
| |
| static int ina2xx_read(struct device *dev, enum hwmon_sensor_types type, |
| u32 attr, int channel, long *val) |
| { |
| switch (type) { |
| case hwmon_chip: |
| return ina2xx_chip_read(dev, attr, val); |
| case hwmon_in: |
| return ina2xx_in_read(dev, attr, channel, val); |
| case hwmon_power: |
| return ina2xx_power_read(dev, attr, val); |
| case hwmon_curr: |
| return ina2xx_curr_read(dev, attr, val); |
| default: |
| return -EOPNOTSUPP; |
| } |
| } |
| |
| static int ina2xx_chip_write(struct device *dev, u32 attr, long val) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| |
| switch (attr) { |
| case hwmon_chip_update_interval: |
| return regmap_update_bits(data->regmap, INA2XX_CONFIG, |
| INA226_AVG_RD_MASK, |
| ina226_interval_to_reg(val)); |
| default: |
| return -EOPNOTSUPP; |
| } |
| } |
| |
| static int ina2xx_in_write(struct device *dev, u32 attr, int channel, long val) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| |
| switch (attr) { |
| case hwmon_in_lcrit: |
| return ina226_alert_limit_write(data, |
| channel ? INA226_BUS_UNDER_VOLTAGE_MASK : INA226_SHUNT_UNDER_VOLTAGE_MASK, |
| channel ? INA2XX_BUS_VOLTAGE : INA2XX_SHUNT_VOLTAGE, |
| val); |
| case hwmon_in_crit: |
| return ina226_alert_limit_write(data, |
| channel ? INA226_BUS_OVER_VOLTAGE_MASK : INA226_SHUNT_OVER_VOLTAGE_MASK, |
| channel ? INA2XX_BUS_VOLTAGE : INA2XX_SHUNT_VOLTAGE, |
| val); |
| default: |
| return -EOPNOTSUPP; |
| } |
| return 0; |
| } |
| |
| static int ina2xx_power_write(struct device *dev, u32 attr, long val) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| |
| switch (attr) { |
| case hwmon_power_crit: |
| return ina226_alert_limit_write(data, INA226_POWER_OVER_LIMIT_MASK, |
| INA2XX_POWER, val); |
| default: |
| return -EOPNOTSUPP; |
| } |
| return 0; |
| } |
| |
| static int ina2xx_curr_write(struct device *dev, u32 attr, long val) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| |
| switch (attr) { |
| case hwmon_curr_lcrit: |
| return ina226_alert_limit_write(data, INA226_SHUNT_UNDER_VOLTAGE_MASK, |
| INA2XX_CURRENT, val); |
| case hwmon_curr_crit: |
| return ina226_alert_limit_write(data, INA226_SHUNT_OVER_VOLTAGE_MASK, |
| INA2XX_CURRENT, val); |
| default: |
| return -EOPNOTSUPP; |
| } |
| return 0; |
| } |
| |
| static int ina2xx_write(struct device *dev, enum hwmon_sensor_types type, |
| u32 attr, int channel, long val) |
| { |
| switch (type) { |
| case hwmon_chip: |
| return ina2xx_chip_write(dev, attr, val); |
| case hwmon_in: |
| return ina2xx_in_write(dev, attr, channel, val); |
| case hwmon_power: |
| return ina2xx_power_write(dev, attr, val); |
| case hwmon_curr: |
| return ina2xx_curr_write(dev, attr, val); |
| default: |
| return -EOPNOTSUPP; |
| } |
| } |
| |
| static umode_t ina2xx_is_visible(const void *_data, enum hwmon_sensor_types type, |
| u32 attr, int channel) |
| { |
| const struct ina2xx_data *data = _data; |
| bool has_alerts = data->config->has_alerts; |
| bool has_power_average = data->config->has_power_average; |
| enum ina2xx_ids chip = data->chip; |
| |
| switch (type) { |
| case hwmon_in: |
| switch (attr) { |
| case hwmon_in_input: |
| return 0444; |
| case hwmon_in_lcrit: |
| case hwmon_in_crit: |
| if (has_alerts) |
| return 0644; |
| break; |
| case hwmon_in_lcrit_alarm: |
| case hwmon_in_crit_alarm: |
| if (has_alerts) |
| return 0444; |
| break; |
| default: |
| break; |
| } |
| break; |
| case hwmon_curr: |
| switch (attr) { |
| case hwmon_curr_input: |
| return 0444; |
| case hwmon_curr_lcrit: |
| case hwmon_curr_crit: |
| if (has_alerts) |
| return 0644; |
| break; |
| case hwmon_curr_lcrit_alarm: |
| case hwmon_curr_crit_alarm: |
| if (has_alerts) |
| return 0444; |
| break; |
| default: |
| break; |
| } |
| break; |
| case hwmon_power: |
| switch (attr) { |
| case hwmon_power_input: |
| return 0444; |
| case hwmon_power_crit: |
| if (has_alerts) |
| return 0644; |
| break; |
| case hwmon_power_crit_alarm: |
| if (has_alerts) |
| return 0444; |
| break; |
| case hwmon_power_average: |
| if (has_power_average) |
| return 0444; |
| break; |
| default: |
| break; |
| } |
| break; |
| case hwmon_chip: |
| switch (attr) { |
| case hwmon_chip_update_interval: |
| if (chip == ina226 || chip == ina260) |
| return 0644; |
| break; |
| default: |
| break; |
| } |
| break; |
| default: |
| break; |
| } |
| return 0; |
| } |
| |
| static const struct hwmon_channel_info * const ina2xx_info[] = { |
| HWMON_CHANNEL_INFO(chip, |
| HWMON_C_UPDATE_INTERVAL), |
| HWMON_CHANNEL_INFO(in, |
| HWMON_I_INPUT | HWMON_I_CRIT | HWMON_I_CRIT_ALARM | |
| HWMON_I_LCRIT | HWMON_I_LCRIT_ALARM, |
| HWMON_I_INPUT | HWMON_I_CRIT | HWMON_I_CRIT_ALARM | |
| HWMON_I_LCRIT | HWMON_I_LCRIT_ALARM |
| ), |
| HWMON_CHANNEL_INFO(curr, HWMON_C_INPUT | HWMON_C_CRIT | HWMON_C_CRIT_ALARM | |
| HWMON_C_LCRIT | HWMON_C_LCRIT_ALARM), |
| HWMON_CHANNEL_INFO(power, |
| HWMON_P_INPUT | HWMON_P_CRIT | HWMON_P_CRIT_ALARM | |
| HWMON_P_AVERAGE), |
| NULL |
| }; |
| |
| static const struct hwmon_ops ina2xx_hwmon_ops = { |
| .is_visible = ina2xx_is_visible, |
| .read = ina2xx_read, |
| .write = ina2xx_write, |
| }; |
| |
| static const struct hwmon_chip_info ina2xx_chip_info = { |
| .ops = &ina2xx_hwmon_ops, |
| .info = ina2xx_info, |
| }; |
| |
| /* shunt resistance */ |
| |
| /* |
| * In order to keep calibration register value fixed, the product |
| * of current_lsb and shunt_resistor should also be fixed and equal |
| * to shunt_voltage_lsb = 1 / shunt_div multiplied by 10^9 in order |
| * to keep the scale. |
| */ |
| static int ina2xx_set_shunt(struct ina2xx_data *data, unsigned long val) |
| { |
| unsigned int dividend = DIV_ROUND_CLOSEST(1000000000, |
| data->config->shunt_div); |
| if (!val || val > dividend) |
| return -EINVAL; |
| |
| data->rshunt = val; |
| data->current_lsb_uA = DIV_ROUND_CLOSEST(dividend, val); |
| data->power_lsb_uW = data->config->power_lsb_factor * |
| data->current_lsb_uA; |
| |
| return 0; |
| } |
| |
| static ssize_t shunt_resistor_show(struct device *dev, |
| struct device_attribute *da, char *buf) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| |
| return sysfs_emit(buf, "%li\n", data->rshunt); |
| } |
| |
| static ssize_t shunt_resistor_store(struct device *dev, |
| struct device_attribute *da, |
| const char *buf, size_t count) |
| { |
| struct ina2xx_data *data = dev_get_drvdata(dev); |
| unsigned long val; |
| int status; |
| |
| status = kstrtoul(buf, 10, &val); |
| if (status < 0) |
| return status; |
| |
| mutex_lock(&data->config_lock); |
| status = ina2xx_set_shunt(data, val); |
| mutex_unlock(&data->config_lock); |
| if (status < 0) |
| return status; |
| return count; |
| } |
| |
| static DEVICE_ATTR_RW(shunt_resistor); |
| |
| /* pointers to created device attributes */ |
| static struct attribute *ina2xx_attrs[] = { |
| &dev_attr_shunt_resistor.attr, |
| NULL, |
| }; |
| ATTRIBUTE_GROUPS(ina2xx); |
| |
| /* |
| * Initialize chip |
| */ |
| static int ina2xx_init(struct device *dev, struct ina2xx_data *data) |
| { |
| struct regmap *regmap = data->regmap; |
| u32 shunt; |
| int ret; |
| |
| if (data->config->has_ishunt) |
| shunt = INA260_RSHUNT; |
| else if (device_property_read_u32(dev, "shunt-resistor", &shunt) < 0) |
| shunt = INA2XX_RSHUNT_DEFAULT; |
| |
| ret = ina2xx_set_shunt(data, shunt); |
| if (ret < 0) |
| return ret; |
| |
| ret = regmap_write(regmap, INA2XX_CONFIG, data->config->config_default); |
| if (ret < 0) |
| return ret; |
| |
| if (data->config->has_alerts) { |
| bool active_high = device_property_read_bool(dev, "ti,alert-polarity-active-high"); |
| |
| regmap_update_bits(regmap, INA226_MASK_ENABLE, |
| INA226_ALERT_LATCH_ENABLE | INA226_ALERT_POLARITY, |
| INA226_ALERT_LATCH_ENABLE | |
| FIELD_PREP(INA226_ALERT_POLARITY, active_high)); |
| } |
| if (data->config->has_power_average) { |
| if (data->chip == sy24655) { |
| /* |
| * Initialize the power accumulation method to continuous |
| * mode and clear the EIN register after each read of the |
| * EIN register |
| */ |
| ret = regmap_write(regmap, SY24655_ACCUM_CONFIG, |
| SY24655_ACCUM_CONFIG_DEFAULT); |
| if (ret < 0) |
| return ret; |
| } |
| } |
| |
| if (data->config->has_ishunt) |
| return 0; |
| |
| /* |
| * Calibration register is set to the best value, which eliminates |
| * truncation errors on calculating current register in hardware. |
| * According to datasheet (eq. 3) the best values are 2048 for |
| * ina226 and 4096 for ina219. They are hardcoded as calibration_value. |
| */ |
| return regmap_write(regmap, INA2XX_CALIBRATION, |
| data->config->calibration_value); |
| } |
| |
| static int ina2xx_probe(struct i2c_client *client) |
| { |
| struct device *dev = &client->dev; |
| struct ina2xx_data *data; |
| struct device *hwmon_dev; |
| enum ina2xx_ids chip; |
| int ret; |
| |
| chip = (uintptr_t)i2c_get_match_data(client); |
| |
| data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); |
| if (!data) |
| return -ENOMEM; |
| |
| /* set the device type */ |
| data->client = client; |
| data->config = &ina2xx_config[chip]; |
| data->chip = chip; |
| mutex_init(&data->config_lock); |
| |
| data->regmap = devm_regmap_init_i2c(client, &ina2xx_regmap_config); |
| if (IS_ERR(data->regmap)) { |
| dev_err(dev, "failed to allocate register map\n"); |
| return PTR_ERR(data->regmap); |
| } |
| |
| ret = devm_regulator_get_enable(dev, "vs"); |
| if (ret) |
| return dev_err_probe(dev, ret, "failed to enable vs regulator\n"); |
| |
| ret = ina2xx_init(dev, data); |
| if (ret < 0) |
| return dev_err_probe(dev, ret, "failed to configure device\n"); |
| |
| hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name, |
| data, &ina2xx_chip_info, |
| data->config->has_ishunt ? |
| NULL : ina2xx_groups); |
| if (IS_ERR(hwmon_dev)) |
| return PTR_ERR(hwmon_dev); |
| |
| dev_info(dev, "power monitor %s (Rshunt = %li uOhm)\n", |
| client->name, data->rshunt); |
| |
| return 0; |
| } |
| |
| static const struct i2c_device_id ina2xx_id[] = { |
| { "ina219", ina219 }, |
| { "ina220", ina219 }, |
| { "ina226", ina226 }, |
| { "ina230", ina226 }, |
| { "ina231", ina226 }, |
| { "ina260", ina260 }, |
| { "sy24655", sy24655 }, |
| { } |
| }; |
| MODULE_DEVICE_TABLE(i2c, ina2xx_id); |
| |
| static const struct of_device_id __maybe_unused ina2xx_of_match[] = { |
| { |
| .compatible = "silergy,sy24655", |
| .data = (void *)sy24655 |
| }, |
| { |
| .compatible = "ti,ina219", |
| .data = (void *)ina219 |
| }, |
| { |
| .compatible = "ti,ina220", |
| .data = (void *)ina219 |
| }, |
| { |
| .compatible = "ti,ina226", |
| .data = (void *)ina226 |
| }, |
| { |
| .compatible = "ti,ina230", |
| .data = (void *)ina226 |
| }, |
| { |
| .compatible = "ti,ina231", |
| .data = (void *)ina226 |
| }, |
| { |
| .compatible = "ti,ina260", |
| .data = (void *)ina260 |
| }, |
| { } |
| }; |
| MODULE_DEVICE_TABLE(of, ina2xx_of_match); |
| |
| static struct i2c_driver ina2xx_driver = { |
| .driver = { |
| .name = "ina2xx", |
| .of_match_table = of_match_ptr(ina2xx_of_match), |
| }, |
| .probe = ina2xx_probe, |
| .id_table = ina2xx_id, |
| }; |
| |
| module_i2c_driver(ina2xx_driver); |
| |
| MODULE_AUTHOR("Lothar Felten <l-felten@ti.com>"); |
| MODULE_DESCRIPTION("ina2xx driver"); |
| MODULE_LICENSE("GPL"); |