Message ID | 20221214220727.1350784-3-jcormier@criticallink.com |
---|---|
State | New |
Headers | show |
Series | hwmon: ltc2945: Add binding and shunt resistor support | expand |
On Thu, Dec 15, 2022 at 10:11 AM Guenter Roeck <linux@roeck-us.net> wrote: > > On 12/14/22 14:07, Cormier, Jonathan wrote: > > From: John Pruitt <jpruitt@criticallink.com> > > > > Added the ability to specify the value of the shunt resistor in the > > device tree instead of assuming it is 1 milliOhm. The value in the > > device tree has the name shunt-resistor-micro-ohms and the > > default value is 1000 micro-ohms in order to preserve the > > current behavior. > > > > Also needs a devicetree match table. On it > > > Signed-off-by: "Cormier, Jonathan" <jcormier@criticallink.com> > > Signed-off-by: John Pruitt <jpruitt@criticallink.com> > > --- > > drivers/hwmon/ltc2945.c | 86 +++++++++++++++++++++++++++++++---------- > > 1 file changed, 65 insertions(+), 21 deletions(-) > > > > diff --git a/drivers/hwmon/ltc2945.c b/drivers/hwmon/ltc2945.c > > index 9adebb59f604..4e8b92e53133 100644 > > --- a/drivers/hwmon/ltc2945.c > > +++ b/drivers/hwmon/ltc2945.c > > @@ -58,6 +58,11 @@ > > #define CONTROL_MULT_SELECT (1 << 0) > > #define CONTROL_TEST_MODE (1 << 4) > > > > +struct ltc2945_data { > > + struct regmap *regmap; > > + u32 shunt_resistor; // number of microohms > > No C++ comments in this code, please. Also, "number of" is not needed. > Something like "in microohms" or just "microohms" would be sufficient. > > > +}; > > + > > static inline bool is_power_reg(u8 reg) > > { > > return reg < LTC2945_SENSE_H; > > @@ -66,7 +71,9 @@ static inline bool is_power_reg(u8 reg) > > /* Return the value from the given register in uW, mV, or mA */ > > static long long ltc2945_reg_to_val(struct device *dev, u8 reg) > > { > > - struct regmap *regmap = dev_get_drvdata(dev); > > + struct ltc2945_data *data = dev_get_drvdata(dev); > > + struct regmap *regmap = data->regmap; > > + u32 shunt_resistor = data->shunt_resistor; > > unsigned int control; > > u8 buf[3]; > > long long val; > > @@ -93,8 +100,11 @@ static long long ltc2945_reg_to_val(struct device *dev, u8 reg) > > case LTC2945_MIN_POWER_THRES_H: > > /* > > * Convert to uW by assuming current is measured with > > - * an 1mOhm sense resistor, similar to current > > - * measurements. > > + * a 1000 microOhm sense resistor (aka shunt resistor) > > + * or what is specified in DT, similar to current > > + * measurements. The shunt_resistor value is in > > + * microOhms. > > The units are already in the variable declaration. No need to repeat. > There is no need to replace "1 mOhm" with "1000 microOhm". > > It might make sense to drop all those comments, add a kerneldoc comment > to struct ltc2945_data, and explain it all there. Will do > > > + * > > * Control register bit 0 selects if voltage at SENSE+/VDD > > * or voltage at ADIN is used to measure power. > > */ > > @@ -108,6 +118,8 @@ static long long ltc2945_reg_to_val(struct device *dev, u8 reg) > > /* 0.5 mV * 25 uV = 0.0125 uV resolution. */ > > val = (val * 25LL) >> 1; > > } > > + val *= 1000; > > + val = DIV_ROUND_CLOSEST_ULL(val, shunt_resistor); > > break; > > case LTC2945_VIN_H: > > case LTC2945_MAX_VIN_H: > > @@ -132,12 +144,15 @@ static long long ltc2945_reg_to_val(struct device *dev, u8 reg) > > case LTC2945_MIN_SENSE_THRES_H: > > /* > > * 25 uV resolution. Convert to current as measured with > > - * an 1 mOhm sense resistor, in mA. If a different sense > > - * resistor is installed, calculate the actual current by > > - * dividing the reported current by the sense resistor value > > - * in mOhm. > > + * an 1000 microOhm sense (or shunt) resistor, in mA. > > + * If a different shunt resistor is installed, calculate > > + * the actual current by dividing the reported current > > + * by the shunt resistor value in microOhms. The actual > > + * The actual shunt resistor value can be specified > > + * in the device tree. > > All but the last sentence just replace 1 mOhm with 1000 microOhm, which > does not add any value. Applies to all similar changes; I won't comment > on it anymore below. > > > */ > > - val *= 25; > > + val *= 25 * 1000; > > + val = DIV_ROUND_CLOSEST_ULL(val, shunt_resistor); > > break; > > default: > > return -EINVAL; > > @@ -148,7 +163,9 @@ static long long ltc2945_reg_to_val(struct device *dev, u8 reg) > > static int ltc2945_val_to_reg(struct device *dev, u8 reg, > > unsigned long val) > > { > > - struct regmap *regmap = dev_get_drvdata(dev); > > + struct ltc2945_data *data = dev_get_drvdata(dev); > > + struct regmap *regmap = data->regmap; > > + u32 shunt_resistor = data->shunt_resistor; > > unsigned int control; > > int ret; > > > > @@ -160,8 +177,10 @@ static int ltc2945_val_to_reg(struct device *dev, u8 reg, > > case LTC2945_MIN_POWER_THRES_H: > > /* > > * Convert to register value by assuming current is measured > > - * with an 1mOhm sense resistor, similar to current > > + * with a 1000 microOhm sense resistor, (aka shunt resistor) > > + * or what is specified in DT, similar to current > > * measurements. > > + * > > * Control register bit 0 selects if voltage at SENSE+/VDD > > * or voltage at ADIN is used to measure power, which in turn > > * determines register calculations. > > @@ -171,14 +190,16 @@ static int ltc2945_val_to_reg(struct device *dev, u8 reg, > > return ret; > > if (control & CONTROL_MULT_SELECT) { > > /* 25 mV * 25 uV = 0.625 uV resolution. */ > > - val = DIV_ROUND_CLOSEST(val, 625); > > + val *= shunt_resistor; > > This can now easily result in an overflow. Okay will fix > > > + val = DIV_ROUND_CLOSEST(val, 625 * 1000); > > } else { > > /* > > * 0.5 mV * 25 uV = 0.0125 uV resolution. > > * Divide first to avoid overflow; > > * accept loss of accuracy. > > */ > > - val = DIV_ROUND_CLOSEST(val, 25) * 2; > > + val *= shunt_resistor; > > + val = DIV_ROUND_CLOSEST(val, 25 * 1000) * 2; > > } > > break; > > case LTC2945_VIN_H: > > @@ -204,12 +225,14 @@ static int ltc2945_val_to_reg(struct device *dev, u8 reg, > > case LTC2945_MIN_SENSE_THRES_H: > > /* > > * 25 uV resolution. Convert to current as measured with > > - * an 1 mOhm sense resistor, in mA. If a different sense > > - * resistor is installed, calculate the actual current by > > - * dividing the reported current by the sense resistor value > > - * in mOhm. > > + * a 1000 microOhm sense (or shunt) resistor, in mA. If > > + * a different shunt resistor is installed, calculate > > + * the actual current by dividing the reported current > > + * by the sense resistor value in microOhms. The actual > > + * shunt resistor value can be specified in the device tree. > > */ > > - val = DIV_ROUND_CLOSEST(val, 25); > > + val *= shunt_resistor; > > Needs to ensure that there are no overflows. Try to write the maximum value > for unsigned long and see what happens. > > > + val = DIV_ROUND_CLOSEST(val, 25 * 1000); > > break; > > default: > > return -EINVAL; > > @@ -234,7 +257,8 @@ static ssize_t ltc2945_value_store(struct device *dev, > > const char *buf, size_t count) > > { > > struct sensor_device_attribute *attr = to_sensor_dev_attr(da); > > - struct regmap *regmap = dev_get_drvdata(dev); > > + struct ltc2945_data *data = dev_get_drvdata(dev); > > + struct regmap *regmap = data->regmap; > > u8 reg = attr->index; > > unsigned long val; > > u8 regbuf[3]; > > @@ -269,7 +293,8 @@ static ssize_t ltc2945_history_store(struct device *dev, > > const char *buf, size_t count) > > { > > struct sensor_device_attribute *attr = to_sensor_dev_attr(da); > > - struct regmap *regmap = dev_get_drvdata(dev); > > + struct ltc2945_data *data = dev_get_drvdata(dev); > > + struct regmap *regmap = data->regmap; > u8 reg = attr->index; > > int num_regs = is_power_reg(reg) ? 3 : 2; > > u8 buf_min[3] = { 0xff, 0xff, 0xff }; > > @@ -321,7 +346,8 @@ static ssize_t ltc2945_bool_show(struct device *dev, > > struct device_attribute *da, char *buf) > > { > > struct sensor_device_attribute *attr = to_sensor_dev_attr(da); > > - struct regmap *regmap = dev_get_drvdata(dev); > > + struct ltc2945_data *data = dev_get_drvdata(dev); > > + struct regmap *regmap = data->regmap; > > unsigned int fault; > > int ret; > > > > @@ -450,6 +476,14 @@ static int ltc2945_probe(struct i2c_client *client) > > struct device *dev = &client->dev; > > struct device *hwmon_dev; > > struct regmap *regmap; > > + u32 shunt_resistor; > > + > drop this empty line > > > + struct ltc2945_data *data; > > + > > + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); > > + if (!data) > > + return -ENOMEM; > > + dev_set_drvdata(dev, data); > > > > regmap = devm_regmap_init_i2c(client, <c2945_regmap_config); > > if (IS_ERR(regmap)) { > > @@ -457,11 +491,21 @@ static int ltc2945_probe(struct i2c_client *client) > > return PTR_ERR(regmap); > > } > > > > + data->regmap = regmap; > > + if (of_property_read_u32(client->dev.of_node, > > + "shunt-resistor-micro-ohms", &shunt_resistor)) > > Please consider using device_property_read_u32(). > > > + shunt_resistor = 1000; /* 1000 micro-Ohm if not set via DT */ > > "if not set via DT" -> "default value". With device_property_read_u32(), > this can be set by other means, not just DT. > > > + > > + if (shunt_resistor == 0) > > + return -EINVAL; > > + > > + data->shunt_resistor = shunt_resistor; > > + > > /* Clear faults */ > > regmap_write(regmap, LTC2945_FAULT, 0x00); > > > > hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name, > > - regmap, > > + data, > > ltc2945_groups); > > return PTR_ERR_OR_ZERO(hwmon_dev); > > } >
diff --git a/drivers/hwmon/ltc2945.c b/drivers/hwmon/ltc2945.c index 9adebb59f604..4e8b92e53133 100644 --- a/drivers/hwmon/ltc2945.c +++ b/drivers/hwmon/ltc2945.c @@ -58,6 +58,11 @@ #define CONTROL_MULT_SELECT (1 << 0) #define CONTROL_TEST_MODE (1 << 4) +struct ltc2945_data { + struct regmap *regmap; + u32 shunt_resistor; // number of microohms +}; + static inline bool is_power_reg(u8 reg) { return reg < LTC2945_SENSE_H; @@ -66,7 +71,9 @@ static inline bool is_power_reg(u8 reg) /* Return the value from the given register in uW, mV, or mA */ static long long ltc2945_reg_to_val(struct device *dev, u8 reg) { - struct regmap *regmap = dev_get_drvdata(dev); + struct ltc2945_data *data = dev_get_drvdata(dev); + struct regmap *regmap = data->regmap; + u32 shunt_resistor = data->shunt_resistor; unsigned int control; u8 buf[3]; long long val; @@ -93,8 +100,11 @@ static long long ltc2945_reg_to_val(struct device *dev, u8 reg) case LTC2945_MIN_POWER_THRES_H: /* * Convert to uW by assuming current is measured with - * an 1mOhm sense resistor, similar to current - * measurements. + * a 1000 microOhm sense resistor (aka shunt resistor) + * or what is specified in DT, similar to current + * measurements. The shunt_resistor value is in + * microOhms. + * * Control register bit 0 selects if voltage at SENSE+/VDD * or voltage at ADIN is used to measure power. */ @@ -108,6 +118,8 @@ static long long ltc2945_reg_to_val(struct device *dev, u8 reg) /* 0.5 mV * 25 uV = 0.0125 uV resolution. */ val = (val * 25LL) >> 1; } + val *= 1000; + val = DIV_ROUND_CLOSEST_ULL(val, shunt_resistor); break; case LTC2945_VIN_H: case LTC2945_MAX_VIN_H: @@ -132,12 +144,15 @@ static long long ltc2945_reg_to_val(struct device *dev, u8 reg) case LTC2945_MIN_SENSE_THRES_H: /* * 25 uV resolution. Convert to current as measured with - * an 1 mOhm sense resistor, in mA. If a different sense - * resistor is installed, calculate the actual current by - * dividing the reported current by the sense resistor value - * in mOhm. + * an 1000 microOhm sense (or shunt) resistor, in mA. + * If a different shunt resistor is installed, calculate + * the actual current by dividing the reported current + * by the shunt resistor value in microOhms. The actual + * The actual shunt resistor value can be specified + * in the device tree. */ - val *= 25; + val *= 25 * 1000; + val = DIV_ROUND_CLOSEST_ULL(val, shunt_resistor); break; default: return -EINVAL; @@ -148,7 +163,9 @@ static long long ltc2945_reg_to_val(struct device *dev, u8 reg) static int ltc2945_val_to_reg(struct device *dev, u8 reg, unsigned long val) { - struct regmap *regmap = dev_get_drvdata(dev); + struct ltc2945_data *data = dev_get_drvdata(dev); + struct regmap *regmap = data->regmap; + u32 shunt_resistor = data->shunt_resistor; unsigned int control; int ret; @@ -160,8 +177,10 @@ static int ltc2945_val_to_reg(struct device *dev, u8 reg, case LTC2945_MIN_POWER_THRES_H: /* * Convert to register value by assuming current is measured - * with an 1mOhm sense resistor, similar to current + * with a 1000 microOhm sense resistor, (aka shunt resistor) + * or what is specified in DT, similar to current * measurements. + * * Control register bit 0 selects if voltage at SENSE+/VDD * or voltage at ADIN is used to measure power, which in turn * determines register calculations. @@ -171,14 +190,16 @@ static int ltc2945_val_to_reg(struct device *dev, u8 reg, return ret; if (control & CONTROL_MULT_SELECT) { /* 25 mV * 25 uV = 0.625 uV resolution. */ - val = DIV_ROUND_CLOSEST(val, 625); + val *= shunt_resistor; + val = DIV_ROUND_CLOSEST(val, 625 * 1000); } else { /* * 0.5 mV * 25 uV = 0.0125 uV resolution. * Divide first to avoid overflow; * accept loss of accuracy. */ - val = DIV_ROUND_CLOSEST(val, 25) * 2; + val *= shunt_resistor; + val = DIV_ROUND_CLOSEST(val, 25 * 1000) * 2; } break; case LTC2945_VIN_H: @@ -204,12 +225,14 @@ static int ltc2945_val_to_reg(struct device *dev, u8 reg, case LTC2945_MIN_SENSE_THRES_H: /* * 25 uV resolution. Convert to current as measured with - * an 1 mOhm sense resistor, in mA. If a different sense - * resistor is installed, calculate the actual current by - * dividing the reported current by the sense resistor value - * in mOhm. + * a 1000 microOhm sense (or shunt) resistor, in mA. If + * a different shunt resistor is installed, calculate + * the actual current by dividing the reported current + * by the sense resistor value in microOhms. The actual + * shunt resistor value can be specified in the device tree. */ - val = DIV_ROUND_CLOSEST(val, 25); + val *= shunt_resistor; + val = DIV_ROUND_CLOSEST(val, 25 * 1000); break; default: return -EINVAL; @@ -234,7 +257,8 @@ static ssize_t ltc2945_value_store(struct device *dev, const char *buf, size_t count) { struct sensor_device_attribute *attr = to_sensor_dev_attr(da); - struct regmap *regmap = dev_get_drvdata(dev); + struct ltc2945_data *data = dev_get_drvdata(dev); + struct regmap *regmap = data->regmap; u8 reg = attr->index; unsigned long val; u8 regbuf[3]; @@ -269,7 +293,8 @@ static ssize_t ltc2945_history_store(struct device *dev, const char *buf, size_t count) { struct sensor_device_attribute *attr = to_sensor_dev_attr(da); - struct regmap *regmap = dev_get_drvdata(dev); + struct ltc2945_data *data = dev_get_drvdata(dev); + struct regmap *regmap = data->regmap; u8 reg = attr->index; int num_regs = is_power_reg(reg) ? 3 : 2; u8 buf_min[3] = { 0xff, 0xff, 0xff }; @@ -321,7 +346,8 @@ static ssize_t ltc2945_bool_show(struct device *dev, struct device_attribute *da, char *buf) { struct sensor_device_attribute *attr = to_sensor_dev_attr(da); - struct regmap *regmap = dev_get_drvdata(dev); + struct ltc2945_data *data = dev_get_drvdata(dev); + struct regmap *regmap = data->regmap; unsigned int fault; int ret; @@ -450,6 +476,14 @@ static int ltc2945_probe(struct i2c_client *client) struct device *dev = &client->dev; struct device *hwmon_dev; struct regmap *regmap; + u32 shunt_resistor; + + struct ltc2945_data *data; + + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + dev_set_drvdata(dev, data); regmap = devm_regmap_init_i2c(client, <c2945_regmap_config); if (IS_ERR(regmap)) { @@ -457,11 +491,21 @@ static int ltc2945_probe(struct i2c_client *client) return PTR_ERR(regmap); } + data->regmap = regmap; + if (of_property_read_u32(client->dev.of_node, + "shunt-resistor-micro-ohms", &shunt_resistor)) + shunt_resistor = 1000; /* 1000 micro-Ohm if not set via DT */ + + if (shunt_resistor == 0) + return -EINVAL; + + data->shunt_resistor = shunt_resistor; + /* Clear faults */ regmap_write(regmap, LTC2945_FAULT, 0x00); hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name, - regmap, + data, ltc2945_groups); return PTR_ERR_OR_ZERO(hwmon_dev); }