Commit 87625b24 authored by Nicolin Chen's avatar Nicolin Chen Committed by Guenter Roeck

hwmon: (ina3221) Serialize sysfs ABI accesses

This change adds a mutex to serialize accesses of sysfs attributes.

This is required when polling CVRF bit of the MASK/ENABLE register
because this bit is cleared on a read of this MASK/ENABLE register
or a write to CONFIG register, which means that this bit might be
accidentally cleared by reading other fields like alert flags.

So this patch adds a mutex lock to protect the write() and read()
callbacks. The read_string() callback won't need the lock since it
just returns the label without touching any hardware register.
Signed-off-by: default avatarNicolin Chen <nicoleotsuka@gmail.com>
Signed-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
parent efb0489e
...@@ -18,6 +18,7 @@ ...@@ -18,6 +18,7 @@
#include <linux/hwmon-sysfs.h> #include <linux/hwmon-sysfs.h>
#include <linux/i2c.h> #include <linux/i2c.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/mutex.h>
#include <linux/of.h> #include <linux/of.h>
#include <linux/regmap.h> #include <linux/regmap.h>
...@@ -94,12 +95,14 @@ struct ina3221_input { ...@@ -94,12 +95,14 @@ struct ina3221_input {
* @regmap: Register map of the device * @regmap: Register map of the device
* @fields: Register fields of the device * @fields: Register fields of the device
* @inputs: Array of channel input source specific structures * @inputs: Array of channel input source specific structures
* @lock: mutex lock to serialize sysfs attribute accesses
* @reg_config: Register value of INA3221_CONFIG * @reg_config: Register value of INA3221_CONFIG
*/ */
struct ina3221_data { struct ina3221_data {
struct regmap *regmap; struct regmap *regmap;
struct regmap_field *fields[F_MAX_FIELDS]; struct regmap_field *fields[F_MAX_FIELDS];
struct ina3221_input inputs[INA3221_NUM_CHANNELS]; struct ina3221_input inputs[INA3221_NUM_CHANNELS];
struct mutex lock;
u32 reg_config; u32 reg_config;
}; };
...@@ -265,29 +268,53 @@ static int ina3221_write_enable(struct device *dev, int channel, bool enable) ...@@ -265,29 +268,53 @@ static int ina3221_write_enable(struct device *dev, int channel, bool enable)
static int ina3221_read(struct device *dev, enum hwmon_sensor_types type, static int ina3221_read(struct device *dev, enum hwmon_sensor_types type,
u32 attr, int channel, long *val) u32 attr, int channel, long *val)
{ {
struct ina3221_data *ina = dev_get_drvdata(dev);
int ret;
mutex_lock(&ina->lock);
switch (type) { switch (type) {
case hwmon_in: case hwmon_in:
/* 0-align channel ID */ /* 0-align channel ID */
return ina3221_read_in(dev, attr, channel - 1, val); ret = ina3221_read_in(dev, attr, channel - 1, val);
break;
case hwmon_curr: case hwmon_curr:
return ina3221_read_curr(dev, attr, channel, val); ret = ina3221_read_curr(dev, attr, channel, val);
break;
default: default:
return -EOPNOTSUPP; ret = -EOPNOTSUPP;
break;
} }
mutex_unlock(&ina->lock);
return ret;
} }
static int ina3221_write(struct device *dev, enum hwmon_sensor_types type, static int ina3221_write(struct device *dev, enum hwmon_sensor_types type,
u32 attr, int channel, long val) u32 attr, int channel, long val)
{ {
struct ina3221_data *ina = dev_get_drvdata(dev);
int ret;
mutex_lock(&ina->lock);
switch (type) { switch (type) {
case hwmon_in: case hwmon_in:
/* 0-align channel ID */ /* 0-align channel ID */
return ina3221_write_enable(dev, channel - 1, val); ret = ina3221_write_enable(dev, channel - 1, val);
break;
case hwmon_curr: case hwmon_curr:
return ina3221_write_curr(dev, attr, channel, val); ret = ina3221_write_curr(dev, attr, channel, val);
break;
default: default:
return -EOPNOTSUPP; ret = -EOPNOTSUPP;
break;
} }
mutex_unlock(&ina->lock);
return ret;
} }
static int ina3221_read_string(struct device *dev, enum hwmon_sensor_types type, static int ina3221_read_string(struct device *dev, enum hwmon_sensor_types type,
...@@ -582,6 +609,7 @@ static int ina3221_probe(struct i2c_client *client, ...@@ -582,6 +609,7 @@ static int ina3221_probe(struct i2c_client *client,
if (ret) if (ret)
return ret; return ret;
mutex_init(&ina->lock);
dev_set_drvdata(dev, ina); dev_set_drvdata(dev, ina);
hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name, ina, hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name, ina,
...@@ -589,12 +617,22 @@ static int ina3221_probe(struct i2c_client *client, ...@@ -589,12 +617,22 @@ static int ina3221_probe(struct i2c_client *client,
ina3221_groups); ina3221_groups);
if (IS_ERR(hwmon_dev)) { if (IS_ERR(hwmon_dev)) {
dev_err(dev, "Unable to register hwmon device\n"); dev_err(dev, "Unable to register hwmon device\n");
mutex_destroy(&ina->lock);
return PTR_ERR(hwmon_dev); return PTR_ERR(hwmon_dev);
} }
return 0; return 0;
} }
static int ina3221_remove(struct i2c_client *client)
{
struct ina3221_data *ina = dev_get_drvdata(&client->dev);
mutex_destroy(&ina->lock);
return 0;
}
static int __maybe_unused ina3221_suspend(struct device *dev) static int __maybe_unused ina3221_suspend(struct device *dev)
{ {
struct ina3221_data *ina = dev_get_drvdata(dev); struct ina3221_data *ina = dev_get_drvdata(dev);
...@@ -663,6 +701,7 @@ MODULE_DEVICE_TABLE(i2c, ina3221_ids); ...@@ -663,6 +701,7 @@ MODULE_DEVICE_TABLE(i2c, ina3221_ids);
static struct i2c_driver ina3221_i2c_driver = { static struct i2c_driver ina3221_i2c_driver = {
.probe = ina3221_probe, .probe = ina3221_probe,
.remove = ina3221_remove,
.driver = { .driver = {
.name = INA3221_DRIVER_NAME, .name = INA3221_DRIVER_NAME,
.of_match_table = ina3221_of_match_table, .of_match_table = ina3221_of_match_table,
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment