Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Driver for Linear Technology LTC2990 power monitor
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright (C) 2014 Topic Embedded Products
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * Author: Mike Looijmans <mike.looijmans@topic.nl>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/bitops.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/err.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/hwmon.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/hwmon-sysfs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/property.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #define LTC2990_STATUS	0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #define LTC2990_CONTROL	0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #define LTC2990_TRIGGER	0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #define LTC2990_TINT_MSB	0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #define LTC2990_V1_MSB	0x06
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #define LTC2990_V2_MSB	0x08
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #define LTC2990_V3_MSB	0x0A
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #define LTC2990_V4_MSB	0x0C
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #define LTC2990_VCC_MSB	0x0E
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #define LTC2990_IN0	BIT(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #define LTC2990_IN1	BIT(1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #define LTC2990_IN2	BIT(2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #define LTC2990_IN3	BIT(3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #define LTC2990_IN4	BIT(4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #define LTC2990_CURR1	BIT(5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #define LTC2990_CURR2	BIT(6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define LTC2990_TEMP1	BIT(7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) #define LTC2990_TEMP2	BIT(8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) #define LTC2990_TEMP3	BIT(9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) #define LTC2990_NONE	0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) #define LTC2990_ALL	GENMASK(9, 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) #define LTC2990_MODE0_SHIFT	0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) #define LTC2990_MODE0_MASK	GENMASK(2, 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) #define LTC2990_MODE1_SHIFT	3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) #define LTC2990_MODE1_MASK	GENMASK(1, 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) /* Enabled measurements for mode bits 2..0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) static const int ltc2990_attrs_ena_0[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	LTC2990_IN1 | LTC2990_IN2 | LTC2990_TEMP3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	LTC2990_CURR1 | LTC2990_TEMP3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	LTC2990_CURR1 | LTC2990_IN3 | LTC2990_IN4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	LTC2990_TEMP2 | LTC2990_IN3 | LTC2990_IN4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	LTC2990_TEMP2 | LTC2990_CURR2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	LTC2990_TEMP2 | LTC2990_TEMP3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	LTC2990_CURR1 | LTC2990_CURR2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	LTC2990_IN1 | LTC2990_IN2 | LTC2990_IN3 | LTC2990_IN4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) /* Enabled measurements for mode bits 4..3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) static const int ltc2990_attrs_ena_1[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	LTC2990_NONE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	LTC2990_TEMP2 | LTC2990_IN1 | LTC2990_CURR1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	LTC2990_TEMP3 | LTC2990_IN3 | LTC2990_CURR2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	LTC2990_ALL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) struct ltc2990_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	struct i2c_client *i2c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	u32 mode[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) /* Return the converted value from the given register in uV or mC */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) static int ltc2990_get_value(struct i2c_client *i2c, int index, int *result)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	int val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	u8 reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	switch (index) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	case LTC2990_IN0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 		reg = LTC2990_VCC_MSB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	case LTC2990_IN1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	case LTC2990_CURR1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	case LTC2990_TEMP2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 		reg = LTC2990_V1_MSB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	case LTC2990_IN2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 		reg = LTC2990_V2_MSB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	case LTC2990_IN3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	case LTC2990_CURR2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	case LTC2990_TEMP3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 		reg = LTC2990_V3_MSB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	case LTC2990_IN4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 		reg = LTC2990_V4_MSB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	case LTC2990_TEMP1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 		reg = LTC2990_TINT_MSB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	val = i2c_smbus_read_word_swapped(i2c, reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	if (unlikely(val < 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 		return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	switch (index) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	case LTC2990_TEMP1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	case LTC2990_TEMP2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	case LTC2990_TEMP3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 		/* temp, 0.0625 degrees/LSB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		*result = sign_extend32(val, 12) * 1000 / 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	case LTC2990_CURR1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	case LTC2990_CURR2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 		 /* Vx-Vy, 19.42uV/LSB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		*result = sign_extend32(val, 14) * 1942 / 100;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	case LTC2990_IN0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 		/* Vcc, 305.18uV/LSB, 2.5V offset */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		*result = sign_extend32(val, 14) * 30518 / (100 * 1000) + 2500;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	case LTC2990_IN1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	case LTC2990_IN2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	case LTC2990_IN3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	case LTC2990_IN4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		/* Vx, 305.18uV/LSB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 		*result = sign_extend32(val, 14) * 30518 / (100 * 1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 		return -EINVAL; /* won't happen, keep compiler happy */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) static ssize_t ltc2990_value_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 				  struct device_attribute *da, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	struct ltc2990_data *data = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	int value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	ret = ltc2990_get_value(data->i2c, attr->index, &value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	if (unlikely(ret < 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	return snprintf(buf, PAGE_SIZE, "%d\n", value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) static umode_t ltc2990_attrs_visible(struct kobject *kobj,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 				     struct attribute *a, int n)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	struct device *dev = container_of(kobj, struct device, kobj);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	struct ltc2990_data *data = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	struct device_attribute *da =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 			container_of(a, struct device_attribute, attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	int attrs_mask = LTC2990_IN0 | LTC2990_TEMP1 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 			 (ltc2990_attrs_ena_0[data->mode[0]] &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 			  ltc2990_attrs_ena_1[data->mode[1]]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	if (attr->index & attrs_mask)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 		return a->mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) static SENSOR_DEVICE_ATTR_RO(temp1_input, ltc2990_value, LTC2990_TEMP1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) static SENSOR_DEVICE_ATTR_RO(temp2_input, ltc2990_value, LTC2990_TEMP2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) static SENSOR_DEVICE_ATTR_RO(temp3_input, ltc2990_value, LTC2990_TEMP3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) static SENSOR_DEVICE_ATTR_RO(curr1_input, ltc2990_value, LTC2990_CURR1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) static SENSOR_DEVICE_ATTR_RO(curr2_input, ltc2990_value, LTC2990_CURR2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) static SENSOR_DEVICE_ATTR_RO(in0_input, ltc2990_value, LTC2990_IN0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) static SENSOR_DEVICE_ATTR_RO(in1_input, ltc2990_value, LTC2990_IN1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) static SENSOR_DEVICE_ATTR_RO(in2_input, ltc2990_value, LTC2990_IN2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) static SENSOR_DEVICE_ATTR_RO(in3_input, ltc2990_value, LTC2990_IN3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) static SENSOR_DEVICE_ATTR_RO(in4_input, ltc2990_value, LTC2990_IN4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) static struct attribute *ltc2990_attrs[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	&sensor_dev_attr_temp1_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 	&sensor_dev_attr_temp2_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	&sensor_dev_attr_temp3_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	&sensor_dev_attr_curr1_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	&sensor_dev_attr_curr2_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 	&sensor_dev_attr_in0_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	&sensor_dev_attr_in1_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	&sensor_dev_attr_in2_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 	&sensor_dev_attr_in3_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	&sensor_dev_attr_in4_input.dev_attr.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) static const struct attribute_group ltc2990_group = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 	.attrs = ltc2990_attrs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	.is_visible = ltc2990_attrs_visible,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) __ATTRIBUTE_GROUPS(ltc2990);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) static int ltc2990_i2c_probe(struct i2c_client *i2c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	struct device *hwmon_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	struct ltc2990_data *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	if (!i2c_check_functionality(i2c->adapter, I2C_FUNC_SMBUS_BYTE_DATA |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 				     I2C_FUNC_SMBUS_WORD_DATA))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	data = devm_kzalloc(&i2c->dev, sizeof(struct ltc2990_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	if (unlikely(!data))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	data->i2c = i2c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	if (dev_fwnode(&i2c->dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 		ret = device_property_read_u32_array(&i2c->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 						     "lltc,meas-mode",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 						     data->mode, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 			return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 		if (data->mode[0] & ~LTC2990_MODE0_MASK ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 		    data->mode[1] & ~LTC2990_MODE1_MASK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 			return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 		ret = i2c_smbus_read_byte_data(i2c, LTC2990_CONTROL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 		if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 			return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 		data->mode[0] = ret >> LTC2990_MODE0_SHIFT & LTC2990_MODE0_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 		data->mode[1] = ret >> LTC2990_MODE1_SHIFT & LTC2990_MODE1_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	/* Setup continuous mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 	ret = i2c_smbus_write_byte_data(i2c, LTC2990_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 					data->mode[0] << LTC2990_MODE0_SHIFT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 					data->mode[1] << LTC2990_MODE1_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 		dev_err(&i2c->dev, "Error: Failed to set control mode.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	/* Trigger once to start continuous conversion */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	ret = i2c_smbus_write_byte_data(i2c, LTC2990_TRIGGER, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 		dev_err(&i2c->dev, "Error: Failed to start acquisition.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	hwmon_dev = devm_hwmon_device_register_with_groups(&i2c->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 							   i2c->name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 							   data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 							   ltc2990_groups);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	return PTR_ERR_OR_ZERO(hwmon_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) static const struct i2c_device_id ltc2990_i2c_id[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	{ "ltc2990", 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	{}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) MODULE_DEVICE_TABLE(i2c, ltc2990_i2c_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) static struct i2c_driver ltc2990_i2c_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		.name = "ltc2990",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	.probe_new = ltc2990_i2c_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	.id_table = ltc2990_i2c_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) module_i2c_driver(ltc2990_i2c_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) MODULE_DESCRIPTION("LTC2990 Sensor Driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) MODULE_AUTHOR("Topic Embedded Products");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) MODULE_LICENSE("GPL v2");