162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0+ 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * vz89x.c - Support for SGX Sensortech MiCS VZ89X VOC sensors 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2015-2018 662306a36Sopenharmony_ci * Author: Matt Ranostay <matt.ranostay@konsulko.com> 762306a36Sopenharmony_ci */ 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci#include <linux/module.h> 1062306a36Sopenharmony_ci#include <linux/mutex.h> 1162306a36Sopenharmony_ci#include <linux/init.h> 1262306a36Sopenharmony_ci#include <linux/i2c.h> 1362306a36Sopenharmony_ci#include <linux/mod_devicetable.h> 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ci#include <linux/iio/iio.h> 1662306a36Sopenharmony_ci#include <linux/iio/sysfs.h> 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci#define VZ89X_REG_MEASUREMENT 0x09 1962306a36Sopenharmony_ci#define VZ89X_REG_MEASUREMENT_RD_SIZE 6 2062306a36Sopenharmony_ci#define VZ89X_REG_MEASUREMENT_WR_SIZE 3 2162306a36Sopenharmony_ci 2262306a36Sopenharmony_ci#define VZ89X_VOC_CO2_IDX 0 2362306a36Sopenharmony_ci#define VZ89X_VOC_SHORT_IDX 1 2462306a36Sopenharmony_ci#define VZ89X_VOC_TVOC_IDX 2 2562306a36Sopenharmony_ci#define VZ89X_VOC_RESISTANCE_IDX 3 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci#define VZ89TE_REG_MEASUREMENT 0x0c 2862306a36Sopenharmony_ci#define VZ89TE_REG_MEASUREMENT_RD_SIZE 7 2962306a36Sopenharmony_ci#define VZ89TE_REG_MEASUREMENT_WR_SIZE 6 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci#define VZ89TE_VOC_TVOC_IDX 0 3262306a36Sopenharmony_ci#define VZ89TE_VOC_CO2_IDX 1 3362306a36Sopenharmony_ci#define VZ89TE_VOC_RESISTANCE_IDX 2 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_cienum { 3662306a36Sopenharmony_ci VZ89X, 3762306a36Sopenharmony_ci VZ89TE, 3862306a36Sopenharmony_ci}; 3962306a36Sopenharmony_ci 4062306a36Sopenharmony_cistruct vz89x_chip_data; 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_cistruct vz89x_data { 4362306a36Sopenharmony_ci struct i2c_client *client; 4462306a36Sopenharmony_ci const struct vz89x_chip_data *chip; 4562306a36Sopenharmony_ci struct mutex lock; 4662306a36Sopenharmony_ci int (*xfer)(struct vz89x_data *data, u8 cmd); 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci bool is_valid; 4962306a36Sopenharmony_ci unsigned long last_update; 5062306a36Sopenharmony_ci u8 buffer[VZ89TE_REG_MEASUREMENT_RD_SIZE]; 5162306a36Sopenharmony_ci}; 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_cistruct vz89x_chip_data { 5462306a36Sopenharmony_ci bool (*valid)(struct vz89x_data *data); 5562306a36Sopenharmony_ci const struct iio_chan_spec *channels; 5662306a36Sopenharmony_ci u8 num_channels; 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_ci u8 cmd; 5962306a36Sopenharmony_ci u8 read_size; 6062306a36Sopenharmony_ci u8 write_size; 6162306a36Sopenharmony_ci}; 6262306a36Sopenharmony_ci 6362306a36Sopenharmony_cistatic const struct iio_chan_spec vz89x_channels[] = { 6462306a36Sopenharmony_ci { 6562306a36Sopenharmony_ci .type = IIO_CONCENTRATION, 6662306a36Sopenharmony_ci .channel2 = IIO_MOD_CO2, 6762306a36Sopenharmony_ci .modified = 1, 6862306a36Sopenharmony_ci .info_mask_separate = 6962306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW), 7062306a36Sopenharmony_ci .address = VZ89X_VOC_CO2_IDX, 7162306a36Sopenharmony_ci }, 7262306a36Sopenharmony_ci { 7362306a36Sopenharmony_ci .type = IIO_CONCENTRATION, 7462306a36Sopenharmony_ci .channel2 = IIO_MOD_VOC, 7562306a36Sopenharmony_ci .modified = 1, 7662306a36Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 7762306a36Sopenharmony_ci .address = VZ89X_VOC_SHORT_IDX, 7862306a36Sopenharmony_ci .extend_name = "short", 7962306a36Sopenharmony_ci }, 8062306a36Sopenharmony_ci { 8162306a36Sopenharmony_ci .type = IIO_CONCENTRATION, 8262306a36Sopenharmony_ci .channel2 = IIO_MOD_VOC, 8362306a36Sopenharmony_ci .modified = 1, 8462306a36Sopenharmony_ci .info_mask_separate = 8562306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW), 8662306a36Sopenharmony_ci .address = VZ89X_VOC_TVOC_IDX, 8762306a36Sopenharmony_ci }, 8862306a36Sopenharmony_ci { 8962306a36Sopenharmony_ci .type = IIO_RESISTANCE, 9062306a36Sopenharmony_ci .info_mask_separate = 9162306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE), 9262306a36Sopenharmony_ci .address = VZ89X_VOC_RESISTANCE_IDX, 9362306a36Sopenharmony_ci .scan_index = -1, 9462306a36Sopenharmony_ci .scan_type = { 9562306a36Sopenharmony_ci .endianness = IIO_LE, 9662306a36Sopenharmony_ci }, 9762306a36Sopenharmony_ci }, 9862306a36Sopenharmony_ci}; 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_cistatic const struct iio_chan_spec vz89te_channels[] = { 10162306a36Sopenharmony_ci { 10262306a36Sopenharmony_ci .type = IIO_CONCENTRATION, 10362306a36Sopenharmony_ci .channel2 = IIO_MOD_VOC, 10462306a36Sopenharmony_ci .modified = 1, 10562306a36Sopenharmony_ci .info_mask_separate = 10662306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW), 10762306a36Sopenharmony_ci .address = VZ89TE_VOC_TVOC_IDX, 10862306a36Sopenharmony_ci }, 10962306a36Sopenharmony_ci 11062306a36Sopenharmony_ci { 11162306a36Sopenharmony_ci .type = IIO_CONCENTRATION, 11262306a36Sopenharmony_ci .channel2 = IIO_MOD_CO2, 11362306a36Sopenharmony_ci .modified = 1, 11462306a36Sopenharmony_ci .info_mask_separate = 11562306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW), 11662306a36Sopenharmony_ci .address = VZ89TE_VOC_CO2_IDX, 11762306a36Sopenharmony_ci }, 11862306a36Sopenharmony_ci { 11962306a36Sopenharmony_ci .type = IIO_RESISTANCE, 12062306a36Sopenharmony_ci .info_mask_separate = 12162306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE), 12262306a36Sopenharmony_ci .address = VZ89TE_VOC_RESISTANCE_IDX, 12362306a36Sopenharmony_ci .scan_index = -1, 12462306a36Sopenharmony_ci .scan_type = { 12562306a36Sopenharmony_ci .endianness = IIO_BE, 12662306a36Sopenharmony_ci }, 12762306a36Sopenharmony_ci }, 12862306a36Sopenharmony_ci}; 12962306a36Sopenharmony_ci 13062306a36Sopenharmony_cistatic IIO_CONST_ATTR(in_concentration_co2_scale, "0.00000698689"); 13162306a36Sopenharmony_cistatic IIO_CONST_ATTR(in_concentration_voc_scale, "0.00000000436681223"); 13262306a36Sopenharmony_ci 13362306a36Sopenharmony_cistatic struct attribute *vz89x_attributes[] = { 13462306a36Sopenharmony_ci &iio_const_attr_in_concentration_co2_scale.dev_attr.attr, 13562306a36Sopenharmony_ci &iio_const_attr_in_concentration_voc_scale.dev_attr.attr, 13662306a36Sopenharmony_ci NULL, 13762306a36Sopenharmony_ci}; 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_cistatic const struct attribute_group vz89x_attrs_group = { 14062306a36Sopenharmony_ci .attrs = vz89x_attributes, 14162306a36Sopenharmony_ci}; 14262306a36Sopenharmony_ci 14362306a36Sopenharmony_ci/* 14462306a36Sopenharmony_ci * Chipset sometime updates in the middle of a reading causing it to reset the 14562306a36Sopenharmony_ci * data pointer, and causing invalid reading of previous data. 14662306a36Sopenharmony_ci * We can check for this by reading MSB of the resistance reading that is 14762306a36Sopenharmony_ci * always zero, and by also confirming the VOC_short isn't zero. 14862306a36Sopenharmony_ci */ 14962306a36Sopenharmony_ci 15062306a36Sopenharmony_cistatic bool vz89x_measurement_is_valid(struct vz89x_data *data) 15162306a36Sopenharmony_ci{ 15262306a36Sopenharmony_ci if (data->buffer[VZ89X_VOC_SHORT_IDX] == 0) 15362306a36Sopenharmony_ci return true; 15462306a36Sopenharmony_ci 15562306a36Sopenharmony_ci return !!(data->buffer[data->chip->read_size - 1] > 0); 15662306a36Sopenharmony_ci} 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci/* VZ89TE device has a modified CRC-8 two complement check */ 15962306a36Sopenharmony_cistatic bool vz89te_measurement_is_valid(struct vz89x_data *data) 16062306a36Sopenharmony_ci{ 16162306a36Sopenharmony_ci u8 crc = 0; 16262306a36Sopenharmony_ci int i, sum = 0; 16362306a36Sopenharmony_ci 16462306a36Sopenharmony_ci for (i = 0; i < (data->chip->read_size - 1); i++) { 16562306a36Sopenharmony_ci sum = crc + data->buffer[i]; 16662306a36Sopenharmony_ci crc = sum; 16762306a36Sopenharmony_ci crc += sum / 256; 16862306a36Sopenharmony_ci } 16962306a36Sopenharmony_ci 17062306a36Sopenharmony_ci return !((0xff - crc) == data->buffer[data->chip->read_size - 1]); 17162306a36Sopenharmony_ci} 17262306a36Sopenharmony_ci 17362306a36Sopenharmony_cistatic int vz89x_i2c_xfer(struct vz89x_data *data, u8 cmd) 17462306a36Sopenharmony_ci{ 17562306a36Sopenharmony_ci const struct vz89x_chip_data *chip = data->chip; 17662306a36Sopenharmony_ci struct i2c_client *client = data->client; 17762306a36Sopenharmony_ci struct i2c_msg msg[2]; 17862306a36Sopenharmony_ci int ret; 17962306a36Sopenharmony_ci u8 buf[6] = { cmd, 0, 0, 0, 0, 0xf3 }; 18062306a36Sopenharmony_ci 18162306a36Sopenharmony_ci msg[0].addr = client->addr; 18262306a36Sopenharmony_ci msg[0].flags = client->flags; 18362306a36Sopenharmony_ci msg[0].len = chip->write_size; 18462306a36Sopenharmony_ci msg[0].buf = (char *) &buf; 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_ci msg[1].addr = client->addr; 18762306a36Sopenharmony_ci msg[1].flags = client->flags | I2C_M_RD; 18862306a36Sopenharmony_ci msg[1].len = chip->read_size; 18962306a36Sopenharmony_ci msg[1].buf = (char *) &data->buffer; 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_ci ret = i2c_transfer(client->adapter, msg, 2); 19262306a36Sopenharmony_ci 19362306a36Sopenharmony_ci return (ret == 2) ? 0 : ret; 19462306a36Sopenharmony_ci} 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_cistatic int vz89x_smbus_xfer(struct vz89x_data *data, u8 cmd) 19762306a36Sopenharmony_ci{ 19862306a36Sopenharmony_ci struct i2c_client *client = data->client; 19962306a36Sopenharmony_ci int ret; 20062306a36Sopenharmony_ci int i; 20162306a36Sopenharmony_ci 20262306a36Sopenharmony_ci ret = i2c_smbus_write_word_data(client, cmd, 0); 20362306a36Sopenharmony_ci if (ret < 0) 20462306a36Sopenharmony_ci return ret; 20562306a36Sopenharmony_ci 20662306a36Sopenharmony_ci for (i = 0; i < data->chip->read_size; i++) { 20762306a36Sopenharmony_ci ret = i2c_smbus_read_byte(client); 20862306a36Sopenharmony_ci if (ret < 0) 20962306a36Sopenharmony_ci return ret; 21062306a36Sopenharmony_ci data->buffer[i] = ret; 21162306a36Sopenharmony_ci } 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci return 0; 21462306a36Sopenharmony_ci} 21562306a36Sopenharmony_ci 21662306a36Sopenharmony_cistatic int vz89x_get_measurement(struct vz89x_data *data) 21762306a36Sopenharmony_ci{ 21862306a36Sopenharmony_ci const struct vz89x_chip_data *chip = data->chip; 21962306a36Sopenharmony_ci int ret; 22062306a36Sopenharmony_ci 22162306a36Sopenharmony_ci /* sensor can only be polled once a second max per datasheet */ 22262306a36Sopenharmony_ci if (!time_after(jiffies, data->last_update + HZ)) 22362306a36Sopenharmony_ci return data->is_valid ? 0 : -EAGAIN; 22462306a36Sopenharmony_ci 22562306a36Sopenharmony_ci data->is_valid = false; 22662306a36Sopenharmony_ci data->last_update = jiffies; 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_ci ret = data->xfer(data, chip->cmd); 22962306a36Sopenharmony_ci if (ret < 0) 23062306a36Sopenharmony_ci return ret; 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_ci ret = chip->valid(data); 23362306a36Sopenharmony_ci if (ret) 23462306a36Sopenharmony_ci return -EAGAIN; 23562306a36Sopenharmony_ci 23662306a36Sopenharmony_ci data->is_valid = true; 23762306a36Sopenharmony_ci 23862306a36Sopenharmony_ci return 0; 23962306a36Sopenharmony_ci} 24062306a36Sopenharmony_ci 24162306a36Sopenharmony_cistatic int vz89x_get_resistance_reading(struct vz89x_data *data, 24262306a36Sopenharmony_ci struct iio_chan_spec const *chan, 24362306a36Sopenharmony_ci int *val) 24462306a36Sopenharmony_ci{ 24562306a36Sopenharmony_ci u8 *tmp = &data->buffer[chan->address]; 24662306a36Sopenharmony_ci 24762306a36Sopenharmony_ci switch (chan->scan_type.endianness) { 24862306a36Sopenharmony_ci case IIO_LE: 24962306a36Sopenharmony_ci *val = le32_to_cpup((__le32 *) tmp) & GENMASK(23, 0); 25062306a36Sopenharmony_ci break; 25162306a36Sopenharmony_ci case IIO_BE: 25262306a36Sopenharmony_ci *val = be32_to_cpup((__be32 *) tmp) >> 8; 25362306a36Sopenharmony_ci break; 25462306a36Sopenharmony_ci default: 25562306a36Sopenharmony_ci return -EINVAL; 25662306a36Sopenharmony_ci } 25762306a36Sopenharmony_ci 25862306a36Sopenharmony_ci return 0; 25962306a36Sopenharmony_ci} 26062306a36Sopenharmony_ci 26162306a36Sopenharmony_cistatic int vz89x_read_raw(struct iio_dev *indio_dev, 26262306a36Sopenharmony_ci struct iio_chan_spec const *chan, int *val, 26362306a36Sopenharmony_ci int *val2, long mask) 26462306a36Sopenharmony_ci{ 26562306a36Sopenharmony_ci struct vz89x_data *data = iio_priv(indio_dev); 26662306a36Sopenharmony_ci int ret = -EINVAL; 26762306a36Sopenharmony_ci 26862306a36Sopenharmony_ci switch (mask) { 26962306a36Sopenharmony_ci case IIO_CHAN_INFO_RAW: 27062306a36Sopenharmony_ci mutex_lock(&data->lock); 27162306a36Sopenharmony_ci ret = vz89x_get_measurement(data); 27262306a36Sopenharmony_ci mutex_unlock(&data->lock); 27362306a36Sopenharmony_ci 27462306a36Sopenharmony_ci if (ret) 27562306a36Sopenharmony_ci return ret; 27662306a36Sopenharmony_ci 27762306a36Sopenharmony_ci switch (chan->type) { 27862306a36Sopenharmony_ci case IIO_CONCENTRATION: 27962306a36Sopenharmony_ci *val = data->buffer[chan->address]; 28062306a36Sopenharmony_ci return IIO_VAL_INT; 28162306a36Sopenharmony_ci case IIO_RESISTANCE: 28262306a36Sopenharmony_ci ret = vz89x_get_resistance_reading(data, chan, val); 28362306a36Sopenharmony_ci if (!ret) 28462306a36Sopenharmony_ci return IIO_VAL_INT; 28562306a36Sopenharmony_ci break; 28662306a36Sopenharmony_ci default: 28762306a36Sopenharmony_ci return -EINVAL; 28862306a36Sopenharmony_ci } 28962306a36Sopenharmony_ci break; 29062306a36Sopenharmony_ci case IIO_CHAN_INFO_SCALE: 29162306a36Sopenharmony_ci switch (chan->type) { 29262306a36Sopenharmony_ci case IIO_RESISTANCE: 29362306a36Sopenharmony_ci *val = 10; 29462306a36Sopenharmony_ci return IIO_VAL_INT; 29562306a36Sopenharmony_ci default: 29662306a36Sopenharmony_ci return -EINVAL; 29762306a36Sopenharmony_ci } 29862306a36Sopenharmony_ci break; 29962306a36Sopenharmony_ci case IIO_CHAN_INFO_OFFSET: 30062306a36Sopenharmony_ci switch (chan->channel2) { 30162306a36Sopenharmony_ci case IIO_MOD_CO2: 30262306a36Sopenharmony_ci *val = 44; 30362306a36Sopenharmony_ci *val2 = 250000; 30462306a36Sopenharmony_ci return IIO_VAL_INT_PLUS_MICRO; 30562306a36Sopenharmony_ci case IIO_MOD_VOC: 30662306a36Sopenharmony_ci *val = -13; 30762306a36Sopenharmony_ci return IIO_VAL_INT; 30862306a36Sopenharmony_ci default: 30962306a36Sopenharmony_ci return -EINVAL; 31062306a36Sopenharmony_ci } 31162306a36Sopenharmony_ci } 31262306a36Sopenharmony_ci 31362306a36Sopenharmony_ci return ret; 31462306a36Sopenharmony_ci} 31562306a36Sopenharmony_ci 31662306a36Sopenharmony_cistatic const struct iio_info vz89x_info = { 31762306a36Sopenharmony_ci .attrs = &vz89x_attrs_group, 31862306a36Sopenharmony_ci .read_raw = vz89x_read_raw, 31962306a36Sopenharmony_ci}; 32062306a36Sopenharmony_ci 32162306a36Sopenharmony_cistatic const struct vz89x_chip_data vz89x_chips[] = { 32262306a36Sopenharmony_ci { 32362306a36Sopenharmony_ci .valid = vz89x_measurement_is_valid, 32462306a36Sopenharmony_ci 32562306a36Sopenharmony_ci .cmd = VZ89X_REG_MEASUREMENT, 32662306a36Sopenharmony_ci .read_size = VZ89X_REG_MEASUREMENT_RD_SIZE, 32762306a36Sopenharmony_ci .write_size = VZ89X_REG_MEASUREMENT_WR_SIZE, 32862306a36Sopenharmony_ci 32962306a36Sopenharmony_ci .channels = vz89x_channels, 33062306a36Sopenharmony_ci .num_channels = ARRAY_SIZE(vz89x_channels), 33162306a36Sopenharmony_ci }, 33262306a36Sopenharmony_ci { 33362306a36Sopenharmony_ci .valid = vz89te_measurement_is_valid, 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci .cmd = VZ89TE_REG_MEASUREMENT, 33662306a36Sopenharmony_ci .read_size = VZ89TE_REG_MEASUREMENT_RD_SIZE, 33762306a36Sopenharmony_ci .write_size = VZ89TE_REG_MEASUREMENT_WR_SIZE, 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci .channels = vz89te_channels, 34062306a36Sopenharmony_ci .num_channels = ARRAY_SIZE(vz89te_channels), 34162306a36Sopenharmony_ci }, 34262306a36Sopenharmony_ci}; 34362306a36Sopenharmony_ci 34462306a36Sopenharmony_cistatic const struct of_device_id vz89x_dt_ids[] = { 34562306a36Sopenharmony_ci { .compatible = "sgx,vz89x", .data = (void *) VZ89X }, 34662306a36Sopenharmony_ci { .compatible = "sgx,vz89te", .data = (void *) VZ89TE }, 34762306a36Sopenharmony_ci { } 34862306a36Sopenharmony_ci}; 34962306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, vz89x_dt_ids); 35062306a36Sopenharmony_ci 35162306a36Sopenharmony_cistatic int vz89x_probe(struct i2c_client *client) 35262306a36Sopenharmony_ci{ 35362306a36Sopenharmony_ci const struct i2c_device_id *id = i2c_client_get_device_id(client); 35462306a36Sopenharmony_ci struct device *dev = &client->dev; 35562306a36Sopenharmony_ci struct iio_dev *indio_dev; 35662306a36Sopenharmony_ci struct vz89x_data *data; 35762306a36Sopenharmony_ci int chip_id; 35862306a36Sopenharmony_ci 35962306a36Sopenharmony_ci indio_dev = devm_iio_device_alloc(dev, sizeof(*data)); 36062306a36Sopenharmony_ci if (!indio_dev) 36162306a36Sopenharmony_ci return -ENOMEM; 36262306a36Sopenharmony_ci data = iio_priv(indio_dev); 36362306a36Sopenharmony_ci 36462306a36Sopenharmony_ci if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) 36562306a36Sopenharmony_ci data->xfer = vz89x_i2c_xfer; 36662306a36Sopenharmony_ci else if (i2c_check_functionality(client->adapter, 36762306a36Sopenharmony_ci I2C_FUNC_SMBUS_WORD_DATA | I2C_FUNC_SMBUS_BYTE)) 36862306a36Sopenharmony_ci data->xfer = vz89x_smbus_xfer; 36962306a36Sopenharmony_ci else 37062306a36Sopenharmony_ci return -EOPNOTSUPP; 37162306a36Sopenharmony_ci 37262306a36Sopenharmony_ci if (!dev_fwnode(dev)) 37362306a36Sopenharmony_ci chip_id = id->driver_data; 37462306a36Sopenharmony_ci else 37562306a36Sopenharmony_ci chip_id = (unsigned long)device_get_match_data(dev); 37662306a36Sopenharmony_ci 37762306a36Sopenharmony_ci i2c_set_clientdata(client, indio_dev); 37862306a36Sopenharmony_ci data->client = client; 37962306a36Sopenharmony_ci data->chip = &vz89x_chips[chip_id]; 38062306a36Sopenharmony_ci data->last_update = jiffies - HZ; 38162306a36Sopenharmony_ci mutex_init(&data->lock); 38262306a36Sopenharmony_ci 38362306a36Sopenharmony_ci indio_dev->info = &vz89x_info; 38462306a36Sopenharmony_ci indio_dev->name = dev_name(dev); 38562306a36Sopenharmony_ci indio_dev->modes = INDIO_DIRECT_MODE; 38662306a36Sopenharmony_ci 38762306a36Sopenharmony_ci indio_dev->channels = data->chip->channels; 38862306a36Sopenharmony_ci indio_dev->num_channels = data->chip->num_channels; 38962306a36Sopenharmony_ci 39062306a36Sopenharmony_ci return devm_iio_device_register(dev, indio_dev); 39162306a36Sopenharmony_ci} 39262306a36Sopenharmony_ci 39362306a36Sopenharmony_cistatic const struct i2c_device_id vz89x_id[] = { 39462306a36Sopenharmony_ci { "vz89x", VZ89X }, 39562306a36Sopenharmony_ci { "vz89te", VZ89TE }, 39662306a36Sopenharmony_ci { } 39762306a36Sopenharmony_ci}; 39862306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, vz89x_id); 39962306a36Sopenharmony_ci 40062306a36Sopenharmony_cistatic struct i2c_driver vz89x_driver = { 40162306a36Sopenharmony_ci .driver = { 40262306a36Sopenharmony_ci .name = "vz89x", 40362306a36Sopenharmony_ci .of_match_table = vz89x_dt_ids, 40462306a36Sopenharmony_ci }, 40562306a36Sopenharmony_ci .probe = vz89x_probe, 40662306a36Sopenharmony_ci .id_table = vz89x_id, 40762306a36Sopenharmony_ci}; 40862306a36Sopenharmony_cimodule_i2c_driver(vz89x_driver); 40962306a36Sopenharmony_ci 41062306a36Sopenharmony_ciMODULE_AUTHOR("Matt Ranostay <matt.ranostay@konsulko.com>"); 41162306a36Sopenharmony_ciMODULE_DESCRIPTION("SGX Sensortech MiCS VZ89X VOC sensors"); 41262306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 413