@@ -1326,6 +1326,8 @@ struct nct6775_data {
/* nct6775_*() callbacks */
u16 (*read_value)(struct nct6775_data *data, u16 reg);
int (*write_value)(struct nct6775_data *data, u16 reg, u16 value);
+ int (*lock)(struct nct6775_data *data);
+ void (*unlock)(struct nct6775_data *data, struct device *dev);
};
struct sensor_device_template {
@@ -1918,12 +1920,26 @@ static void nct6775_update_pwm_limits(struct device *dev)
}
}
+static int nct6775_lock(struct nct6775_data *data)
+{
+ mutex_lock(&data->update_lock);
+
+ return 0;
+}
+
+static void nct6775_unlock(struct nct6775_data *data, struct device *dev)
+{
+ mutex_unlock(&data->update_lock);
+}
+
static struct nct6775_data *nct6775_update_device(struct device *dev)
{
struct nct6775_data *data = dev_get_drvdata(dev);
- int i, j;
+ int i, j, err;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return data;
if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
|| !data->valid) {
@@ -2011,7 +2027,7 @@ static struct nct6775_data *nct6775_update_device(struct device *dev)
data->valid = true;
}
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return data;
}
@@ -2043,11 +2059,15 @@ store_in_reg(struct device *dev, struct device_attribute *attr, const char *buf,
err = kstrtoul(buf, 10, &val);
if (err < 0)
return err;
- mutex_lock(&data->update_lock);
+
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->in[nr][index] = in_to_reg(val, nr);
data->write_value(data, data->REG_IN_MINMAX[index - 1][nr],
data->in[nr][index]);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2127,14 +2147,17 @@ store_beep(struct device *dev, struct device_attribute *attr, const char *buf,
if (val > 1)
return -EINVAL;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
if (val)
data->beeps |= (1ULL << nr);
else
data->beeps &= ~(1ULL << nr);
data->write_value(data, data->REG_BEEP[regindex],
(data->beeps >> (regindex << 3)) & 0xff);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2183,14 +2206,17 @@ store_temp_beep(struct device *dev, struct device_attribute *attr,
bit = data->BEEP_BITS[nr + TEMP_ALARM_BASE];
regindex = bit >> 3;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
if (val)
data->beeps |= (1ULL << bit);
else
data->beeps &= ~(1ULL << bit);
data->write_value(data, data->REG_BEEP[regindex],
(data->beeps >> (regindex << 3)) & 0xff);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2284,7 +2310,10 @@ store_fan_min(struct device *dev, struct device_attribute *attr,
if (err < 0)
return err;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
if (!data->has_fan_div) {
/* NCT6776F or NCT6779D; we know this is a 13 bit register */
if (!val) {
@@ -2357,7 +2386,7 @@ store_fan_min(struct device *dev, struct device_attribute *attr,
write_min:
data->write_value(data, data->REG_FAN_MIN[nr], data->fan_min[nr]);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2390,13 +2419,16 @@ store_fan_pulses(struct device *dev, struct device_attribute *attr,
if (val > 4)
return -EINVAL;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->fan_pulses[nr] = val & 3;
reg = data->read_value(data, data->REG_FAN_PULSES[nr]);
reg &= ~(0x03 << data->FAN_PULSE_SHIFT[nr]);
reg |= (val & 3) << data->FAN_PULSE_SHIFT[nr];
data->write_value(data, data->REG_FAN_PULSES[nr], reg);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2494,11 +2526,14 @@ store_temp(struct device *dev, struct device_attribute *attr, const char *buf,
if (err < 0)
return err;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->temp[index][nr] = LM75_TEMP_TO_REG(val);
nct6775_write_temp(data, data->reg_temp[index][nr],
data->temp[index][nr]);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2527,10 +2562,13 @@ store_temp_offset(struct device *dev, struct device_attribute *attr,
val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), -128, 127);
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->temp_offset[nr] = val;
data->write_value(data, data->REG_TEMP_OFFSET[nr], val);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2563,7 +2601,9 @@ store_temp_type(struct device *dev, struct device_attribute *attr,
if (val != 1 && val != 3 && val != 4)
return -EINVAL;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
data->temp_type[nr] = val;
vbit = 0x02 << nr;
@@ -2584,7 +2624,7 @@ store_temp_type(struct device *dev, struct device_attribute *attr,
data->write_value(data, data->REG_VBAT, vbat);
data->write_value(data, data->REG_DIODE, diode);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2704,14 +2744,17 @@ store_pwm_mode(struct device *dev, struct device_attribute *attr,
return count;
}
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->pwm_mode[nr] = val;
reg = data->read_value(data, data->REG_PWM_MODE[nr]);
reg &= ~data->PWM_MODE_MASK[nr];
if (!val)
reg |= data->PWM_MODE_MASK[nr];
data->write_value(data, data->REG_PWM_MODE[nr], reg);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2756,7 +2799,10 @@ store_pwm(struct device *dev, struct device_attribute *attr, const char *buf,
return err;
val = clamp_val(val, minval[index], maxval[index]);
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->pwm[index][nr] = val;
data->write_value(data, data->REG_PWM[index][nr], val);
if (index == 2) { /* floor: disable if val == 0 */
@@ -2766,7 +2812,7 @@ store_pwm(struct device *dev, struct device_attribute *attr, const char *buf,
reg |= 0x80;
data->write_value(data, data->REG_TEMP_SEL[nr], reg);
}
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2866,7 +2912,10 @@ store_pwm_enable(struct device *dev, struct device_attribute *attr,
return -EINVAL;
}
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->pwm_enable[nr] = val;
if (val == off) {
/*
@@ -2880,7 +2929,7 @@ store_pwm_enable(struct device *dev, struct device_attribute *attr,
reg &= 0x0f;
reg |= pwm_enable_to_reg(val) << 4;
data->write_value(data, data->REG_FAN_MODE[nr], reg);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2929,14 +2978,17 @@ store_pwm_temp_sel(struct device *dev, struct device_attribute *attr,
if (!(data->have_temp & BIT(val - 1)) || !data->temp_src[val - 1])
return -EINVAL;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
src = data->temp_src[val - 1];
data->pwm_temp_sel[nr] = src;
reg = data->read_value(data, data->REG_TEMP_SEL[nr]);
reg &= 0xe0;
reg |= src;
data->write_value(data, data->REG_TEMP_SEL[nr], reg);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -2973,7 +3025,10 @@ store_pwm_weight_temp_sel(struct device *dev, struct device_attribute *attr,
!data->temp_src[val - 1]))
return -EINVAL;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
if (val) {
src = data->temp_src[val - 1];
data->pwm_weight_temp_sel[nr] = src;
@@ -2987,7 +3042,7 @@ store_pwm_weight_temp_sel(struct device *dev, struct device_attribute *attr,
reg &= 0x7f;
data->write_value(data, data->REG_WEIGHT_TEMP_SEL[nr], reg);
}
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3018,10 +3073,13 @@ store_target_temp(struct device *dev, struct device_attribute *attr,
val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0,
data->target_temp_mask);
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->target_temp[nr] = val;
pwm_update_registers(data, nr);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3055,10 +3113,13 @@ store_target_speed(struct device *dev, struct device_attribute *attr,
val = clamp_val(val, 0, 1350000U);
speed = fan_to_reg(val, data->fan_div[nr]);
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->target_speed[nr] = speed;
pwm_update_registers(data, nr);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3092,7 +3153,10 @@ store_temp_tolerance(struct device *dev, struct device_attribute *attr,
/* Limit tolerance as needed */
val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0, data->tolerance_mask);
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->temp_tolerance[index][nr] = val;
if (index)
pwm_update_registers(data, nr);
@@ -3100,7 +3164,7 @@ store_temp_tolerance(struct device *dev, struct device_attribute *attr,
data->write_value(data,
data->REG_CRITICAL_TEMP_TOLERANCE[nr],
val);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3169,10 +3233,13 @@ store_speed_tolerance(struct device *dev, struct device_attribute *attr,
/* Limit tolerance as needed */
val = clamp_val(val, 0, data->speed_tolerance_limit);
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->target_speed_tolerance[nr] = val;
pwm_update_registers(data, nr);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3220,10 +3287,13 @@ store_weight_temp(struct device *dev, struct device_attribute *attr,
val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0, 255);
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->weight_temp[index][nr] = val;
data->write_value(data, data->REG_WEIGHT_TEMP[index][nr], val);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3269,10 +3339,13 @@ store_fan_time(struct device *dev, struct device_attribute *attr,
return err;
val = step_time_to_reg(val, data->pwm_mode[nr]);
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->fan_time[index][nr] = val;
data->write_value(data, data->REG_FAN_TIME[index][nr], val);
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3310,7 +3383,10 @@ store_auto_pwm(struct device *dev, struct device_attribute *attr,
val = 0xff;
}
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->auto_pwm[nr][point] = val;
if (point < data->auto_pwm_num) {
data->write_value(data,
@@ -3355,7 +3431,7 @@ store_auto_pwm(struct device *dev, struct device_attribute *attr,
break;
}
}
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3391,7 +3467,10 @@ store_auto_temp(struct device *dev, struct device_attribute *attr,
if (val > 255000)
return -EINVAL;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->auto_temp[nr][point] = DIV_ROUND_CLOSEST(val, 1000);
if (point < data->auto_pwm_num) {
data->write_value(data,
@@ -3401,7 +3480,7 @@ store_auto_temp(struct device *dev, struct device_attribute *attr,
data->write_value(data, data->REG_CRITICAL_TEMP[nr],
data->auto_temp[nr][point]);
}
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3570,7 +3649,9 @@ clear_caseopen(struct device *dev, struct device_attribute *attr,
if (kstrtoul(buf, 10, &val) || val != 0)
return -EINVAL;
- mutex_lock(&data->update_lock);
+ ret = data->lock(data);
+ if (ret)
+ return ret;
/*
* Use CR registers to clear caseopen status.
@@ -3593,7 +3674,7 @@ clear_caseopen(struct device *dev, struct device_attribute *attr,
data->valid = false; /* Force cache refresh */
error:
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return count;
}
@@ -3981,6 +4062,9 @@ static int nct6775_probe(struct platform_device *pdev)
}
mutex_init(&data->update_lock);
+ data->lock = nct6775_lock;
+ data->unlock = nct6775_unlock;
+
data->name = nct6775_device_names[data->kind];
data->bank = 0xff; /* Force initial bank selection */
platform_set_drvdata(pdev, data);
@@ -4790,14 +4874,18 @@ static void nct6791_enable_io_mapping(struct nct6775_sio_data *sio_data)
static int __maybe_unused nct6775_suspend(struct device *dev)
{
struct nct6775_data *data = nct6775_update_device(dev);
+ int err;
+
+ err = data->lock(data);
+ if (err)
+ return err;
- mutex_lock(&data->update_lock);
data->vbat = data->read_value(data, data->REG_VBAT);
if (data->kind == nct6775) {
data->fandiv1 = data->read_value(data, NCT6775_REG_FANDIV1);
data->fandiv2 = data->read_value(data, NCT6775_REG_FANDIV2);
}
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return 0;
}
@@ -4806,10 +4894,13 @@ static int __maybe_unused nct6775_resume(struct device *dev)
{
struct nct6775_data *data = dev_get_drvdata(dev);
struct nct6775_sio_data *sio_data = dev_get_platdata(dev);
- int i, j, err = 0;
+ int i, j, err;
u8 reg;
- mutex_lock(&data->update_lock);
+ err = data->lock(data);
+ if (err)
+ return err;
+
data->bank = 0xff; /* Force initial bank selection */
err = sio_data->sio_enter(sio_data);
@@ -4868,7 +4959,7 @@ static int __maybe_unused nct6775_resume(struct device *dev)
abort:
/* Force re-reading all values */
data->valid = false;
- mutex_unlock(&data->update_lock);
+ data->unlock(data, dev);
return err;
}
Prepare for platform specific callbacks usage: * Use nct6775 lock function pointers in struct nct6775_data instead direct calls. BugLink: https://bugzilla.kernel.org/show_bug.cgi?id=204807 Signed-off-by: Denis Pauk <pauk.denis@gmail.com> --- drivers/hwmon/nct6775.c | 195 +++++++++++++++++++++++++++++----------- 1 file changed, 143 insertions(+), 52 deletions(-)