Linux Audio

Check our new training course

Loading...
v6.8
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/***************************************************************************
  3 *   Copyright (C) 2010-2012 Hans de Goede <hdegoede@redhat.com>           *
  4 *                                                                         *
  5 ***************************************************************************/
  6
  7#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  8
  9#include <linux/bits.h>
 10#include <linux/minmax.h>
 11#include <linux/module.h>
 12#include <linux/mod_devicetable.h>
 13#include <linux/pm.h>
 14#include <linux/init.h>
 15#include <linux/regmap.h>
 16#include <linux/slab.h>
 17#include <linux/jiffies.h>
 18#include <linux/platform_device.h>
 19#include <linux/hwmon.h>
 
 20#include <linux/err.h>
 21#include <linux/mutex.h>
 22#include "sch56xx-common.h"
 23
 24#define DRVNAME "sch5627"
 25#define DEVNAME DRVNAME /* We only support one model */
 26
 27#define SCH5627_HWMON_ID		0xa5
 28#define SCH5627_COMPANY_ID		0x5c
 29#define SCH5627_PRIMARY_ID		0xa0
 30
 31#define SCH5627_REG_BUILD_CODE		0x39
 32#define SCH5627_REG_BUILD_ID		0x3a
 33#define SCH5627_REG_HWMON_ID		0x3c
 34#define SCH5627_REG_HWMON_REV		0x3d
 35#define SCH5627_REG_COMPANY_ID		0x3e
 36#define SCH5627_REG_PRIMARY_ID		0x3f
 37#define SCH5627_REG_CTRL		0x40
 38
 39#define SCH5627_CTRL_START		BIT(0)
 40#define SCH5627_CTRL_LOCK		BIT(1)
 41#define SCH5627_CTRL_VBAT		BIT(4)
 42
 43#define SCH5627_NO_TEMPS		8
 44#define SCH5627_NO_FANS			4
 45#define SCH5627_NO_IN			5
 46
 47static const u16 SCH5627_REG_TEMP_MSB[SCH5627_NO_TEMPS] = {
 48	0x2B, 0x26, 0x27, 0x28, 0x29, 0x2A, 0x180, 0x181 };
 49static const u16 SCH5627_REG_TEMP_LSN[SCH5627_NO_TEMPS] = {
 50	0xE2, 0xE1, 0xE1, 0xE5, 0xE5, 0xE6, 0x182, 0x182 };
 51static const u16 SCH5627_REG_TEMP_HIGH_NIBBLE[SCH5627_NO_TEMPS] = {
 52	0, 0, 1, 1, 0, 0, 0, 1 };
 53static const u16 SCH5627_REG_TEMP_HIGH[SCH5627_NO_TEMPS] = {
 54	0x61, 0x57, 0x59, 0x5B, 0x5D, 0x5F, 0x184, 0x186 };
 55static const u16 SCH5627_REG_TEMP_ABS[SCH5627_NO_TEMPS] = {
 56	0x9B, 0x96, 0x97, 0x98, 0x99, 0x9A, 0x1A8, 0x1A9 };
 57
 58static const u16 SCH5627_REG_FAN[SCH5627_NO_FANS] = {
 59	0x2C, 0x2E, 0x30, 0x32 };
 60static const u16 SCH5627_REG_FAN_MIN[SCH5627_NO_FANS] = {
 61	0x62, 0x64, 0x66, 0x68 };
 62
 63static const u16 SCH5627_REG_PWM_MAP[SCH5627_NO_FANS] = {
 64	0xA0, 0xA1, 0xA2, 0xA3 };
 65
 66static const u16 SCH5627_REG_IN_MSB[SCH5627_NO_IN] = {
 67	0x22, 0x23, 0x24, 0x25, 0x189 };
 68static const u16 SCH5627_REG_IN_LSN[SCH5627_NO_IN] = {
 69	0xE4, 0xE4, 0xE3, 0xE3, 0x18A };
 70static const u16 SCH5627_REG_IN_HIGH_NIBBLE[SCH5627_NO_IN] = {
 71	1, 0, 1, 0, 1 };
 72static const u16 SCH5627_REG_IN_FACTOR[SCH5627_NO_IN] = {
 73	10745, 3660, 9765, 10745, 3660 };
 74static const char * const SCH5627_IN_LABELS[SCH5627_NO_IN] = {
 75	"VCC", "VTT", "VBAT", "VTR", "V_IN" };
 76
 77struct sch5627_data {
 78	struct regmap *regmap;
 79	unsigned short addr;
 
 
 80	u8 control;
 
 
 
 81
 82	struct mutex update_lock;
 83	unsigned long last_battery;	/* In jiffies */
 84	char temp_valid;		/* !=0 if following fields are valid */
 85	char fan_valid;
 86	char in_valid;
 87	unsigned long temp_last_updated;	/* In jiffies */
 88	unsigned long fan_last_updated;
 89	unsigned long in_last_updated;
 90	u16 temp[SCH5627_NO_TEMPS];
 91	u16 fan[SCH5627_NO_FANS];
 92	u16 in[SCH5627_NO_IN];
 93};
 94
 95static const struct regmap_range sch5627_tunables_ranges[] = {
 96	regmap_reg_range(0x57, 0x57),
 97	regmap_reg_range(0x59, 0x59),
 98	regmap_reg_range(0x5B, 0x5B),
 99	regmap_reg_range(0x5D, 0x5D),
100	regmap_reg_range(0x5F, 0x5F),
101	regmap_reg_range(0x61, 0x69),
102	regmap_reg_range(0x96, 0x9B),
103	regmap_reg_range(0xA0, 0xA3),
104	regmap_reg_range(0x184, 0x184),
105	regmap_reg_range(0x186, 0x186),
106	regmap_reg_range(0x1A8, 0x1A9),
107};
108
109static const struct regmap_access_table sch5627_tunables_table = {
110	.yes_ranges = sch5627_tunables_ranges,
111	.n_yes_ranges = ARRAY_SIZE(sch5627_tunables_ranges),
112};
113
114static const struct regmap_config sch5627_regmap_config = {
115	.reg_bits = 16,
116	.val_bits = 8,
117	.wr_table = &sch5627_tunables_table,
118	.rd_table = &sch5627_tunables_table,
119	.cache_type = REGCACHE_RBTREE,
120	.use_single_read = true,
121	.use_single_write = true,
122	.can_sleep = true,
123};
124
125static int sch5627_update_temp(struct sch5627_data *data)
126{
127	int ret = 0;
 
128	int i, val;
129
130	mutex_lock(&data->update_lock);
131
 
 
 
 
 
 
 
132	/* Cache the values for 1 second */
133	if (time_after(jiffies, data->temp_last_updated + HZ) || !data->temp_valid) {
134		for (i = 0; i < SCH5627_NO_TEMPS; i++) {
135			val = sch56xx_read_virtual_reg12(data->addr, SCH5627_REG_TEMP_MSB[i],
136							 SCH5627_REG_TEMP_LSN[i],
137							 SCH5627_REG_TEMP_HIGH_NIBBLE[i]);
 
138			if (unlikely(val < 0)) {
139				ret = val;
140				goto abort;
141			}
142			data->temp[i] = val;
143		}
144		data->temp_last_updated = jiffies;
145		data->temp_valid = 1;
146	}
147abort:
148	mutex_unlock(&data->update_lock);
149	return ret;
150}
151
152static int sch5627_update_fan(struct sch5627_data *data)
153{
154	int ret = 0;
155	int i, val;
156
157	mutex_lock(&data->update_lock);
158
159	/* Cache the values for 1 second */
160	if (time_after(jiffies, data->fan_last_updated + HZ) || !data->fan_valid) {
161		for (i = 0; i < SCH5627_NO_FANS; i++) {
162			val = sch56xx_read_virtual_reg16(data->addr, SCH5627_REG_FAN[i]);
 
163			if (unlikely(val < 0)) {
164				ret = val;
165				goto abort;
166			}
167			data->fan[i] = val;
168		}
169		data->fan_last_updated = jiffies;
170		data->fan_valid = 1;
171	}
172abort:
173	mutex_unlock(&data->update_lock);
174	return ret;
175}
176
177static int sch5627_update_in(struct sch5627_data *data)
178{
179	int ret = 0;
180	int i, val;
181
182	mutex_lock(&data->update_lock);
183
184	/* Trigger a Vbat voltage measurement every 5 minutes */
185	if (time_after(jiffies, data->last_battery + 300 * HZ)) {
186		sch56xx_write_virtual_reg(data->addr, SCH5627_REG_CTRL,
187					  data->control | SCH5627_CTRL_VBAT);
188		data->last_battery = jiffies;
189	}
190
191	/* Cache the values for 1 second */
192	if (time_after(jiffies, data->in_last_updated + HZ) || !data->in_valid) {
193		for (i = 0; i < SCH5627_NO_IN; i++) {
194			val = sch56xx_read_virtual_reg12(data->addr, SCH5627_REG_IN_MSB[i],
195							 SCH5627_REG_IN_LSN[i],
196							 SCH5627_REG_IN_HIGH_NIBBLE[i]);
 
197			if (unlikely(val < 0)) {
198				ret = val;
199				goto abort;
200			}
201			data->in[i] = val;
202		}
203		data->in_last_updated = jiffies;
204		data->in_valid = 1;
 
205	}
206abort:
207	mutex_unlock(&data->update_lock);
208	return ret;
209}
210
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
211static int reg_to_temp(u16 reg)
212{
213	return (reg * 625) / 10 - 64000;
214}
215
216static int reg_to_temp_limit(u8 reg)
217{
218	return (reg - 64) * 1000;
219}
220
221static int reg_to_rpm(u16 reg)
222{
223	if (reg == 0)
224		return -EIO;
225	if (reg == 0xffff)
226		return 0;
227
228	return 5400540 / reg;
229}
230
231static u8 sch5627_temp_limit_to_reg(long value)
 
232{
233	long limit = (value / 1000) + 64;
234
235	return clamp_val(limit, 0, U8_MAX);
236}
237
238static u16 sch5627_rpm_to_reg(long value)
 
239{
240	long pulses;
241
242	if (value <= 0)
243		return U16_MAX - 1;
244
245	pulses = 5400540 / value;
 
246
247	return clamp_val(pulses, 1, U16_MAX - 1);
 
248}
249
250static umode_t sch5627_is_visible(const void *drvdata, enum hwmon_sensor_types type, u32 attr,
251				  int channel)
252{
253	const struct sch5627_data *data = drvdata;
 
254
255	/* Once the lock bit is set, the virtual registers become read-only
256	 * until the next power cycle.
257	 */
258	if (data->control & SCH5627_CTRL_LOCK)
259		return 0444;
260
261	switch (type) {
262	case hwmon_temp:
263		switch (attr) {
264		case hwmon_temp_max:
265		case hwmon_temp_crit:
266			return 0644;
267		default:
268			break;
269		}
270		break;
271	case hwmon_fan:
272		switch (attr) {
273		case hwmon_fan_min:
274			return 0644;
275		default:
276			break;
277		}
278		break;
279	case hwmon_pwm:
280		switch (attr) {
281		case hwmon_pwm_auto_channels_temp:
282			return 0644;
283		default:
284			break;
285		}
286		break;
287	default:
288		break;
289	}
290
291	return 0444;
 
 
 
 
 
 
 
 
292}
293
294static int sch5627_read(struct device *dev, enum hwmon_sensor_types type, u32 attr, int channel,
295			long *val)
296{
 
297	struct sch5627_data *data = dev_get_drvdata(dev);
298	int ret, value;
299
300	switch (type) {
301	case hwmon_temp:
302		switch (attr) {
303		case hwmon_temp_input:
304			ret = sch5627_update_temp(data);
305			if (ret < 0)
306				return ret;
307
308			*val = reg_to_temp(data->temp[channel]);
309			return 0;
310		case hwmon_temp_max:
311			ret = regmap_read(data->regmap, SCH5627_REG_TEMP_ABS[channel], &value);
312			if (ret < 0)
313				return ret;
314
315			*val = reg_to_temp_limit((u8)value);
316			return 0;
317		case hwmon_temp_crit:
318			ret = regmap_read(data->regmap, SCH5627_REG_TEMP_HIGH[channel], &value);
319			if (ret < 0)
320				return ret;
321
322			*val = reg_to_temp_limit((u8)value);
323			return 0;
324		case hwmon_temp_fault:
325			ret = sch5627_update_temp(data);
326			if (ret < 0)
327				return ret;
328
329			*val = (data->temp[channel] == 0);
330			return 0;
331		default:
332			break;
333		}
334		break;
335	case hwmon_fan:
336		switch (attr) {
337		case hwmon_fan_input:
338			ret = sch5627_update_fan(data);
339			if (ret < 0)
340				return ret;
341
342			ret = reg_to_rpm(data->fan[channel]);
343			if (ret < 0)
344				return ret;
345
346			*val = ret;
347			return 0;
348		case hwmon_fan_min:
349			ret = sch56xx_regmap_read16(data->regmap, SCH5627_REG_FAN_MIN[channel],
350						    &value);
351			if (ret < 0)
352				return ret;
353
354			ret = reg_to_rpm((u16)value);
355			if (ret < 0)
356				return ret;
357
358			*val = ret;
359			return 0;
360		case hwmon_fan_fault:
361			ret = sch5627_update_fan(data);
362			if (ret < 0)
363				return ret;
364
365			*val = (data->fan[channel] == 0xffff);
366			return 0;
367		default:
368			break;
369		}
370		break;
371	case hwmon_pwm:
372		switch (attr) {
373		case hwmon_pwm_auto_channels_temp:
374			ret = regmap_read(data->regmap, SCH5627_REG_PWM_MAP[channel], &value);
375			if (ret < 0)
376				return ret;
377
378			*val = value;
379			return 0;
380		default:
381			break;
382		}
383		break;
384	case hwmon_in:
385		ret = sch5627_update_in(data);
386		if (ret < 0)
387			return ret;
388		switch (attr) {
389		case hwmon_in_input:
390			*val = DIV_ROUND_CLOSEST(data->in[channel] * SCH5627_REG_IN_FACTOR[channel],
391						 10000);
392			return 0;
393		default:
394			break;
395		}
396		break;
397	default:
398		break;
399	}
400
401	return -EOPNOTSUPP;
 
 
 
 
 
 
 
402}
403
404static int sch5627_read_string(struct device *dev, enum hwmon_sensor_types type, u32 attr,
405			       int channel, const char **str)
406{
407	switch (type) {
408	case hwmon_in:
409		switch (attr) {
410		case hwmon_in_label:
411			*str = SCH5627_IN_LABELS[channel];
412			return 0;
413		default:
414			break;
415		}
416		break;
417	default:
418		break;
419	}
420
421	return -EOPNOTSUPP;
 
 
 
 
422}
423
424static int sch5627_write(struct device *dev, enum hwmon_sensor_types type, u32 attr, int channel,
425			 long val)
426{
 
427	struct sch5627_data *data = dev_get_drvdata(dev);
428	u16 fan;
429	u8 temp;
430
431	switch (type) {
432	case hwmon_temp:
433		temp = sch5627_temp_limit_to_reg(val);
434
435		switch (attr) {
436		case hwmon_temp_max:
437			return regmap_write(data->regmap, SCH5627_REG_TEMP_ABS[channel], temp);
438		case hwmon_temp_crit:
439			return regmap_write(data->regmap, SCH5627_REG_TEMP_HIGH[channel], temp);
440		default:
441			break;
442		}
443		break;
444	case hwmon_fan:
445		switch (attr) {
446		case hwmon_fan_min:
447			fan = sch5627_rpm_to_reg(val);
448
449			return sch56xx_regmap_write16(data->regmap, SCH5627_REG_FAN_MIN[channel],
450						      fan);
451		default:
452			break;
453		}
454		break;
455	case hwmon_pwm:
456		switch (attr) {
457		case hwmon_pwm_auto_channels_temp:
458			/* registers are 8 bit wide */
459			if (val > U8_MAX || val < 0)
460				return -EINVAL;
461
462			return regmap_write(data->regmap, SCH5627_REG_PWM_MAP[channel], val);
463		default:
464			break;
465		}
466		break;
467	default:
468		break;
469	}
470
471	return -EOPNOTSUPP;
472}
473
474static const struct hwmon_ops sch5627_ops = {
475	.is_visible = sch5627_is_visible,
476	.read = sch5627_read,
477	.read_string = sch5627_read_string,
478	.write = sch5627_write,
479};
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
480
481static const struct hwmon_channel_info * const sch5627_info[] = {
482	HWMON_CHANNEL_INFO(chip, HWMON_C_REGISTER_TZ),
483	HWMON_CHANNEL_INFO(temp,
484			   HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT | HWMON_T_FAULT,
485			   HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT | HWMON_T_FAULT,
486			   HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT | HWMON_T_FAULT,
487			   HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT | HWMON_T_FAULT,
488			   HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT | HWMON_T_FAULT,
489			   HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT | HWMON_T_FAULT,
490			   HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT | HWMON_T_FAULT,
491			   HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT | HWMON_T_FAULT
492			   ),
493	HWMON_CHANNEL_INFO(fan,
494			   HWMON_F_INPUT | HWMON_F_MIN | HWMON_F_FAULT,
495			   HWMON_F_INPUT | HWMON_F_MIN | HWMON_F_FAULT,
496			   HWMON_F_INPUT | HWMON_F_MIN | HWMON_F_FAULT,
497			   HWMON_F_INPUT | HWMON_F_MIN | HWMON_F_FAULT
498			   ),
499	HWMON_CHANNEL_INFO(pwm,
500			   HWMON_PWM_AUTO_CHANNELS_TEMP,
501			   HWMON_PWM_AUTO_CHANNELS_TEMP,
502			   HWMON_PWM_AUTO_CHANNELS_TEMP,
503			   HWMON_PWM_AUTO_CHANNELS_TEMP
504			   ),
505	HWMON_CHANNEL_INFO(in,
506			   HWMON_I_INPUT | HWMON_I_LABEL,
507			   HWMON_I_INPUT | HWMON_I_LABEL,
508			   HWMON_I_INPUT | HWMON_I_LABEL,
509			   HWMON_I_INPUT | HWMON_I_LABEL,
510			   HWMON_I_INPUT
511			   ),
512	NULL
513};
514
515static const struct hwmon_chip_info sch5627_chip_info = {
516	.ops = &sch5627_ops,
517	.info = sch5627_info,
518};
519
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
520static int sch5627_probe(struct platform_device *pdev)
521{
522	struct sch5627_data *data;
523	struct device *hwmon_dev;
524	int build_code, build_id, hwmon_rev, val;
525
526	data = devm_kzalloc(&pdev->dev, sizeof(struct sch5627_data),
527			    GFP_KERNEL);
528	if (!data)
529		return -ENOMEM;
530
531	data->addr = platform_get_resource(pdev, IORESOURCE_IO, 0)->start;
532	mutex_init(&data->update_lock);
533	platform_set_drvdata(pdev, data);
534
535	val = sch56xx_read_virtual_reg(data->addr, SCH5627_REG_HWMON_ID);
536	if (val < 0)
537		return val;
538
 
539	if (val != SCH5627_HWMON_ID) {
540		pr_err("invalid %s id: 0x%02X (expected 0x%02X)\n", "hwmon",
541		       val, SCH5627_HWMON_ID);
542		return -ENODEV;
 
543	}
544
545	val = sch56xx_read_virtual_reg(data->addr, SCH5627_REG_COMPANY_ID);
546	if (val < 0)
547		return val;
548
 
549	if (val != SCH5627_COMPANY_ID) {
550		pr_err("invalid %s id: 0x%02X (expected 0x%02X)\n", "company",
551		       val, SCH5627_COMPANY_ID);
552		return -ENODEV;
 
553	}
554
555	val = sch56xx_read_virtual_reg(data->addr, SCH5627_REG_PRIMARY_ID);
556	if (val < 0)
557		return val;
558
 
559	if (val != SCH5627_PRIMARY_ID) {
560		pr_err("invalid %s id: 0x%02X (expected 0x%02X)\n", "primary",
561		       val, SCH5627_PRIMARY_ID);
562		return -ENODEV;
 
563	}
564
565	build_code = sch56xx_read_virtual_reg(data->addr,
566					      SCH5627_REG_BUILD_CODE);
567	if (build_code < 0)
568		return build_code;
 
 
569
570	build_id = sch56xx_read_virtual_reg16(data->addr,
571					      SCH5627_REG_BUILD_ID);
572	if (build_id < 0)
573		return build_id;
 
 
574
575	hwmon_rev = sch56xx_read_virtual_reg(data->addr,
576					     SCH5627_REG_HWMON_REV);
577	if (hwmon_rev < 0)
578		return hwmon_rev;
 
 
579
580	val = sch56xx_read_virtual_reg(data->addr, SCH5627_REG_CTRL);
581	if (val < 0)
582		return val;
583
 
584	data->control = val;
585	if (!(data->control & SCH5627_CTRL_START)) {
586		pr_err("hardware monitoring not enabled\n");
587		return -ENODEV;
 
588	}
589
590	data->regmap = devm_regmap_init_sch56xx(&pdev->dev, &data->update_lock, data->addr,
591						&sch5627_regmap_config);
592	if (IS_ERR(data->regmap))
593		return PTR_ERR(data->regmap);
594
595	/* Trigger a Vbat voltage measurement, so that we get a valid reading
596	   the first time we read Vbat */
597	sch56xx_write_virtual_reg(data->addr, SCH5627_REG_CTRL, data->control | SCH5627_CTRL_VBAT);
 
598	data->last_battery = jiffies;
599
 
 
 
 
 
 
 
 
600	pr_info("found %s chip at %#hx\n", DEVNAME, data->addr);
601	pr_info("firmware build: code 0x%02X, id 0x%04X, hwmon: rev 0x%02X\n",
602		build_code, build_id, hwmon_rev);
603
604	hwmon_dev = devm_hwmon_device_register_with_info(&pdev->dev, DEVNAME, data,
605							 &sch5627_chip_info, NULL);
606	if (IS_ERR(hwmon_dev))
607		return PTR_ERR(hwmon_dev);
 
 
 
 
 
 
 
608
609	/* Note failing to register the watchdog is not a fatal error */
610	sch56xx_watchdog_register(&pdev->dev, data->addr,
611				  (build_code << 24) | (build_id << 8) | hwmon_rev,
612				  &data->update_lock, 1);
613
614	return 0;
615}
616
617static int sch5627_suspend(struct device *dev)
618{
619	struct sch5627_data *data = dev_get_drvdata(dev);
620
621	regcache_cache_only(data->regmap, true);
622	regcache_mark_dirty(data->regmap);
623
624	return 0;
625}
626
627static int sch5627_resume(struct device *dev)
628{
629	struct sch5627_data *data = dev_get_drvdata(dev);
630
631	regcache_cache_only(data->regmap, false);
632	/* We must not access the virtual registers when the lock bit is set */
633	if (data->control & SCH5627_CTRL_LOCK)
634		return regcache_drop_region(data->regmap, 0, U16_MAX);
635
636	return regcache_sync(data->regmap);
637}
638
639static DEFINE_SIMPLE_DEV_PM_OPS(sch5627_dev_pm_ops, sch5627_suspend, sch5627_resume);
640
641static const struct platform_device_id sch5627_device_id[] = {
642	{
643		.name = "sch5627",
644	},
645	{ }
646};
647MODULE_DEVICE_TABLE(platform, sch5627_device_id);
648
649static struct platform_driver sch5627_driver = {
650	.driver = {
651		.name	= DRVNAME,
652		.pm	= pm_sleep_ptr(&sch5627_dev_pm_ops),
653	},
654	.probe		= sch5627_probe,
655	.id_table	= sch5627_device_id,
656};
657
658module_platform_driver(sch5627_driver);
659
660MODULE_DESCRIPTION("SMSC SCH5627 Hardware Monitoring Driver");
661MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
662MODULE_LICENSE("GPL");
v5.9
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/***************************************************************************
  3 *   Copyright (C) 2010-2012 Hans de Goede <hdegoede@redhat.com>           *
  4 *                                                                         *
  5 ***************************************************************************/
  6
  7#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  8
 
 
  9#include <linux/module.h>
 
 
 10#include <linux/init.h>
 
 11#include <linux/slab.h>
 12#include <linux/jiffies.h>
 13#include <linux/platform_device.h>
 14#include <linux/hwmon.h>
 15#include <linux/hwmon-sysfs.h>
 16#include <linux/err.h>
 17#include <linux/mutex.h>
 18#include "sch56xx-common.h"
 19
 20#define DRVNAME "sch5627"
 21#define DEVNAME DRVNAME /* We only support one model */
 22
 23#define SCH5627_HWMON_ID		0xa5
 24#define SCH5627_COMPANY_ID		0x5c
 25#define SCH5627_PRIMARY_ID		0xa0
 26
 27#define SCH5627_REG_BUILD_CODE		0x39
 28#define SCH5627_REG_BUILD_ID		0x3a
 29#define SCH5627_REG_HWMON_ID		0x3c
 30#define SCH5627_REG_HWMON_REV		0x3d
 31#define SCH5627_REG_COMPANY_ID		0x3e
 32#define SCH5627_REG_PRIMARY_ID		0x3f
 33#define SCH5627_REG_CTRL		0x40
 34
 
 
 
 
 35#define SCH5627_NO_TEMPS		8
 36#define SCH5627_NO_FANS			4
 37#define SCH5627_NO_IN			5
 38
 39static const u16 SCH5627_REG_TEMP_MSB[SCH5627_NO_TEMPS] = {
 40	0x2B, 0x26, 0x27, 0x28, 0x29, 0x2A, 0x180, 0x181 };
 41static const u16 SCH5627_REG_TEMP_LSN[SCH5627_NO_TEMPS] = {
 42	0xE2, 0xE1, 0xE1, 0xE5, 0xE5, 0xE6, 0x182, 0x182 };
 43static const u16 SCH5627_REG_TEMP_HIGH_NIBBLE[SCH5627_NO_TEMPS] = {
 44	0, 0, 1, 1, 0, 0, 0, 1 };
 45static const u16 SCH5627_REG_TEMP_HIGH[SCH5627_NO_TEMPS] = {
 46	0x61, 0x57, 0x59, 0x5B, 0x5D, 0x5F, 0x184, 0x186 };
 47static const u16 SCH5627_REG_TEMP_ABS[SCH5627_NO_TEMPS] = {
 48	0x9B, 0x96, 0x97, 0x98, 0x99, 0x9A, 0x1A8, 0x1A9 };
 49
 50static const u16 SCH5627_REG_FAN[SCH5627_NO_FANS] = {
 51	0x2C, 0x2E, 0x30, 0x32 };
 52static const u16 SCH5627_REG_FAN_MIN[SCH5627_NO_FANS] = {
 53	0x62, 0x64, 0x66, 0x68 };
 54
 
 
 
 55static const u16 SCH5627_REG_IN_MSB[SCH5627_NO_IN] = {
 56	0x22, 0x23, 0x24, 0x25, 0x189 };
 57static const u16 SCH5627_REG_IN_LSN[SCH5627_NO_IN] = {
 58	0xE4, 0xE4, 0xE3, 0xE3, 0x18A };
 59static const u16 SCH5627_REG_IN_HIGH_NIBBLE[SCH5627_NO_IN] = {
 60	1, 0, 1, 0, 1 };
 61static const u16 SCH5627_REG_IN_FACTOR[SCH5627_NO_IN] = {
 62	10745, 3660, 9765, 10745, 3660 };
 63static const char * const SCH5627_IN_LABELS[SCH5627_NO_IN] = {
 64	"VCC", "VTT", "VBAT", "VTR", "V_IN" };
 65
 66struct sch5627_data {
 
 67	unsigned short addr;
 68	struct device *hwmon_dev;
 69	struct sch56xx_watchdog_data *watchdog;
 70	u8 control;
 71	u8 temp_max[SCH5627_NO_TEMPS];
 72	u8 temp_crit[SCH5627_NO_TEMPS];
 73	u16 fan_min[SCH5627_NO_FANS];
 74
 75	struct mutex update_lock;
 76	unsigned long last_battery;	/* In jiffies */
 77	char valid;			/* !=0 if following fields are valid */
 78	unsigned long last_updated;	/* In jiffies */
 
 
 
 
 79	u16 temp[SCH5627_NO_TEMPS];
 80	u16 fan[SCH5627_NO_FANS];
 81	u16 in[SCH5627_NO_IN];
 82};
 83
 84static struct sch5627_data *sch5627_update_device(struct device *dev)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 85{
 86	struct sch5627_data *data = dev_get_drvdata(dev);
 87	struct sch5627_data *ret = data;
 88	int i, val;
 89
 90	mutex_lock(&data->update_lock);
 91
 92	/* Trigger a Vbat voltage measurement every 5 minutes */
 93	if (time_after(jiffies, data->last_battery + 300 * HZ)) {
 94		sch56xx_write_virtual_reg(data->addr, SCH5627_REG_CTRL,
 95					  data->control | 0x10);
 96		data->last_battery = jiffies;
 97	}
 98
 99	/* Cache the values for 1 second */
100	if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
101		for (i = 0; i < SCH5627_NO_TEMPS; i++) {
102			val = sch56xx_read_virtual_reg12(data->addr,
103				SCH5627_REG_TEMP_MSB[i],
104				SCH5627_REG_TEMP_LSN[i],
105				SCH5627_REG_TEMP_HIGH_NIBBLE[i]);
106			if (unlikely(val < 0)) {
107				ret = ERR_PTR(val);
108				goto abort;
109			}
110			data->temp[i] = val;
111		}
 
 
 
 
 
 
 
112
 
 
 
 
 
 
 
 
 
113		for (i = 0; i < SCH5627_NO_FANS; i++) {
114			val = sch56xx_read_virtual_reg16(data->addr,
115							 SCH5627_REG_FAN[i]);
116			if (unlikely(val < 0)) {
117				ret = ERR_PTR(val);
118				goto abort;
119			}
120			data->fan[i] = val;
121		}
 
 
 
 
 
 
 
 
 
 
 
 
122
 
 
 
 
 
 
 
 
 
 
 
123		for (i = 0; i < SCH5627_NO_IN; i++) {
124			val = sch56xx_read_virtual_reg12(data->addr,
125				SCH5627_REG_IN_MSB[i],
126				SCH5627_REG_IN_LSN[i],
127				SCH5627_REG_IN_HIGH_NIBBLE[i]);
128			if (unlikely(val < 0)) {
129				ret = ERR_PTR(val);
130				goto abort;
131			}
132			data->in[i] = val;
133		}
134
135		data->last_updated = jiffies;
136		data->valid = 1;
137	}
138abort:
139	mutex_unlock(&data->update_lock);
140	return ret;
141}
142
143static int sch5627_read_limits(struct sch5627_data *data)
144{
145	int i, val;
146
147	for (i = 0; i < SCH5627_NO_TEMPS; i++) {
148		/*
149		 * Note what SMSC calls ABS, is what lm_sensors calls max
150		 * (aka high), and HIGH is what lm_sensors calls crit.
151		 */
152		val = sch56xx_read_virtual_reg(data->addr,
153					       SCH5627_REG_TEMP_ABS[i]);
154		if (val < 0)
155			return val;
156		data->temp_max[i] = val;
157
158		val = sch56xx_read_virtual_reg(data->addr,
159					       SCH5627_REG_TEMP_HIGH[i]);
160		if (val < 0)
161			return val;
162		data->temp_crit[i] = val;
163	}
164	for (i = 0; i < SCH5627_NO_FANS; i++) {
165		val = sch56xx_read_virtual_reg16(data->addr,
166						 SCH5627_REG_FAN_MIN[i]);
167		if (val < 0)
168			return val;
169		data->fan_min[i] = val;
170	}
171
172	return 0;
173}
174
175static int reg_to_temp(u16 reg)
176{
177	return (reg * 625) / 10 - 64000;
178}
179
180static int reg_to_temp_limit(u8 reg)
181{
182	return (reg - 64) * 1000;
183}
184
185static int reg_to_rpm(u16 reg)
186{
187	if (reg == 0)
188		return -EIO;
189	if (reg == 0xffff)
190		return 0;
191
192	return 5400540 / reg;
193}
194
195static ssize_t name_show(struct device *dev, struct device_attribute *devattr,
196	char *buf)
197{
198	return snprintf(buf, PAGE_SIZE, "%s\n", DEVNAME);
 
 
199}
200
201static ssize_t temp_show(struct device *dev, struct device_attribute *devattr,
202			 char *buf)
203{
204	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
205	struct sch5627_data *data = sch5627_update_device(dev);
206	int val;
 
207
208	if (IS_ERR(data))
209		return PTR_ERR(data);
210
211	val = reg_to_temp(data->temp[attr->index]);
212	return snprintf(buf, PAGE_SIZE, "%d\n", val);
213}
214
215static ssize_t temp_fault_show(struct device *dev,
216			       struct device_attribute *devattr, char *buf)
217{
218	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
219	struct sch5627_data *data = sch5627_update_device(dev);
220
221	if (IS_ERR(data))
222		return PTR_ERR(data);
 
 
 
223
224	return snprintf(buf, PAGE_SIZE, "%d\n", data->temp[attr->index] == 0);
225}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
226
227static ssize_t temp_max_show(struct device *dev,
228			     struct device_attribute *devattr, char *buf)
229{
230	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
231	struct sch5627_data *data = dev_get_drvdata(dev);
232	int val;
233
234	val = reg_to_temp_limit(data->temp_max[attr->index]);
235	return snprintf(buf, PAGE_SIZE, "%d\n", val);
236}
237
238static ssize_t temp_crit_show(struct device *dev,
239			      struct device_attribute *devattr, char *buf)
240{
241	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
242	struct sch5627_data *data = dev_get_drvdata(dev);
243	int val;
244
245	val = reg_to_temp_limit(data->temp_crit[attr->index]);
246	return snprintf(buf, PAGE_SIZE, "%d\n", val);
247}
248
249static ssize_t fan_show(struct device *dev, struct device_attribute *devattr,
250			char *buf)
251{
252	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
253	struct sch5627_data *data = sch5627_update_device(dev);
254	int val;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
255
256	if (IS_ERR(data))
257		return PTR_ERR(data);
258
259	val = reg_to_rpm(data->fan[attr->index]);
260	if (val < 0)
261		return val;
262
263	return snprintf(buf, PAGE_SIZE, "%d\n", val);
264}
265
266static ssize_t fan_fault_show(struct device *dev,
267			      struct device_attribute *devattr, char *buf)
268{
269	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
270	struct sch5627_data *data = sch5627_update_device(dev);
 
 
 
 
 
 
 
 
 
 
 
271
272	if (IS_ERR(data))
273		return PTR_ERR(data);
274
275	return snprintf(buf, PAGE_SIZE, "%d\n",
276			data->fan[attr->index] == 0xffff);
277}
278
279static ssize_t fan_min_show(struct device *dev,
280			    struct device_attribute *devattr, char *buf)
281{
282	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
283	struct sch5627_data *data = dev_get_drvdata(dev);
284	int val = reg_to_rpm(data->fan_min[attr->index]);
285	if (val < 0)
286		return val;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
287
288	return snprintf(buf, PAGE_SIZE, "%d\n", val);
289}
290
291static ssize_t in_show(struct device *dev, struct device_attribute *devattr,
292		       char *buf)
293{
294	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
295	struct sch5627_data *data = sch5627_update_device(dev);
296	int val;
297
298	if (IS_ERR(data))
299		return PTR_ERR(data);
300
301	val = DIV_ROUND_CLOSEST(
302		data->in[attr->index] * SCH5627_REG_IN_FACTOR[attr->index],
303		10000);
304	return snprintf(buf, PAGE_SIZE, "%d\n", val);
305}
306
307static ssize_t in_label_show(struct device *dev,
308			     struct device_attribute *devattr, char *buf)
309{
310	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
311
312	return snprintf(buf, PAGE_SIZE, "%s\n",
313			SCH5627_IN_LABELS[attr->index]);
314}
315
316static DEVICE_ATTR_RO(name);
317static SENSOR_DEVICE_ATTR_RO(temp1_input, temp, 0);
318static SENSOR_DEVICE_ATTR_RO(temp2_input, temp, 1);
319static SENSOR_DEVICE_ATTR_RO(temp3_input, temp, 2);
320static SENSOR_DEVICE_ATTR_RO(temp4_input, temp, 3);
321static SENSOR_DEVICE_ATTR_RO(temp5_input, temp, 4);
322static SENSOR_DEVICE_ATTR_RO(temp6_input, temp, 5);
323static SENSOR_DEVICE_ATTR_RO(temp7_input, temp, 6);
324static SENSOR_DEVICE_ATTR_RO(temp8_input, temp, 7);
325static SENSOR_DEVICE_ATTR_RO(temp1_fault, temp_fault, 0);
326static SENSOR_DEVICE_ATTR_RO(temp2_fault, temp_fault, 1);
327static SENSOR_DEVICE_ATTR_RO(temp3_fault, temp_fault, 2);
328static SENSOR_DEVICE_ATTR_RO(temp4_fault, temp_fault, 3);
329static SENSOR_DEVICE_ATTR_RO(temp5_fault, temp_fault, 4);
330static SENSOR_DEVICE_ATTR_RO(temp6_fault, temp_fault, 5);
331static SENSOR_DEVICE_ATTR_RO(temp7_fault, temp_fault, 6);
332static SENSOR_DEVICE_ATTR_RO(temp8_fault, temp_fault, 7);
333static SENSOR_DEVICE_ATTR_RO(temp1_max, temp_max, 0);
334static SENSOR_DEVICE_ATTR_RO(temp2_max, temp_max, 1);
335static SENSOR_DEVICE_ATTR_RO(temp3_max, temp_max, 2);
336static SENSOR_DEVICE_ATTR_RO(temp4_max, temp_max, 3);
337static SENSOR_DEVICE_ATTR_RO(temp5_max, temp_max, 4);
338static SENSOR_DEVICE_ATTR_RO(temp6_max, temp_max, 5);
339static SENSOR_DEVICE_ATTR_RO(temp7_max, temp_max, 6);
340static SENSOR_DEVICE_ATTR_RO(temp8_max, temp_max, 7);
341static SENSOR_DEVICE_ATTR_RO(temp1_crit, temp_crit, 0);
342static SENSOR_DEVICE_ATTR_RO(temp2_crit, temp_crit, 1);
343static SENSOR_DEVICE_ATTR_RO(temp3_crit, temp_crit, 2);
344static SENSOR_DEVICE_ATTR_RO(temp4_crit, temp_crit, 3);
345static SENSOR_DEVICE_ATTR_RO(temp5_crit, temp_crit, 4);
346static SENSOR_DEVICE_ATTR_RO(temp6_crit, temp_crit, 5);
347static SENSOR_DEVICE_ATTR_RO(temp7_crit, temp_crit, 6);
348static SENSOR_DEVICE_ATTR_RO(temp8_crit, temp_crit, 7);
349
350static SENSOR_DEVICE_ATTR_RO(fan1_input, fan, 0);
351static SENSOR_DEVICE_ATTR_RO(fan2_input, fan, 1);
352static SENSOR_DEVICE_ATTR_RO(fan3_input, fan, 2);
353static SENSOR_DEVICE_ATTR_RO(fan4_input, fan, 3);
354static SENSOR_DEVICE_ATTR_RO(fan1_fault, fan_fault, 0);
355static SENSOR_DEVICE_ATTR_RO(fan2_fault, fan_fault, 1);
356static SENSOR_DEVICE_ATTR_RO(fan3_fault, fan_fault, 2);
357static SENSOR_DEVICE_ATTR_RO(fan4_fault, fan_fault, 3);
358static SENSOR_DEVICE_ATTR_RO(fan1_min, fan_min, 0);
359static SENSOR_DEVICE_ATTR_RO(fan2_min, fan_min, 1);
360static SENSOR_DEVICE_ATTR_RO(fan3_min, fan_min, 2);
361static SENSOR_DEVICE_ATTR_RO(fan4_min, fan_min, 3);
362
363static SENSOR_DEVICE_ATTR_RO(in0_input, in, 0);
364static SENSOR_DEVICE_ATTR_RO(in1_input, in, 1);
365static SENSOR_DEVICE_ATTR_RO(in2_input, in, 2);
366static SENSOR_DEVICE_ATTR_RO(in3_input, in, 3);
367static SENSOR_DEVICE_ATTR_RO(in4_input, in, 4);
368static SENSOR_DEVICE_ATTR_RO(in0_label, in_label, 0);
369static SENSOR_DEVICE_ATTR_RO(in1_label, in_label, 1);
370static SENSOR_DEVICE_ATTR_RO(in2_label, in_label, 2);
371static SENSOR_DEVICE_ATTR_RO(in3_label, in_label, 3);
372
373static struct attribute *sch5627_attributes[] = {
374	&dev_attr_name.attr,
375
376	&sensor_dev_attr_temp1_input.dev_attr.attr,
377	&sensor_dev_attr_temp2_input.dev_attr.attr,
378	&sensor_dev_attr_temp3_input.dev_attr.attr,
379	&sensor_dev_attr_temp4_input.dev_attr.attr,
380	&sensor_dev_attr_temp5_input.dev_attr.attr,
381	&sensor_dev_attr_temp6_input.dev_attr.attr,
382	&sensor_dev_attr_temp7_input.dev_attr.attr,
383	&sensor_dev_attr_temp8_input.dev_attr.attr,
384	&sensor_dev_attr_temp1_fault.dev_attr.attr,
385	&sensor_dev_attr_temp2_fault.dev_attr.attr,
386	&sensor_dev_attr_temp3_fault.dev_attr.attr,
387	&sensor_dev_attr_temp4_fault.dev_attr.attr,
388	&sensor_dev_attr_temp5_fault.dev_attr.attr,
389	&sensor_dev_attr_temp6_fault.dev_attr.attr,
390	&sensor_dev_attr_temp7_fault.dev_attr.attr,
391	&sensor_dev_attr_temp8_fault.dev_attr.attr,
392	&sensor_dev_attr_temp1_max.dev_attr.attr,
393	&sensor_dev_attr_temp2_max.dev_attr.attr,
394	&sensor_dev_attr_temp3_max.dev_attr.attr,
395	&sensor_dev_attr_temp4_max.dev_attr.attr,
396	&sensor_dev_attr_temp5_max.dev_attr.attr,
397	&sensor_dev_attr_temp6_max.dev_attr.attr,
398	&sensor_dev_attr_temp7_max.dev_attr.attr,
399	&sensor_dev_attr_temp8_max.dev_attr.attr,
400	&sensor_dev_attr_temp1_crit.dev_attr.attr,
401	&sensor_dev_attr_temp2_crit.dev_attr.attr,
402	&sensor_dev_attr_temp3_crit.dev_attr.attr,
403	&sensor_dev_attr_temp4_crit.dev_attr.attr,
404	&sensor_dev_attr_temp5_crit.dev_attr.attr,
405	&sensor_dev_attr_temp6_crit.dev_attr.attr,
406	&sensor_dev_attr_temp7_crit.dev_attr.attr,
407	&sensor_dev_attr_temp8_crit.dev_attr.attr,
408
409	&sensor_dev_attr_fan1_input.dev_attr.attr,
410	&sensor_dev_attr_fan2_input.dev_attr.attr,
411	&sensor_dev_attr_fan3_input.dev_attr.attr,
412	&sensor_dev_attr_fan4_input.dev_attr.attr,
413	&sensor_dev_attr_fan1_fault.dev_attr.attr,
414	&sensor_dev_attr_fan2_fault.dev_attr.attr,
415	&sensor_dev_attr_fan3_fault.dev_attr.attr,
416	&sensor_dev_attr_fan4_fault.dev_attr.attr,
417	&sensor_dev_attr_fan1_min.dev_attr.attr,
418	&sensor_dev_attr_fan2_min.dev_attr.attr,
419	&sensor_dev_attr_fan3_min.dev_attr.attr,
420	&sensor_dev_attr_fan4_min.dev_attr.attr,
421
422	&sensor_dev_attr_in0_input.dev_attr.attr,
423	&sensor_dev_attr_in1_input.dev_attr.attr,
424	&sensor_dev_attr_in2_input.dev_attr.attr,
425	&sensor_dev_attr_in3_input.dev_attr.attr,
426	&sensor_dev_attr_in4_input.dev_attr.attr,
427	&sensor_dev_attr_in0_label.dev_attr.attr,
428	&sensor_dev_attr_in1_label.dev_attr.attr,
429	&sensor_dev_attr_in2_label.dev_attr.attr,
430	&sensor_dev_attr_in3_label.dev_attr.attr,
431	/* No in4_label as in4 is a generic input pin */
432
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
433	NULL
434};
435
436static const struct attribute_group sch5627_group = {
437	.attrs = sch5627_attributes,
 
438};
439
440static int sch5627_remove(struct platform_device *pdev)
441{
442	struct sch5627_data *data = platform_get_drvdata(pdev);
443
444	if (data->watchdog)
445		sch56xx_watchdog_unregister(data->watchdog);
446
447	if (data->hwmon_dev)
448		hwmon_device_unregister(data->hwmon_dev);
449
450	sysfs_remove_group(&pdev->dev.kobj, &sch5627_group);
451
452	return 0;
453}
454
455static int sch5627_probe(struct platform_device *pdev)
456{
457	struct sch5627_data *data;
458	int err, build_code, build_id, hwmon_rev, val;
 
459
460	data = devm_kzalloc(&pdev->dev, sizeof(struct sch5627_data),
461			    GFP_KERNEL);
462	if (!data)
463		return -ENOMEM;
464
465	data->addr = platform_get_resource(pdev, IORESOURCE_IO, 0)->start;
466	mutex_init(&data->update_lock);
467	platform_set_drvdata(pdev, data);
468
469	val = sch56xx_read_virtual_reg(data->addr, SCH5627_REG_HWMON_ID);
470	if (val < 0) {
471		err = val;
472		goto error;
473	}
474	if (val != SCH5627_HWMON_ID) {
475		pr_err("invalid %s id: 0x%02X (expected 0x%02X)\n", "hwmon",
476		       val, SCH5627_HWMON_ID);
477		err = -ENODEV;
478		goto error;
479	}
480
481	val = sch56xx_read_virtual_reg(data->addr, SCH5627_REG_COMPANY_ID);
482	if (val < 0) {
483		err = val;
484		goto error;
485	}
486	if (val != SCH5627_COMPANY_ID) {
487		pr_err("invalid %s id: 0x%02X (expected 0x%02X)\n", "company",
488		       val, SCH5627_COMPANY_ID);
489		err = -ENODEV;
490		goto error;
491	}
492
493	val = sch56xx_read_virtual_reg(data->addr, SCH5627_REG_PRIMARY_ID);
494	if (val < 0) {
495		err = val;
496		goto error;
497	}
498	if (val != SCH5627_PRIMARY_ID) {
499		pr_err("invalid %s id: 0x%02X (expected 0x%02X)\n", "primary",
500		       val, SCH5627_PRIMARY_ID);
501		err = -ENODEV;
502		goto error;
503	}
504
505	build_code = sch56xx_read_virtual_reg(data->addr,
506					      SCH5627_REG_BUILD_CODE);
507	if (build_code < 0) {
508		err = build_code;
509		goto error;
510	}
511
512	build_id = sch56xx_read_virtual_reg16(data->addr,
513					      SCH5627_REG_BUILD_ID);
514	if (build_id < 0) {
515		err = build_id;
516		goto error;
517	}
518
519	hwmon_rev = sch56xx_read_virtual_reg(data->addr,
520					     SCH5627_REG_HWMON_REV);
521	if (hwmon_rev < 0) {
522		err = hwmon_rev;
523		goto error;
524	}
525
526	val = sch56xx_read_virtual_reg(data->addr, SCH5627_REG_CTRL);
527	if (val < 0) {
528		err = val;
529		goto error;
530	}
531	data->control = val;
532	if (!(data->control & 0x01)) {
533		pr_err("hardware monitoring not enabled\n");
534		err = -ENODEV;
535		goto error;
536	}
 
 
 
 
 
 
537	/* Trigger a Vbat voltage measurement, so that we get a valid reading
538	   the first time we read Vbat */
539	sch56xx_write_virtual_reg(data->addr, SCH5627_REG_CTRL,
540				  data->control | 0x10);
541	data->last_battery = jiffies;
542
543	/*
544	 * Read limits, we do this only once as reading a register on
545	 * the sch5627 is quite expensive (and they don't change).
546	 */
547	err = sch5627_read_limits(data);
548	if (err)
549		goto error;
550
551	pr_info("found %s chip at %#hx\n", DEVNAME, data->addr);
552	pr_info("firmware build: code 0x%02X, id 0x%04X, hwmon: rev 0x%02X\n",
553		build_code, build_id, hwmon_rev);
554
555	/* Register sysfs interface files */
556	err = sysfs_create_group(&pdev->dev.kobj, &sch5627_group);
557	if (err)
558		goto error;
559
560	data->hwmon_dev = hwmon_device_register(&pdev->dev);
561	if (IS_ERR(data->hwmon_dev)) {
562		err = PTR_ERR(data->hwmon_dev);
563		data->hwmon_dev = NULL;
564		goto error;
565	}
566
567	/* Note failing to register the watchdog is not a fatal error */
568	data->watchdog = sch56xx_watchdog_register(&pdev->dev, data->addr,
569			(build_code << 24) | (build_id << 8) | hwmon_rev,
570			&data->update_lock, 1);
571
572	return 0;
 
 
 
 
 
573
574error:
575	sch5627_remove(pdev);
576	return err;
 
577}
578
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
579static struct platform_driver sch5627_driver = {
580	.driver = {
581		.name	= DRVNAME,
 
582	},
583	.probe		= sch5627_probe,
584	.remove		= sch5627_remove,
585};
586
587module_platform_driver(sch5627_driver);
588
589MODULE_DESCRIPTION("SMSC SCH5627 Hardware Monitoring Driver");
590MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
591MODULE_LICENSE("GPL");