|
@@ -246,35 +246,6 @@ static struct i2c_driver pc87360_driver = {
|
|
* Sysfs stuff
|
|
* Sysfs stuff
|
|
*/
|
|
*/
|
|
|
|
|
|
-static ssize_t _set_fan_min(struct device *dev, const char *buf,
|
|
|
|
- size_t count, int nr)
|
|
|
|
-{
|
|
|
|
- struct i2c_client *client = to_i2c_client(dev);
|
|
|
|
- struct pc87360_data *data = i2c_get_clientdata(client);
|
|
|
|
- long fan_min = simple_strtol(buf, NULL, 10);
|
|
|
|
-
|
|
|
|
- down(&data->update_lock);
|
|
|
|
- fan_min = FAN_TO_REG(fan_min, FAN_DIV_FROM_REG(data->fan_status[nr]));
|
|
|
|
-
|
|
|
|
- /* If it wouldn't fit, change clock divisor */
|
|
|
|
- while (fan_min > 255
|
|
|
|
- && (data->fan_status[nr] & 0x60) != 0x60) {
|
|
|
|
- fan_min >>= 1;
|
|
|
|
- data->fan[nr] >>= 1;
|
|
|
|
- data->fan_status[nr] += 0x20;
|
|
|
|
- }
|
|
|
|
- data->fan_min[nr] = fan_min > 255 ? 255 : fan_min;
|
|
|
|
- pc87360_write_value(data, LD_FAN, NO_BANK, PC87360_REG_FAN_MIN(nr),
|
|
|
|
- data->fan_min[nr]);
|
|
|
|
-
|
|
|
|
- /* Write new divider, preserve alarm bits */
|
|
|
|
- pc87360_write_value(data, LD_FAN, NO_BANK, PC87360_REG_FAN_STATUS(nr),
|
|
|
|
- data->fan_status[nr] & 0xF9);
|
|
|
|
- up(&data->update_lock);
|
|
|
|
-
|
|
|
|
- return count;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
static ssize_t show_fan_input(struct device *dev, struct device_attribute *devattr, char *buf)
|
|
static ssize_t show_fan_input(struct device *dev, struct device_attribute *devattr, char *buf)
|
|
{
|
|
{
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
|
|
@@ -307,7 +278,30 @@ static ssize_t set_fan_min(struct device *dev, struct device_attribute *devattr,
|
|
size_t count)
|
|
size_t count)
|
|
{
|
|
{
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
|
|
- return _set_fan_min(dev, buf, count, attr->index);
|
|
|
|
|
|
+ struct i2c_client *client = to_i2c_client(dev);
|
|
|
|
+ struct pc87360_data *data = i2c_get_clientdata(client);
|
|
|
|
+ long fan_min = simple_strtol(buf, NULL, 10);
|
|
|
|
+
|
|
|
|
+ down(&data->update_lock);
|
|
|
|
+ fan_min = FAN_TO_REG(fan_min, FAN_DIV_FROM_REG(data->fan_status[attr->index]));
|
|
|
|
+
|
|
|
|
+ /* If it wouldn't fit, change clock divisor */
|
|
|
|
+ while (fan_min > 255
|
|
|
|
+ && (data->fan_status[attr->index] & 0x60) != 0x60) {
|
|
|
|
+ fan_min >>= 1;
|
|
|
|
+ data->fan[attr->index] >>= 1;
|
|
|
|
+ data->fan_status[attr->index] += 0x20;
|
|
|
|
+ }
|
|
|
|
+ data->fan_min[attr->index] = fan_min > 255 ? 255 : fan_min;
|
|
|
|
+ pc87360_write_value(data, LD_FAN, NO_BANK, PC87360_REG_FAN_MIN(attr->index),
|
|
|
|
+ data->fan_min[attr->index]);
|
|
|
|
+
|
|
|
|
+ /* Write new divider, preserve alarm bits */
|
|
|
|
+ pc87360_write_value(data, LD_FAN, NO_BANK, PC87360_REG_FAN_STATUS(attr->index),
|
|
|
|
+ data->fan_status[attr->index] & 0xF9);
|
|
|
|
+ up(&data->update_lock);
|
|
|
|
+
|
|
|
|
+ return count;
|
|
}
|
|
}
|
|
|
|
|
|
#define show_and_set_fan(offset) \
|
|
#define show_and_set_fan(offset) \
|