1 // SPDX-License-Identifier: GPL-2.0-or-later
3  * max31790.c - Part of lm_sensors, Linux kernel modules for hardware
28 /* Fan Config register bits */
34 /* Fan Dynamics register bits */
56  * Client data (each client gets its own)
75 	struct max31790_data *data = dev_get_drvdata(dev);  in max31790_update_device()  local
76 	struct i2c_client *client = data->client;  in max31790_update_device()
77 	struct max31790_data *ret = data;  in max31790_update_device()
81 	mutex_lock(&data->update_lock);  in max31790_update_device()
83 	if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {  in max31790_update_device()
88 		data->fault_status |= rv & 0x3F;  in max31790_update_device()
94 		data->fault_status |= (rv & 0x3F) << 6;  in max31790_update_device()
101 			data->tach[i] = rv;  in max31790_update_device()
103 			if (data->fan_config[i]  in max31790_update_device()
110 				data->tach[NR_CHANNEL + i] = rv;  in max31790_update_device()
116 				data->pwm[i] = rv;  in max31790_update_device()
122 				data->target_count[i] = rv;  in max31790_update_device()
126 		data->last_updated = jiffies;  in max31790_update_device()
127 		data->valid = true;  in max31790_update_device()
132 	data->valid = false;  in max31790_update_device()
136 	mutex_unlock(&data->update_lock);  in max31790_update_device()
150 	u8 bits;  in bits_for_tach_period()  local
153 		bits = 0x0;  in bits_for_tach_period()
155 		bits = 0x1;  in bits_for_tach_period()
157 		bits = 0x2;  in bits_for_tach_period()
159 		bits = 0x3;  in bits_for_tach_period()
161 		bits = 0x4;  in bits_for_tach_period()
163 		bits = 0x5;  in bits_for_tach_period()
165 	return bits;  in bits_for_tach_period()
171 	struct max31790_data *data = max31790_update_device(dev);  in max31790_read_fan()  local
174 	if (IS_ERR(data))  in max31790_read_fan()
175 		return PTR_ERR(data);  in max31790_read_fan()
179 		sr = get_tach_period(data->fan_dynamics[channel % NR_CHANNEL]);  in max31790_read_fan()
180 		if (data->tach[channel] == FAN_COUNT_REG_MAX)  in max31790_read_fan()
183 			rpm = RPM_FROM_REG(data->tach[channel], sr);  in max31790_read_fan()
187 		sr = get_tach_period(data->fan_dynamics[channel]);  in max31790_read_fan()
188 		rpm = RPM_FROM_REG(data->target_count[channel], sr);  in max31790_read_fan()
192 		mutex_lock(&data->update_lock);  in max31790_read_fan()
193 		*val = !!(data->fault_status & (1 << channel));  in max31790_read_fan()
194 		data->fault_status &= ~(1 << channel);  in max31790_read_fan()
203 			i2c_smbus_write_byte_data(data->client, reg,  in max31790_read_fan()
204 						  data->target_count[channel % NR_CHANNEL] >> 8);  in max31790_read_fan()
206 		mutex_unlock(&data->update_lock);  in max31790_read_fan()
209 		*val = !!(data->fan_config[channel] & MAX31790_FAN_CFG_TACH_INPUT_EN);  in max31790_read_fan()
212 		return -EOPNOTSUPP;  in max31790_read_fan()
219 	struct max31790_data *data = dev_get_drvdata(dev);  in max31790_write_fan()  local
220 	struct i2c_client *client = data->client;  in max31790_write_fan()
223 	u8 bits, fan_config;  in max31790_write_fan()  local
226 	mutex_lock(&data->update_lock);  in max31790_write_fan()
231 		bits = bits_for_tach_period(val);  in max31790_write_fan()
232 		data->fan_dynamics[channel] =  in max31790_write_fan()
233 			((data->fan_dynamics[channel] &  in max31790_write_fan()
235 			 (bits << MAX31790_FAN_DYN_SR_SHIFT));  in max31790_write_fan()
238 					data->fan_dynamics[channel]);  in max31790_write_fan()
242 		sr = get_tach_period(data->fan_dynamics[channel]);  in max31790_write_fan()
246 		data->target_count[channel] = target_count << 5;  in max31790_write_fan()
250 					data->target_count[channel]);  in max31790_write_fan()
253 		fan_config = data->fan_config[channel];  in max31790_write_fan()
259 			err = -EINVAL;  in max31790_write_fan()
262 		if (fan_config != data->fan_config[channel]) {  in max31790_write_fan()
266 				data->fan_config[channel] = fan_config;  in max31790_write_fan()
270 		err = -EOPNOTSUPP;  in max31790_write_fan()
274 	mutex_unlock(&data->update_lock);  in max31790_write_fan()
281 	const struct max31790_data *data = _data;  in max31790_fan_is_visible()  local
282 	u8 fan_config = data->fan_config[channel % NR_CHANNEL];  in max31790_fan_is_visible()
308 	struct max31790_data *data = max31790_update_device(dev);  in max31790_read_pwm()  local
311 	if (IS_ERR(data))  in max31790_read_pwm()
312 		return PTR_ERR(data);  in max31790_read_pwm()
314 	fan_config = data->fan_config[channel];  in max31790_read_pwm()
318 		*val = data->pwm[channel] >> 8;  in max31790_read_pwm()
329 		return -EOPNOTSUPP;  in max31790_read_pwm()
336 	struct max31790_data *data = dev_get_drvdata(dev);  in max31790_write_pwm()  local
337 	struct i2c_client *client = data->client;  in max31790_write_pwm()
341 	mutex_lock(&data->update_lock);  in max31790_write_pwm()
346 			err = -EINVAL;  in max31790_write_pwm()
352 		data->valid = false;  in max31790_write_pwm()
358 		fan_config = data->fan_config[channel];  in max31790_write_pwm()
378 			err = -EINVAL;  in max31790_write_pwm()
381 		if (fan_config != data->fan_config[channel]) {  in max31790_write_pwm()
385 				data->fan_config[channel] = fan_config;  in max31790_write_pwm()
389 		err = -EOPNOTSUPP;  in max31790_write_pwm()
393 	mutex_unlock(&data->update_lock);  in max31790_write_pwm()
400 	const struct max31790_data *data = _data;  in max31790_pwm_is_visible()  local
401 	u8 fan_config = data->fan_config[channel];  in max31790_pwm_is_visible()
423 		return -EOPNOTSUPP;  in max31790_read()
436 		return -EOPNOTSUPP;  in max31790_write()
440 static umode_t max31790_is_visible(const void *data,  in max31790_is_visible()  argument
446 		return max31790_fan_is_visible(data, attr, channel);  in max31790_is_visible()
448 		return max31790_pwm_is_visible(data, attr, channel);  in max31790_is_visible()
490 				struct max31790_data *data)  in max31790_init_client()  argument
499 		data->fan_config[i] = rv;  in max31790_init_client()
505 		data->fan_dynamics[i] = rv;  in max31790_init_client()
513 	struct i2c_adapter *adapter = client->adapter;  in max31790_probe()
514 	struct device *dev = &client->dev;  in max31790_probe()
515 	struct max31790_data *data;  in max31790_probe()  local
521 		return -ENODEV;  in max31790_probe()
523 	data = devm_kzalloc(dev, sizeof(struct max31790_data), GFP_KERNEL);  in max31790_probe()
524 	if (!data)  in max31790_probe()
525 		return -ENOMEM;  in max31790_probe()
527 	data->client = client;  in max31790_probe()
528 	mutex_init(&data->update_lock);  in max31790_probe()
533 	err = max31790_init_client(client, data);  in max31790_probe()
537 	hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name,  in max31790_probe()
538 							 data,  in max31790_probe()