162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * hp206c.c - HOPERF HP206C precision barometer and altimeter sensor 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (c) 2016, Intel Corporation. 662306a36Sopenharmony_ci * 762306a36Sopenharmony_ci * (7-bit I2C slave address 0x76) 862306a36Sopenharmony_ci * 962306a36Sopenharmony_ci * Datasheet: 1062306a36Sopenharmony_ci * http://www.hoperf.com/upload/sensor/HP206C_DataSheet_EN_V2.0.pdf 1162306a36Sopenharmony_ci */ 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_ci#include <linux/module.h> 1462306a36Sopenharmony_ci#include <linux/i2c.h> 1562306a36Sopenharmony_ci#include <linux/iio/iio.h> 1662306a36Sopenharmony_ci#include <linux/iio/sysfs.h> 1762306a36Sopenharmony_ci#include <linux/delay.h> 1862306a36Sopenharmony_ci#include <linux/util_macros.h> 1962306a36Sopenharmony_ci#include <linux/acpi.h> 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_ci#include <asm/unaligned.h> 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci/* I2C commands: */ 2462306a36Sopenharmony_ci#define HP206C_CMD_SOFT_RST 0x06 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci#define HP206C_CMD_ADC_CVT 0x40 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_ci#define HP206C_CMD_ADC_CVT_OSR_4096 0x00 2962306a36Sopenharmony_ci#define HP206C_CMD_ADC_CVT_OSR_2048 0x04 3062306a36Sopenharmony_ci#define HP206C_CMD_ADC_CVT_OSR_1024 0x08 3162306a36Sopenharmony_ci#define HP206C_CMD_ADC_CVT_OSR_512 0x0c 3262306a36Sopenharmony_ci#define HP206C_CMD_ADC_CVT_OSR_256 0x10 3362306a36Sopenharmony_ci#define HP206C_CMD_ADC_CVT_OSR_128 0x14 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_ci#define HP206C_CMD_ADC_CVT_CHNL_PT 0x00 3662306a36Sopenharmony_ci#define HP206C_CMD_ADC_CVT_CHNL_T 0x02 3762306a36Sopenharmony_ci 3862306a36Sopenharmony_ci#define HP206C_CMD_READ_P 0x30 3962306a36Sopenharmony_ci#define HP206C_CMD_READ_T 0x32 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ci#define HP206C_CMD_READ_REG 0x80 4262306a36Sopenharmony_ci#define HP206C_CMD_WRITE_REG 0xc0 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci#define HP206C_REG_INT_EN 0x0b 4562306a36Sopenharmony_ci#define HP206C_REG_INT_CFG 0x0c 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci#define HP206C_REG_INT_SRC 0x0d 4862306a36Sopenharmony_ci#define HP206C_FLAG_DEV_RDY 0x40 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ci#define HP206C_REG_PARA 0x0f 5162306a36Sopenharmony_ci#define HP206C_FLAG_CMPS_EN 0x80 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci/* Maximum spin for DEV_RDY */ 5462306a36Sopenharmony_ci#define HP206C_MAX_DEV_RDY_WAIT_COUNT 20 5562306a36Sopenharmony_ci#define HP206C_DEV_RDY_WAIT_US 20000 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_cistruct hp206c_data { 5862306a36Sopenharmony_ci struct mutex mutex; 5962306a36Sopenharmony_ci struct i2c_client *client; 6062306a36Sopenharmony_ci int temp_osr_index; 6162306a36Sopenharmony_ci int pres_osr_index; 6262306a36Sopenharmony_ci}; 6362306a36Sopenharmony_ci 6462306a36Sopenharmony_cistruct hp206c_osr_setting { 6562306a36Sopenharmony_ci u8 osr_mask; 6662306a36Sopenharmony_ci unsigned int temp_conv_time_us; 6762306a36Sopenharmony_ci unsigned int pres_conv_time_us; 6862306a36Sopenharmony_ci}; 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci/* Data from Table 5 in datasheet. */ 7162306a36Sopenharmony_cistatic const struct hp206c_osr_setting hp206c_osr_settings[] = { 7262306a36Sopenharmony_ci { HP206C_CMD_ADC_CVT_OSR_4096, 65600, 131100 }, 7362306a36Sopenharmony_ci { HP206C_CMD_ADC_CVT_OSR_2048, 32800, 65600 }, 7462306a36Sopenharmony_ci { HP206C_CMD_ADC_CVT_OSR_1024, 16400, 32800 }, 7562306a36Sopenharmony_ci { HP206C_CMD_ADC_CVT_OSR_512, 8200, 16400 }, 7662306a36Sopenharmony_ci { HP206C_CMD_ADC_CVT_OSR_256, 4100, 8200 }, 7762306a36Sopenharmony_ci { HP206C_CMD_ADC_CVT_OSR_128, 2100, 4100 }, 7862306a36Sopenharmony_ci}; 7962306a36Sopenharmony_cistatic const int hp206c_osr_rates[] = { 4096, 2048, 1024, 512, 256, 128 }; 8062306a36Sopenharmony_cistatic const char hp206c_osr_rates_str[] = "4096 2048 1024 512 256 128"; 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_cistatic inline int hp206c_read_reg(struct i2c_client *client, u8 reg) 8362306a36Sopenharmony_ci{ 8462306a36Sopenharmony_ci return i2c_smbus_read_byte_data(client, HP206C_CMD_READ_REG | reg); 8562306a36Sopenharmony_ci} 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_cistatic inline int hp206c_write_reg(struct i2c_client *client, u8 reg, u8 val) 8862306a36Sopenharmony_ci{ 8962306a36Sopenharmony_ci return i2c_smbus_write_byte_data(client, 9062306a36Sopenharmony_ci HP206C_CMD_WRITE_REG | reg, val); 9162306a36Sopenharmony_ci} 9262306a36Sopenharmony_ci 9362306a36Sopenharmony_cistatic int hp206c_read_20bit(struct i2c_client *client, u8 cmd) 9462306a36Sopenharmony_ci{ 9562306a36Sopenharmony_ci int ret; 9662306a36Sopenharmony_ci u8 values[3]; 9762306a36Sopenharmony_ci 9862306a36Sopenharmony_ci ret = i2c_smbus_read_i2c_block_data(client, cmd, sizeof(values), values); 9962306a36Sopenharmony_ci if (ret < 0) 10062306a36Sopenharmony_ci return ret; 10162306a36Sopenharmony_ci if (ret != sizeof(values)) 10262306a36Sopenharmony_ci return -EIO; 10362306a36Sopenharmony_ci return get_unaligned_be24(&values[0]) & GENMASK(19, 0); 10462306a36Sopenharmony_ci} 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci/* Spin for max 160ms until DEV_RDY is 1, or return error. */ 10762306a36Sopenharmony_cistatic int hp206c_wait_dev_rdy(struct iio_dev *indio_dev) 10862306a36Sopenharmony_ci{ 10962306a36Sopenharmony_ci int ret; 11062306a36Sopenharmony_ci int count = 0; 11162306a36Sopenharmony_ci struct hp206c_data *data = iio_priv(indio_dev); 11262306a36Sopenharmony_ci struct i2c_client *client = data->client; 11362306a36Sopenharmony_ci 11462306a36Sopenharmony_ci while (++count <= HP206C_MAX_DEV_RDY_WAIT_COUNT) { 11562306a36Sopenharmony_ci ret = hp206c_read_reg(client, HP206C_REG_INT_SRC); 11662306a36Sopenharmony_ci if (ret < 0) { 11762306a36Sopenharmony_ci dev_err(&indio_dev->dev, "Failed READ_REG INT_SRC: %d\n", ret); 11862306a36Sopenharmony_ci return ret; 11962306a36Sopenharmony_ci } 12062306a36Sopenharmony_ci if (ret & HP206C_FLAG_DEV_RDY) 12162306a36Sopenharmony_ci return 0; 12262306a36Sopenharmony_ci usleep_range(HP206C_DEV_RDY_WAIT_US, HP206C_DEV_RDY_WAIT_US * 3 / 2); 12362306a36Sopenharmony_ci } 12462306a36Sopenharmony_ci return -ETIMEDOUT; 12562306a36Sopenharmony_ci} 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_cistatic int hp206c_set_compensation(struct i2c_client *client, bool enabled) 12862306a36Sopenharmony_ci{ 12962306a36Sopenharmony_ci int val; 13062306a36Sopenharmony_ci 13162306a36Sopenharmony_ci val = hp206c_read_reg(client, HP206C_REG_PARA); 13262306a36Sopenharmony_ci if (val < 0) 13362306a36Sopenharmony_ci return val; 13462306a36Sopenharmony_ci if (enabled) 13562306a36Sopenharmony_ci val |= HP206C_FLAG_CMPS_EN; 13662306a36Sopenharmony_ci else 13762306a36Sopenharmony_ci val &= ~HP206C_FLAG_CMPS_EN; 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_ci return hp206c_write_reg(client, HP206C_REG_PARA, val); 14062306a36Sopenharmony_ci} 14162306a36Sopenharmony_ci 14262306a36Sopenharmony_ci/* Do a soft reset */ 14362306a36Sopenharmony_cistatic int hp206c_soft_reset(struct iio_dev *indio_dev) 14462306a36Sopenharmony_ci{ 14562306a36Sopenharmony_ci int ret; 14662306a36Sopenharmony_ci struct hp206c_data *data = iio_priv(indio_dev); 14762306a36Sopenharmony_ci struct i2c_client *client = data->client; 14862306a36Sopenharmony_ci 14962306a36Sopenharmony_ci ret = i2c_smbus_write_byte(client, HP206C_CMD_SOFT_RST); 15062306a36Sopenharmony_ci if (ret) { 15162306a36Sopenharmony_ci dev_err(&client->dev, "Failed to reset device: %d\n", ret); 15262306a36Sopenharmony_ci return ret; 15362306a36Sopenharmony_ci } 15462306a36Sopenharmony_ci 15562306a36Sopenharmony_ci usleep_range(400, 600); 15662306a36Sopenharmony_ci 15762306a36Sopenharmony_ci ret = hp206c_wait_dev_rdy(indio_dev); 15862306a36Sopenharmony_ci if (ret) { 15962306a36Sopenharmony_ci dev_err(&client->dev, "Device not ready after soft reset: %d\n", ret); 16062306a36Sopenharmony_ci return ret; 16162306a36Sopenharmony_ci } 16262306a36Sopenharmony_ci 16362306a36Sopenharmony_ci ret = hp206c_set_compensation(client, true); 16462306a36Sopenharmony_ci if (ret) 16562306a36Sopenharmony_ci dev_err(&client->dev, "Failed to enable compensation: %d\n", ret); 16662306a36Sopenharmony_ci return ret; 16762306a36Sopenharmony_ci} 16862306a36Sopenharmony_ci 16962306a36Sopenharmony_cistatic int hp206c_conv_and_read(struct iio_dev *indio_dev, 17062306a36Sopenharmony_ci u8 conv_cmd, u8 read_cmd, 17162306a36Sopenharmony_ci unsigned int sleep_us) 17262306a36Sopenharmony_ci{ 17362306a36Sopenharmony_ci int ret; 17462306a36Sopenharmony_ci struct hp206c_data *data = iio_priv(indio_dev); 17562306a36Sopenharmony_ci struct i2c_client *client = data->client; 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_ci ret = hp206c_wait_dev_rdy(indio_dev); 17862306a36Sopenharmony_ci if (ret < 0) { 17962306a36Sopenharmony_ci dev_err(&indio_dev->dev, "Device not ready: %d\n", ret); 18062306a36Sopenharmony_ci return ret; 18162306a36Sopenharmony_ci } 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_ci ret = i2c_smbus_write_byte(client, conv_cmd); 18462306a36Sopenharmony_ci if (ret < 0) { 18562306a36Sopenharmony_ci dev_err(&indio_dev->dev, "Failed convert: %d\n", ret); 18662306a36Sopenharmony_ci return ret; 18762306a36Sopenharmony_ci } 18862306a36Sopenharmony_ci 18962306a36Sopenharmony_ci usleep_range(sleep_us, sleep_us * 3 / 2); 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_ci ret = hp206c_wait_dev_rdy(indio_dev); 19262306a36Sopenharmony_ci if (ret < 0) { 19362306a36Sopenharmony_ci dev_err(&indio_dev->dev, "Device not ready: %d\n", ret); 19462306a36Sopenharmony_ci return ret; 19562306a36Sopenharmony_ci } 19662306a36Sopenharmony_ci 19762306a36Sopenharmony_ci ret = hp206c_read_20bit(client, read_cmd); 19862306a36Sopenharmony_ci if (ret < 0) 19962306a36Sopenharmony_ci dev_err(&indio_dev->dev, "Failed read: %d\n", ret); 20062306a36Sopenharmony_ci 20162306a36Sopenharmony_ci return ret; 20262306a36Sopenharmony_ci} 20362306a36Sopenharmony_ci 20462306a36Sopenharmony_cistatic int hp206c_read_raw(struct iio_dev *indio_dev, 20562306a36Sopenharmony_ci struct iio_chan_spec const *chan, int *val, 20662306a36Sopenharmony_ci int *val2, long mask) 20762306a36Sopenharmony_ci{ 20862306a36Sopenharmony_ci int ret; 20962306a36Sopenharmony_ci struct hp206c_data *data = iio_priv(indio_dev); 21062306a36Sopenharmony_ci const struct hp206c_osr_setting *osr_setting; 21162306a36Sopenharmony_ci u8 conv_cmd; 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci mutex_lock(&data->mutex); 21462306a36Sopenharmony_ci 21562306a36Sopenharmony_ci switch (mask) { 21662306a36Sopenharmony_ci case IIO_CHAN_INFO_OVERSAMPLING_RATIO: 21762306a36Sopenharmony_ci switch (chan->type) { 21862306a36Sopenharmony_ci case IIO_TEMP: 21962306a36Sopenharmony_ci *val = hp206c_osr_rates[data->temp_osr_index]; 22062306a36Sopenharmony_ci ret = IIO_VAL_INT; 22162306a36Sopenharmony_ci break; 22262306a36Sopenharmony_ci 22362306a36Sopenharmony_ci case IIO_PRESSURE: 22462306a36Sopenharmony_ci *val = hp206c_osr_rates[data->pres_osr_index]; 22562306a36Sopenharmony_ci ret = IIO_VAL_INT; 22662306a36Sopenharmony_ci break; 22762306a36Sopenharmony_ci default: 22862306a36Sopenharmony_ci ret = -EINVAL; 22962306a36Sopenharmony_ci } 23062306a36Sopenharmony_ci break; 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_ci case IIO_CHAN_INFO_RAW: 23362306a36Sopenharmony_ci switch (chan->type) { 23462306a36Sopenharmony_ci case IIO_TEMP: 23562306a36Sopenharmony_ci osr_setting = &hp206c_osr_settings[data->temp_osr_index]; 23662306a36Sopenharmony_ci conv_cmd = HP206C_CMD_ADC_CVT | 23762306a36Sopenharmony_ci osr_setting->osr_mask | 23862306a36Sopenharmony_ci HP206C_CMD_ADC_CVT_CHNL_T; 23962306a36Sopenharmony_ci ret = hp206c_conv_and_read(indio_dev, 24062306a36Sopenharmony_ci conv_cmd, 24162306a36Sopenharmony_ci HP206C_CMD_READ_T, 24262306a36Sopenharmony_ci osr_setting->temp_conv_time_us); 24362306a36Sopenharmony_ci if (ret >= 0) { 24462306a36Sopenharmony_ci /* 20 significant bits are provided. 24562306a36Sopenharmony_ci * Extend sign over the rest. 24662306a36Sopenharmony_ci */ 24762306a36Sopenharmony_ci *val = sign_extend32(ret, 19); 24862306a36Sopenharmony_ci ret = IIO_VAL_INT; 24962306a36Sopenharmony_ci } 25062306a36Sopenharmony_ci break; 25162306a36Sopenharmony_ci 25262306a36Sopenharmony_ci case IIO_PRESSURE: 25362306a36Sopenharmony_ci osr_setting = &hp206c_osr_settings[data->pres_osr_index]; 25462306a36Sopenharmony_ci conv_cmd = HP206C_CMD_ADC_CVT | 25562306a36Sopenharmony_ci osr_setting->osr_mask | 25662306a36Sopenharmony_ci HP206C_CMD_ADC_CVT_CHNL_PT; 25762306a36Sopenharmony_ci ret = hp206c_conv_and_read(indio_dev, 25862306a36Sopenharmony_ci conv_cmd, 25962306a36Sopenharmony_ci HP206C_CMD_READ_P, 26062306a36Sopenharmony_ci osr_setting->pres_conv_time_us); 26162306a36Sopenharmony_ci if (ret >= 0) { 26262306a36Sopenharmony_ci *val = ret; 26362306a36Sopenharmony_ci ret = IIO_VAL_INT; 26462306a36Sopenharmony_ci } 26562306a36Sopenharmony_ci break; 26662306a36Sopenharmony_ci default: 26762306a36Sopenharmony_ci ret = -EINVAL; 26862306a36Sopenharmony_ci } 26962306a36Sopenharmony_ci break; 27062306a36Sopenharmony_ci 27162306a36Sopenharmony_ci case IIO_CHAN_INFO_SCALE: 27262306a36Sopenharmony_ci switch (chan->type) { 27362306a36Sopenharmony_ci case IIO_TEMP: 27462306a36Sopenharmony_ci *val = 0; 27562306a36Sopenharmony_ci *val2 = 10000; 27662306a36Sopenharmony_ci ret = IIO_VAL_INT_PLUS_MICRO; 27762306a36Sopenharmony_ci break; 27862306a36Sopenharmony_ci 27962306a36Sopenharmony_ci case IIO_PRESSURE: 28062306a36Sopenharmony_ci *val = 0; 28162306a36Sopenharmony_ci *val2 = 1000; 28262306a36Sopenharmony_ci ret = IIO_VAL_INT_PLUS_MICRO; 28362306a36Sopenharmony_ci break; 28462306a36Sopenharmony_ci default: 28562306a36Sopenharmony_ci ret = -EINVAL; 28662306a36Sopenharmony_ci } 28762306a36Sopenharmony_ci break; 28862306a36Sopenharmony_ci 28962306a36Sopenharmony_ci default: 29062306a36Sopenharmony_ci ret = -EINVAL; 29162306a36Sopenharmony_ci } 29262306a36Sopenharmony_ci 29362306a36Sopenharmony_ci mutex_unlock(&data->mutex); 29462306a36Sopenharmony_ci return ret; 29562306a36Sopenharmony_ci} 29662306a36Sopenharmony_ci 29762306a36Sopenharmony_cistatic int hp206c_write_raw(struct iio_dev *indio_dev, 29862306a36Sopenharmony_ci struct iio_chan_spec const *chan, 29962306a36Sopenharmony_ci int val, int val2, long mask) 30062306a36Sopenharmony_ci{ 30162306a36Sopenharmony_ci int ret = 0; 30262306a36Sopenharmony_ci struct hp206c_data *data = iio_priv(indio_dev); 30362306a36Sopenharmony_ci 30462306a36Sopenharmony_ci if (mask != IIO_CHAN_INFO_OVERSAMPLING_RATIO) 30562306a36Sopenharmony_ci return -EINVAL; 30662306a36Sopenharmony_ci mutex_lock(&data->mutex); 30762306a36Sopenharmony_ci switch (chan->type) { 30862306a36Sopenharmony_ci case IIO_TEMP: 30962306a36Sopenharmony_ci data->temp_osr_index = find_closest_descending(val, 31062306a36Sopenharmony_ci hp206c_osr_rates, ARRAY_SIZE(hp206c_osr_rates)); 31162306a36Sopenharmony_ci break; 31262306a36Sopenharmony_ci case IIO_PRESSURE: 31362306a36Sopenharmony_ci data->pres_osr_index = find_closest_descending(val, 31462306a36Sopenharmony_ci hp206c_osr_rates, ARRAY_SIZE(hp206c_osr_rates)); 31562306a36Sopenharmony_ci break; 31662306a36Sopenharmony_ci default: 31762306a36Sopenharmony_ci ret = -EINVAL; 31862306a36Sopenharmony_ci } 31962306a36Sopenharmony_ci mutex_unlock(&data->mutex); 32062306a36Sopenharmony_ci return ret; 32162306a36Sopenharmony_ci} 32262306a36Sopenharmony_ci 32362306a36Sopenharmony_cistatic const struct iio_chan_spec hp206c_channels[] = { 32462306a36Sopenharmony_ci { 32562306a36Sopenharmony_ci .type = IIO_TEMP, 32662306a36Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | 32762306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_SCALE) | 32862306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_OVERSAMPLING_RATIO), 32962306a36Sopenharmony_ci }, 33062306a36Sopenharmony_ci { 33162306a36Sopenharmony_ci .type = IIO_PRESSURE, 33262306a36Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | 33362306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_SCALE) | 33462306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_OVERSAMPLING_RATIO), 33562306a36Sopenharmony_ci } 33662306a36Sopenharmony_ci}; 33762306a36Sopenharmony_ci 33862306a36Sopenharmony_cistatic IIO_CONST_ATTR_SAMP_FREQ_AVAIL(hp206c_osr_rates_str); 33962306a36Sopenharmony_ci 34062306a36Sopenharmony_cistatic struct attribute *hp206c_attributes[] = { 34162306a36Sopenharmony_ci &iio_const_attr_sampling_frequency_available.dev_attr.attr, 34262306a36Sopenharmony_ci NULL, 34362306a36Sopenharmony_ci}; 34462306a36Sopenharmony_ci 34562306a36Sopenharmony_cistatic const struct attribute_group hp206c_attribute_group = { 34662306a36Sopenharmony_ci .attrs = hp206c_attributes, 34762306a36Sopenharmony_ci}; 34862306a36Sopenharmony_ci 34962306a36Sopenharmony_cistatic const struct iio_info hp206c_info = { 35062306a36Sopenharmony_ci .attrs = &hp206c_attribute_group, 35162306a36Sopenharmony_ci .read_raw = hp206c_read_raw, 35262306a36Sopenharmony_ci .write_raw = hp206c_write_raw, 35362306a36Sopenharmony_ci}; 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_cistatic int hp206c_probe(struct i2c_client *client) 35662306a36Sopenharmony_ci{ 35762306a36Sopenharmony_ci const struct i2c_device_id *id = i2c_client_get_device_id(client); 35862306a36Sopenharmony_ci struct iio_dev *indio_dev; 35962306a36Sopenharmony_ci struct hp206c_data *data; 36062306a36Sopenharmony_ci int ret; 36162306a36Sopenharmony_ci 36262306a36Sopenharmony_ci if (!i2c_check_functionality(client->adapter, 36362306a36Sopenharmony_ci I2C_FUNC_SMBUS_BYTE | 36462306a36Sopenharmony_ci I2C_FUNC_SMBUS_BYTE_DATA | 36562306a36Sopenharmony_ci I2C_FUNC_SMBUS_READ_I2C_BLOCK)) { 36662306a36Sopenharmony_ci dev_err(&client->dev, "Adapter does not support " 36762306a36Sopenharmony_ci "all required i2c functionality\n"); 36862306a36Sopenharmony_ci return -ENODEV; 36962306a36Sopenharmony_ci } 37062306a36Sopenharmony_ci 37162306a36Sopenharmony_ci indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 37262306a36Sopenharmony_ci if (!indio_dev) 37362306a36Sopenharmony_ci return -ENOMEM; 37462306a36Sopenharmony_ci 37562306a36Sopenharmony_ci data = iio_priv(indio_dev); 37662306a36Sopenharmony_ci data->client = client; 37762306a36Sopenharmony_ci mutex_init(&data->mutex); 37862306a36Sopenharmony_ci 37962306a36Sopenharmony_ci indio_dev->info = &hp206c_info; 38062306a36Sopenharmony_ci indio_dev->name = id->name; 38162306a36Sopenharmony_ci indio_dev->modes = INDIO_DIRECT_MODE; 38262306a36Sopenharmony_ci indio_dev->channels = hp206c_channels; 38362306a36Sopenharmony_ci indio_dev->num_channels = ARRAY_SIZE(hp206c_channels); 38462306a36Sopenharmony_ci 38562306a36Sopenharmony_ci i2c_set_clientdata(client, indio_dev); 38662306a36Sopenharmony_ci 38762306a36Sopenharmony_ci /* Do a soft reset on probe */ 38862306a36Sopenharmony_ci ret = hp206c_soft_reset(indio_dev); 38962306a36Sopenharmony_ci if (ret) { 39062306a36Sopenharmony_ci dev_err(&client->dev, "Failed to reset on startup: %d\n", ret); 39162306a36Sopenharmony_ci return -ENODEV; 39262306a36Sopenharmony_ci } 39362306a36Sopenharmony_ci 39462306a36Sopenharmony_ci return devm_iio_device_register(&client->dev, indio_dev); 39562306a36Sopenharmony_ci} 39662306a36Sopenharmony_ci 39762306a36Sopenharmony_cistatic const struct i2c_device_id hp206c_id[] = { 39862306a36Sopenharmony_ci {"hp206c"}, 39962306a36Sopenharmony_ci {} 40062306a36Sopenharmony_ci}; 40162306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, hp206c_id); 40262306a36Sopenharmony_ci 40362306a36Sopenharmony_ci#ifdef CONFIG_ACPI 40462306a36Sopenharmony_cistatic const struct acpi_device_id hp206c_acpi_match[] = { 40562306a36Sopenharmony_ci {"HOP206C", 0}, 40662306a36Sopenharmony_ci { }, 40762306a36Sopenharmony_ci}; 40862306a36Sopenharmony_ciMODULE_DEVICE_TABLE(acpi, hp206c_acpi_match); 40962306a36Sopenharmony_ci#endif 41062306a36Sopenharmony_ci 41162306a36Sopenharmony_cistatic struct i2c_driver hp206c_driver = { 41262306a36Sopenharmony_ci .probe = hp206c_probe, 41362306a36Sopenharmony_ci .id_table = hp206c_id, 41462306a36Sopenharmony_ci .driver = { 41562306a36Sopenharmony_ci .name = "hp206c", 41662306a36Sopenharmony_ci .acpi_match_table = ACPI_PTR(hp206c_acpi_match), 41762306a36Sopenharmony_ci }, 41862306a36Sopenharmony_ci}; 41962306a36Sopenharmony_ci 42062306a36Sopenharmony_cimodule_i2c_driver(hp206c_driver); 42162306a36Sopenharmony_ci 42262306a36Sopenharmony_ciMODULE_DESCRIPTION("HOPERF HP206C precision barometer and altimeter sensor"); 42362306a36Sopenharmony_ciMODULE_AUTHOR("Leonard Crestez <leonard.crestez@intel.com>"); 42462306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 425