xref: /OK3568_Linux_fs/kernel/drivers/iio/chemical/vz89x.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * vz89x.c - Support for SGX Sensortech MiCS VZ89X VOC sensors
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2015-2018
6*4882a593Smuzhiyun  * Author: Matt Ranostay <matt.ranostay@konsulko.com>
7*4882a593Smuzhiyun  */
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun #include <linux/module.h>
10*4882a593Smuzhiyun #include <linux/mutex.h>
11*4882a593Smuzhiyun #include <linux/init.h>
12*4882a593Smuzhiyun #include <linux/i2c.h>
13*4882a593Smuzhiyun #include <linux/mod_devicetable.h>
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun #include <linux/iio/iio.h>
16*4882a593Smuzhiyun #include <linux/iio/sysfs.h>
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #define VZ89X_REG_MEASUREMENT		0x09
19*4882a593Smuzhiyun #define VZ89X_REG_MEASUREMENT_RD_SIZE	6
20*4882a593Smuzhiyun #define VZ89X_REG_MEASUREMENT_WR_SIZE	3
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #define VZ89X_VOC_CO2_IDX		0
23*4882a593Smuzhiyun #define VZ89X_VOC_SHORT_IDX		1
24*4882a593Smuzhiyun #define VZ89X_VOC_TVOC_IDX		2
25*4882a593Smuzhiyun #define VZ89X_VOC_RESISTANCE_IDX	3
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun #define VZ89TE_REG_MEASUREMENT		0x0c
28*4882a593Smuzhiyun #define VZ89TE_REG_MEASUREMENT_RD_SIZE	7
29*4882a593Smuzhiyun #define VZ89TE_REG_MEASUREMENT_WR_SIZE	6
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun #define VZ89TE_VOC_TVOC_IDX		0
32*4882a593Smuzhiyun #define VZ89TE_VOC_CO2_IDX		1
33*4882a593Smuzhiyun #define VZ89TE_VOC_RESISTANCE_IDX	2
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun enum {
36*4882a593Smuzhiyun 	VZ89X,
37*4882a593Smuzhiyun 	VZ89TE,
38*4882a593Smuzhiyun };
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun struct vz89x_chip_data;
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun struct vz89x_data {
43*4882a593Smuzhiyun 	struct i2c_client *client;
44*4882a593Smuzhiyun 	const struct vz89x_chip_data *chip;
45*4882a593Smuzhiyun 	struct mutex lock;
46*4882a593Smuzhiyun 	int (*xfer)(struct vz89x_data *data, u8 cmd);
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun 	bool is_valid;
49*4882a593Smuzhiyun 	unsigned long last_update;
50*4882a593Smuzhiyun 	u8 buffer[VZ89TE_REG_MEASUREMENT_RD_SIZE];
51*4882a593Smuzhiyun };
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun struct vz89x_chip_data {
54*4882a593Smuzhiyun 	bool (*valid)(struct vz89x_data *data);
55*4882a593Smuzhiyun 	const struct iio_chan_spec *channels;
56*4882a593Smuzhiyun 	u8 num_channels;
57*4882a593Smuzhiyun 
58*4882a593Smuzhiyun 	u8 cmd;
59*4882a593Smuzhiyun 	u8 read_size;
60*4882a593Smuzhiyun 	u8 write_size;
61*4882a593Smuzhiyun };
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun static const struct iio_chan_spec vz89x_channels[] = {
64*4882a593Smuzhiyun 	{
65*4882a593Smuzhiyun 		.type = IIO_CONCENTRATION,
66*4882a593Smuzhiyun 		.channel2 = IIO_MOD_CO2,
67*4882a593Smuzhiyun 		.modified = 1,
68*4882a593Smuzhiyun 		.info_mask_separate =
69*4882a593Smuzhiyun 			BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW),
70*4882a593Smuzhiyun 		.address = VZ89X_VOC_CO2_IDX,
71*4882a593Smuzhiyun 	},
72*4882a593Smuzhiyun 	{
73*4882a593Smuzhiyun 		.type = IIO_CONCENTRATION,
74*4882a593Smuzhiyun 		.channel2 = IIO_MOD_VOC,
75*4882a593Smuzhiyun 		.modified = 1,
76*4882a593Smuzhiyun 		.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
77*4882a593Smuzhiyun 		.address = VZ89X_VOC_SHORT_IDX,
78*4882a593Smuzhiyun 		.extend_name = "short",
79*4882a593Smuzhiyun 	},
80*4882a593Smuzhiyun 	{
81*4882a593Smuzhiyun 		.type = IIO_CONCENTRATION,
82*4882a593Smuzhiyun 		.channel2 = IIO_MOD_VOC,
83*4882a593Smuzhiyun 		.modified = 1,
84*4882a593Smuzhiyun 		.info_mask_separate =
85*4882a593Smuzhiyun 			BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW),
86*4882a593Smuzhiyun 		.address = VZ89X_VOC_TVOC_IDX,
87*4882a593Smuzhiyun 	},
88*4882a593Smuzhiyun 	{
89*4882a593Smuzhiyun 		.type = IIO_RESISTANCE,
90*4882a593Smuzhiyun 		.info_mask_separate =
91*4882a593Smuzhiyun 			BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
92*4882a593Smuzhiyun 		.address = VZ89X_VOC_RESISTANCE_IDX,
93*4882a593Smuzhiyun 		.scan_index = -1,
94*4882a593Smuzhiyun 		.scan_type = {
95*4882a593Smuzhiyun 			.endianness = IIO_LE,
96*4882a593Smuzhiyun 		},
97*4882a593Smuzhiyun 	},
98*4882a593Smuzhiyun };
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun static const struct iio_chan_spec vz89te_channels[] = {
101*4882a593Smuzhiyun 	{
102*4882a593Smuzhiyun 		.type = IIO_CONCENTRATION,
103*4882a593Smuzhiyun 		.channel2 = IIO_MOD_VOC,
104*4882a593Smuzhiyun 		.modified = 1,
105*4882a593Smuzhiyun 		.info_mask_separate =
106*4882a593Smuzhiyun 			BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW),
107*4882a593Smuzhiyun 		.address = VZ89TE_VOC_TVOC_IDX,
108*4882a593Smuzhiyun 	},
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun 	{
111*4882a593Smuzhiyun 		.type = IIO_CONCENTRATION,
112*4882a593Smuzhiyun 		.channel2 = IIO_MOD_CO2,
113*4882a593Smuzhiyun 		.modified = 1,
114*4882a593Smuzhiyun 		.info_mask_separate =
115*4882a593Smuzhiyun 			BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW),
116*4882a593Smuzhiyun 		.address = VZ89TE_VOC_CO2_IDX,
117*4882a593Smuzhiyun 	},
118*4882a593Smuzhiyun 	{
119*4882a593Smuzhiyun 		.type = IIO_RESISTANCE,
120*4882a593Smuzhiyun 		.info_mask_separate =
121*4882a593Smuzhiyun 			BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
122*4882a593Smuzhiyun 		.address = VZ89TE_VOC_RESISTANCE_IDX,
123*4882a593Smuzhiyun 		.scan_index = -1,
124*4882a593Smuzhiyun 		.scan_type = {
125*4882a593Smuzhiyun 			.endianness = IIO_BE,
126*4882a593Smuzhiyun 		},
127*4882a593Smuzhiyun 	},
128*4882a593Smuzhiyun };
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun static IIO_CONST_ATTR(in_concentration_co2_scale, "0.00000698689");
131*4882a593Smuzhiyun static IIO_CONST_ATTR(in_concentration_voc_scale, "0.00000000436681223");
132*4882a593Smuzhiyun 
133*4882a593Smuzhiyun static struct attribute *vz89x_attributes[] = {
134*4882a593Smuzhiyun 	&iio_const_attr_in_concentration_co2_scale.dev_attr.attr,
135*4882a593Smuzhiyun 	&iio_const_attr_in_concentration_voc_scale.dev_attr.attr,
136*4882a593Smuzhiyun 	NULL,
137*4882a593Smuzhiyun };
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun static const struct attribute_group vz89x_attrs_group = {
140*4882a593Smuzhiyun 	.attrs = vz89x_attributes,
141*4882a593Smuzhiyun };
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun /*
144*4882a593Smuzhiyun  * Chipset sometime updates in the middle of a reading causing it to reset the
145*4882a593Smuzhiyun  * data pointer, and causing invalid reading of previous data.
146*4882a593Smuzhiyun  * We can check for this by reading MSB of the resistance reading that is
147*4882a593Smuzhiyun  * always zero, and by also confirming the VOC_short isn't zero.
148*4882a593Smuzhiyun  */
149*4882a593Smuzhiyun 
vz89x_measurement_is_valid(struct vz89x_data * data)150*4882a593Smuzhiyun static bool vz89x_measurement_is_valid(struct vz89x_data *data)
151*4882a593Smuzhiyun {
152*4882a593Smuzhiyun 	if (data->buffer[VZ89X_VOC_SHORT_IDX] == 0)
153*4882a593Smuzhiyun 		return true;
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 	return !!(data->buffer[data->chip->read_size - 1] > 0);
156*4882a593Smuzhiyun }
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun /* VZ89TE device has a modified CRC-8 two complement check */
vz89te_measurement_is_valid(struct vz89x_data * data)159*4882a593Smuzhiyun static bool vz89te_measurement_is_valid(struct vz89x_data *data)
160*4882a593Smuzhiyun {
161*4882a593Smuzhiyun 	u8 crc = 0;
162*4882a593Smuzhiyun 	int i, sum = 0;
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 	for (i = 0; i < (data->chip->read_size - 1); i++) {
165*4882a593Smuzhiyun 		sum = crc + data->buffer[i];
166*4882a593Smuzhiyun 		crc = sum;
167*4882a593Smuzhiyun 		crc += sum / 256;
168*4882a593Smuzhiyun 	}
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun 	return !((0xff - crc) == data->buffer[data->chip->read_size - 1]);
171*4882a593Smuzhiyun }
172*4882a593Smuzhiyun 
vz89x_i2c_xfer(struct vz89x_data * data,u8 cmd)173*4882a593Smuzhiyun static int vz89x_i2c_xfer(struct vz89x_data *data, u8 cmd)
174*4882a593Smuzhiyun {
175*4882a593Smuzhiyun 	const struct vz89x_chip_data *chip = data->chip;
176*4882a593Smuzhiyun 	struct i2c_client *client = data->client;
177*4882a593Smuzhiyun 	struct i2c_msg msg[2];
178*4882a593Smuzhiyun 	int ret;
179*4882a593Smuzhiyun 	u8 buf[6] = { cmd, 0, 0, 0, 0, 0xf3 };
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	msg[0].addr = client->addr;
182*4882a593Smuzhiyun 	msg[0].flags = client->flags;
183*4882a593Smuzhiyun 	msg[0].len = chip->write_size;
184*4882a593Smuzhiyun 	msg[0].buf  = (char *) &buf;
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun 	msg[1].addr = client->addr;
187*4882a593Smuzhiyun 	msg[1].flags = client->flags | I2C_M_RD;
188*4882a593Smuzhiyun 	msg[1].len = chip->read_size;
189*4882a593Smuzhiyun 	msg[1].buf = (char *) &data->buffer;
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun 	ret = i2c_transfer(client->adapter, msg, 2);
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 	return (ret == 2) ? 0 : ret;
194*4882a593Smuzhiyun }
195*4882a593Smuzhiyun 
vz89x_smbus_xfer(struct vz89x_data * data,u8 cmd)196*4882a593Smuzhiyun static int vz89x_smbus_xfer(struct vz89x_data *data, u8 cmd)
197*4882a593Smuzhiyun {
198*4882a593Smuzhiyun 	struct i2c_client *client = data->client;
199*4882a593Smuzhiyun 	int ret;
200*4882a593Smuzhiyun 	int i;
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	ret = i2c_smbus_write_word_data(client, cmd, 0);
203*4882a593Smuzhiyun 	if (ret < 0)
204*4882a593Smuzhiyun 		return ret;
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun 	for (i = 0; i < data->chip->read_size; i++) {
207*4882a593Smuzhiyun 		ret = i2c_smbus_read_byte(client);
208*4882a593Smuzhiyun 		if (ret < 0)
209*4882a593Smuzhiyun 			return ret;
210*4882a593Smuzhiyun 		data->buffer[i] = ret;
211*4882a593Smuzhiyun 	}
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun 	return 0;
214*4882a593Smuzhiyun }
215*4882a593Smuzhiyun 
vz89x_get_measurement(struct vz89x_data * data)216*4882a593Smuzhiyun static int vz89x_get_measurement(struct vz89x_data *data)
217*4882a593Smuzhiyun {
218*4882a593Smuzhiyun 	const struct vz89x_chip_data *chip = data->chip;
219*4882a593Smuzhiyun 	int ret;
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	/* sensor can only be polled once a second max per datasheet */
222*4882a593Smuzhiyun 	if (!time_after(jiffies, data->last_update + HZ))
223*4882a593Smuzhiyun 		return data->is_valid ? 0 : -EAGAIN;
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	data->is_valid = false;
226*4882a593Smuzhiyun 	data->last_update = jiffies;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	ret = data->xfer(data, chip->cmd);
229*4882a593Smuzhiyun 	if (ret < 0)
230*4882a593Smuzhiyun 		return ret;
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	ret = chip->valid(data);
233*4882a593Smuzhiyun 	if (ret)
234*4882a593Smuzhiyun 		return -EAGAIN;
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	data->is_valid = true;
237*4882a593Smuzhiyun 
238*4882a593Smuzhiyun 	return 0;
239*4882a593Smuzhiyun }
240*4882a593Smuzhiyun 
vz89x_get_resistance_reading(struct vz89x_data * data,struct iio_chan_spec const * chan,int * val)241*4882a593Smuzhiyun static int vz89x_get_resistance_reading(struct vz89x_data *data,
242*4882a593Smuzhiyun 					struct iio_chan_spec const *chan,
243*4882a593Smuzhiyun 					int *val)
244*4882a593Smuzhiyun {
245*4882a593Smuzhiyun 	u8 *tmp = (u8 *) &data->buffer[chan->address];
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	switch (chan->scan_type.endianness) {
248*4882a593Smuzhiyun 	case IIO_LE:
249*4882a593Smuzhiyun 		*val = le32_to_cpup((__le32 *) tmp) & GENMASK(23, 0);
250*4882a593Smuzhiyun 		break;
251*4882a593Smuzhiyun 	case IIO_BE:
252*4882a593Smuzhiyun 		*val = be32_to_cpup((__be32 *) tmp) >> 8;
253*4882a593Smuzhiyun 		break;
254*4882a593Smuzhiyun 	default:
255*4882a593Smuzhiyun 		return -EINVAL;
256*4882a593Smuzhiyun 	}
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 	return 0;
259*4882a593Smuzhiyun }
260*4882a593Smuzhiyun 
vz89x_read_raw(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,int * val,int * val2,long mask)261*4882a593Smuzhiyun static int vz89x_read_raw(struct iio_dev *indio_dev,
262*4882a593Smuzhiyun 			  struct iio_chan_spec const *chan, int *val,
263*4882a593Smuzhiyun 			  int *val2, long mask)
264*4882a593Smuzhiyun {
265*4882a593Smuzhiyun 	struct vz89x_data *data = iio_priv(indio_dev);
266*4882a593Smuzhiyun 	int ret = -EINVAL;
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 	switch (mask) {
269*4882a593Smuzhiyun 	case IIO_CHAN_INFO_RAW:
270*4882a593Smuzhiyun 		mutex_lock(&data->lock);
271*4882a593Smuzhiyun 		ret = vz89x_get_measurement(data);
272*4882a593Smuzhiyun 		mutex_unlock(&data->lock);
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun 		if (ret)
275*4882a593Smuzhiyun 			return ret;
276*4882a593Smuzhiyun 
277*4882a593Smuzhiyun 		switch (chan->type) {
278*4882a593Smuzhiyun 		case IIO_CONCENTRATION:
279*4882a593Smuzhiyun 			*val = data->buffer[chan->address];
280*4882a593Smuzhiyun 			return IIO_VAL_INT;
281*4882a593Smuzhiyun 		case IIO_RESISTANCE:
282*4882a593Smuzhiyun 			ret = vz89x_get_resistance_reading(data, chan, val);
283*4882a593Smuzhiyun 			if (!ret)
284*4882a593Smuzhiyun 				return IIO_VAL_INT;
285*4882a593Smuzhiyun 			break;
286*4882a593Smuzhiyun 		default:
287*4882a593Smuzhiyun 			return -EINVAL;
288*4882a593Smuzhiyun 		}
289*4882a593Smuzhiyun 		break;
290*4882a593Smuzhiyun 	case IIO_CHAN_INFO_SCALE:
291*4882a593Smuzhiyun 		switch (chan->type) {
292*4882a593Smuzhiyun 		case IIO_RESISTANCE:
293*4882a593Smuzhiyun 			*val = 10;
294*4882a593Smuzhiyun 			return IIO_VAL_INT;
295*4882a593Smuzhiyun 		default:
296*4882a593Smuzhiyun 			return -EINVAL;
297*4882a593Smuzhiyun 		}
298*4882a593Smuzhiyun 		break;
299*4882a593Smuzhiyun 	case IIO_CHAN_INFO_OFFSET:
300*4882a593Smuzhiyun 		switch (chan->channel2) {
301*4882a593Smuzhiyun 		case IIO_MOD_CO2:
302*4882a593Smuzhiyun 			*val = 44;
303*4882a593Smuzhiyun 			*val2 = 250000;
304*4882a593Smuzhiyun 			return IIO_VAL_INT_PLUS_MICRO;
305*4882a593Smuzhiyun 		case IIO_MOD_VOC:
306*4882a593Smuzhiyun 			*val = -13;
307*4882a593Smuzhiyun 			return IIO_VAL_INT;
308*4882a593Smuzhiyun 		default:
309*4882a593Smuzhiyun 			return -EINVAL;
310*4882a593Smuzhiyun 		}
311*4882a593Smuzhiyun 	}
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	return ret;
314*4882a593Smuzhiyun }
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun static const struct iio_info vz89x_info = {
317*4882a593Smuzhiyun 	.attrs		= &vz89x_attrs_group,
318*4882a593Smuzhiyun 	.read_raw	= vz89x_read_raw,
319*4882a593Smuzhiyun };
320*4882a593Smuzhiyun 
321*4882a593Smuzhiyun static const struct vz89x_chip_data vz89x_chips[] = {
322*4882a593Smuzhiyun 	{
323*4882a593Smuzhiyun 		.valid = vz89x_measurement_is_valid,
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 		.cmd = VZ89X_REG_MEASUREMENT,
326*4882a593Smuzhiyun 		.read_size = VZ89X_REG_MEASUREMENT_RD_SIZE,
327*4882a593Smuzhiyun 		.write_size = VZ89X_REG_MEASUREMENT_WR_SIZE,
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun 		.channels = vz89x_channels,
330*4882a593Smuzhiyun 		.num_channels = ARRAY_SIZE(vz89x_channels),
331*4882a593Smuzhiyun 	},
332*4882a593Smuzhiyun 	{
333*4882a593Smuzhiyun 		.valid = vz89te_measurement_is_valid,
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun 		.cmd = VZ89TE_REG_MEASUREMENT,
336*4882a593Smuzhiyun 		.read_size = VZ89TE_REG_MEASUREMENT_RD_SIZE,
337*4882a593Smuzhiyun 		.write_size = VZ89TE_REG_MEASUREMENT_WR_SIZE,
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 		.channels = vz89te_channels,
340*4882a593Smuzhiyun 		.num_channels = ARRAY_SIZE(vz89te_channels),
341*4882a593Smuzhiyun 	},
342*4882a593Smuzhiyun };
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun static const struct of_device_id vz89x_dt_ids[] = {
345*4882a593Smuzhiyun 	{ .compatible = "sgx,vz89x", .data = (void *) VZ89X },
346*4882a593Smuzhiyun 	{ .compatible = "sgx,vz89te", .data = (void *) VZ89TE },
347*4882a593Smuzhiyun 	{ }
348*4882a593Smuzhiyun };
349*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, vz89x_dt_ids);
350*4882a593Smuzhiyun 
vz89x_probe(struct i2c_client * client,const struct i2c_device_id * id)351*4882a593Smuzhiyun static int vz89x_probe(struct i2c_client *client,
352*4882a593Smuzhiyun 		       const struct i2c_device_id *id)
353*4882a593Smuzhiyun {
354*4882a593Smuzhiyun 	struct device *dev = &client->dev;
355*4882a593Smuzhiyun 	struct iio_dev *indio_dev;
356*4882a593Smuzhiyun 	struct vz89x_data *data;
357*4882a593Smuzhiyun 	int chip_id;
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	indio_dev = devm_iio_device_alloc(dev, sizeof(*data));
360*4882a593Smuzhiyun 	if (!indio_dev)
361*4882a593Smuzhiyun 		return -ENOMEM;
362*4882a593Smuzhiyun 	data = iio_priv(indio_dev);
363*4882a593Smuzhiyun 
364*4882a593Smuzhiyun 	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
365*4882a593Smuzhiyun 		data->xfer = vz89x_i2c_xfer;
366*4882a593Smuzhiyun 	else if (i2c_check_functionality(client->adapter,
367*4882a593Smuzhiyun 				I2C_FUNC_SMBUS_WORD_DATA | I2C_FUNC_SMBUS_BYTE))
368*4882a593Smuzhiyun 		data->xfer = vz89x_smbus_xfer;
369*4882a593Smuzhiyun 	else
370*4882a593Smuzhiyun 		return -EOPNOTSUPP;
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	if (!dev_fwnode(dev))
373*4882a593Smuzhiyun 		chip_id = id->driver_data;
374*4882a593Smuzhiyun 	else
375*4882a593Smuzhiyun 		chip_id = (unsigned long)device_get_match_data(dev);
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun 	i2c_set_clientdata(client, indio_dev);
378*4882a593Smuzhiyun 	data->client = client;
379*4882a593Smuzhiyun 	data->chip = &vz89x_chips[chip_id];
380*4882a593Smuzhiyun 	data->last_update = jiffies - HZ;
381*4882a593Smuzhiyun 	mutex_init(&data->lock);
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun 	indio_dev->info = &vz89x_info;
384*4882a593Smuzhiyun 	indio_dev->name = dev_name(dev);
385*4882a593Smuzhiyun 	indio_dev->modes = INDIO_DIRECT_MODE;
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun 	indio_dev->channels = data->chip->channels;
388*4882a593Smuzhiyun 	indio_dev->num_channels = data->chip->num_channels;
389*4882a593Smuzhiyun 
390*4882a593Smuzhiyun 	return devm_iio_device_register(dev, indio_dev);
391*4882a593Smuzhiyun }
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun static const struct i2c_device_id vz89x_id[] = {
394*4882a593Smuzhiyun 	{ "vz89x", VZ89X },
395*4882a593Smuzhiyun 	{ "vz89te", VZ89TE },
396*4882a593Smuzhiyun 	{ }
397*4882a593Smuzhiyun };
398*4882a593Smuzhiyun MODULE_DEVICE_TABLE(i2c, vz89x_id);
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun static struct i2c_driver vz89x_driver = {
401*4882a593Smuzhiyun 	.driver = {
402*4882a593Smuzhiyun 		.name	= "vz89x",
403*4882a593Smuzhiyun 		.of_match_table = vz89x_dt_ids,
404*4882a593Smuzhiyun 	},
405*4882a593Smuzhiyun 	.probe = vz89x_probe,
406*4882a593Smuzhiyun 	.id_table = vz89x_id,
407*4882a593Smuzhiyun };
408*4882a593Smuzhiyun module_i2c_driver(vz89x_driver);
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun MODULE_AUTHOR("Matt Ranostay <matt.ranostay@konsulko.com>");
411*4882a593Smuzhiyun MODULE_DESCRIPTION("SGX Sensortech MiCS VZ89X VOC sensors");
412*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
413