1 // SPDX-License-Identifier: GPL-2.0-or-later
3  * max31790.c - Part of lm_sensors, Linux kernel modules for hardware
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()
168 static int max31790_read_fan(struct device *dev, u32 attr, int channel,  in max31790_read_fan()  argument
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()
198 		 * clears the fault for the companion channel if enabled.  in max31790_read_fan()
201 			int reg = MAX31790_REG_TARGET_COUNT(channel % NR_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()
216 static int max31790_write_fan(struct device *dev, u32 attr, int channel,  in max31790_write_fan()  argument
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()
226 	mutex_lock(&data->update_lock);  in max31790_write_fan()
232 		data->fan_dynamics[channel] =  in max31790_write_fan()
233 			((data->fan_dynamics[channel] &  in max31790_write_fan()
237 					MAX31790_REG_FAN_DYNAMICS(channel),  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()
249 					MAX31790_REG_TARGET_COUNT(channel),  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()
263 			err = i2c_smbus_write_byte_data(client, MAX31790_REG_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()
279 static umode_t max31790_fan_is_visible(const void *_data, u32 attr, int channel)  in max31790_fan_is_visible()  argument
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()
287 		if (channel < NR_CHANNEL ||  in max31790_fan_is_visible()
292 		if (channel < NR_CHANNEL &&  in max31790_fan_is_visible()
297 		if (channel < NR_CHANNEL)  in max31790_fan_is_visible()
305 static int max31790_read_pwm(struct device *dev, u32 attr, int channel,  in max31790_read_pwm()  argument
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()
333 static int max31790_write_pwm(struct device *dev, u32 attr, int channel,  in max31790_write_pwm()  argument
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()
354 						   MAX31790_REG_PWMOUT(channel),  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()
382 			err = i2c_smbus_write_byte_data(client, MAX31790_REG_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()
398 static umode_t max31790_pwm_is_visible(const void *_data, u32 attr, int channel)  in max31790_pwm_is_visible()  argument
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()
415 			 u32 attr, int channel, long *val)  in max31790_read()  argument
419 		return max31790_read_fan(dev, attr, channel, val);  in max31790_read()
421 		return max31790_read_pwm(dev, attr, channel, val);  in max31790_read()
423 		return -EOPNOTSUPP;  in max31790_read()
428 			  u32 attr, int channel, long val)  in max31790_write()  argument
432 		return max31790_write_fan(dev, attr, channel, val);  in max31790_write()
434 		return max31790_write_pwm(dev, attr, channel, val);  in max31790_write()
436 		return -EOPNOTSUPP;  in max31790_write()
440 static umode_t max31790_is_visible(const void *data,  in max31790_is_visible()  argument
442 				   u32 attr, int channel)  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()