diff options
| -rw-r--r-- | drivers/iio/light/cm3391.c | 49 |
1 files changed, 44 insertions, 5 deletions
diff --git a/drivers/iio/light/cm3391.c b/drivers/iio/light/cm3391.c index abe8b8e7f5c..8049446d98a 100644 --- a/drivers/iio/light/cm3391.c +++ b/drivers/iio/light/cm3391.c @@ -53,7 +53,7 @@ #define CM3391_CMD_CS_IT_SHIFT 4 #define CM3391_CMD_CS_IT_MASK (BIT(4) | BIT(5) | BIT(6)) -#define CM3391_CMD_CS_IT_DEFAULT (0x01 << CM3391_CMD_CS_IT_SHIFT) +#define CM3391_CMD_CS_IT_DEFAULT (0x04 << CM3391_CMD_CS_IT_SHIFT) #define CM3391_CMD_CS_HS_SHIFT BIT(3) @@ -69,7 +69,8 @@ #define CM3391_THRESHOLD_PERCENT 10 /* 10 percent */ #define CM3391_MLUX_PER_BIT_DEFAULT 550 -#define CM3391_MLUX_PER_BIT_BASE_IT 100000 +#define CM3391_MLUX_PER_BIT_BASE_IT 800000 + static const struct { int val; @@ -90,6 +91,7 @@ static const int CM3391_cs_it_values[] = { struct cm3391_cs_info { u32 id; int regs_bmp; + int auto_it_enabled; int calibscale; int mlux_per_bit; int mlux_per_bit_base_it; @@ -102,8 +104,9 @@ struct cm3391_cs_info { static struct cm3391_cs_info cm3391_cs_info_default = { .id = 3391, .regs_bmp = 0x0F, - .calibscale = CM3391_CALIBSCALE_DEFAULT, - .mlux_per_bit = CM3391_MLUX_PER_BIT_DEFAULT, + .auto_it_enabled = 0, + .calibscale = CM3391_CALIBSCALE_DEFAULT, + .mlux_per_bit = CM3391_MLUX_PER_BIT_DEFAULT, .mlux_per_bit_base_it = CM3391_MLUX_PER_BIT_BASE_IT, .cs_it_bits = CM3391_cs_it_bits, .cs_it_values = CM3391_cs_it_values, @@ -299,6 +302,9 @@ void cm3391_autoit(struct cm3391_chip *chip, u16 als_raw) int i; int update; s32 ret; + + if(!chip->cs_info->auto_it_enabled) + return; cs_it = chip->conf_regs[CM3391_REG_ADDR_CMD]; cs_it &= CM3391_CMD_CS_IT_MASK; @@ -321,6 +327,7 @@ void cm3391_autoit(struct cm3391_chip *chip, u16 als_raw) } if (update) { +//printk(KERN_INFO "ALS readings are too high/low changing to:%i als_read:%i", i, als_raw) cs_it = cm3391_cs_it_scales[i].it; cs_it <<= CM3391_CMD_CS_IT_SHIFT; @@ -433,7 +440,7 @@ static int cm3391_get_lux(struct cm3391_chip *chip) cs_it = val * 1000000 + val2; lux = (__force u64)cs_info->mlux_per_bit; lux *= cs_info->mlux_per_bit_base_it; - lux = div_u64(lux, cs_it); + lux = div_u64(lux,cs_it); /* Get als_raw */ ret = i2c_smbus_read_word_data(client, CM3391_REG_ADDR_ALS); @@ -509,6 +516,34 @@ static int cm3391_write_raw(struct iio_dev *indio_dev, return -EINVAL; } +static ssize_t cm3391_set_enable_auto_it(struct device *dev, + struct device_attribute *attr, const char *buf, size_t size) +{ + int ret; + int val; + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct cm3391_chip *chip = iio_priv(indio_dev); + struct cm3391_cs_info *cs_info = chip->cs_info; + ret = sscanf(buf, "%i", &val); + if(ret != 1){ + return -EINVAL; + } + + cs_info->auto_it_enabled = val; + + return size; +} + +static ssize_t cm3391_get_enable_auto_it(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct cm3391_chip *chip = iio_priv(indio_dev); + struct cm3391_cs_info *cs_info = chip->cs_info; + int len; + len = sprintf(buf, "%i\n", cs_info->auto_it_enabled); + return len; +} /** * cm3391_get_it_available() - Get available CS IT value @@ -666,8 +701,12 @@ static const struct iio_chan_spec cm3391_channels[] = { static IIO_DEVICE_ATTR(in_illuminance_integration_time_available, S_IRUGO, cm3391_get_it_available, NULL, 0); +static IIO_DEVICE_ATTR(auto_it, + S_IRUGO | S_IWUGO, cm3391_get_enable_auto_it, cm3391_set_enable_auto_it, 0); + static struct attribute *cm3391_attributes[] = { &iio_dev_attr_in_illuminance_integration_time_available.dev_attr.attr, + &iio_dev_attr_auto_it.dev_attr.attr, NULL, }; |