staging: iio: tsl2583: fix issue with changes to calibscale and int_time not being set on the chip
When updating the in_illuminance_calibscale and in_illuminance_integration_time sysfs attributes, these values were not actually written to the chip. The chip would continue to use the old parameters. Extracted out tsl2583_set_als_gain() and tsl2583_set_als_time() functions that are now called when these sysfs attributes are updated. The chip initialization also calls these these new functions. Signed-off-by: Brian Masney <masneyb@onstation.org> Signed-off-by: Jonathan Cameron <jic23@kernel.org>
This commit is contained in:
parent
c908fb76b2
commit
2167769aed
|
@ -352,6 +352,51 @@ static int taos_als_calibrate(struct iio_dev *indio_dev)
|
|||
return (int)gain_trim_val;
|
||||
}
|
||||
|
||||
static int tsl2583_set_als_time(struct tsl2583_chip *chip)
|
||||
{
|
||||
int als_count, als_time, ret;
|
||||
u8 val;
|
||||
|
||||
/* determine als integration register */
|
||||
als_count = (chip->taos_settings.als_time * 100 + 135) / 270;
|
||||
if (!als_count)
|
||||
als_count = 1; /* ensure at least one cycle */
|
||||
|
||||
/* convert back to time (encompasses overrides) */
|
||||
als_time = (als_count * 27 + 5) / 10;
|
||||
|
||||
val = 256 - als_count;
|
||||
ret = i2c_smbus_write_byte_data(chip->client,
|
||||
TSL258X_CMD_REG | TSL258X_ALS_TIME,
|
||||
val);
|
||||
if (ret < 0) {
|
||||
dev_err(&chip->client->dev, "%s failed to set the als time to %d\n",
|
||||
__func__, val);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* set chip struct re scaling and saturation */
|
||||
chip->als_saturation = als_count * 922; /* 90% of full scale */
|
||||
chip->als_time_scale = (als_time + 25) / 50;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int tsl2583_set_als_gain(struct tsl2583_chip *chip)
|
||||
{
|
||||
int ret;
|
||||
|
||||
/* Set the gain based on taos_settings struct */
|
||||
ret = i2c_smbus_write_byte_data(chip->client,
|
||||
TSL258X_CMD_REG | TSL258X_GAIN,
|
||||
chip->taos_settings.als_gain);
|
||||
if (ret < 0)
|
||||
dev_err(&chip->client->dev, "%s failed to set the gain to %d\n",
|
||||
__func__, chip->taos_settings.als_gain);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int tsl2583_set_power_state(struct tsl2583_chip *chip, u8 state)
|
||||
{
|
||||
int ret;
|
||||
|
@ -371,10 +416,8 @@ static int tsl2583_set_power_state(struct tsl2583_chip *chip, u8 state)
|
|||
*/
|
||||
static int tsl2583_chip_init_and_power_on(struct iio_dev *indio_dev)
|
||||
{
|
||||
int ret, val;
|
||||
int als_count;
|
||||
int als_time;
|
||||
struct tsl2583_chip *chip = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
/* and make sure we're not already on */
|
||||
if (chip->taos_chip_status == TSL258X_CHIP_WORKING) {
|
||||
|
@ -397,37 +440,13 @@ static int tsl2583_chip_init_and_power_on(struct iio_dev *indio_dev)
|
|||
return ret;
|
||||
}
|
||||
|
||||
/* determine als integration register */
|
||||
als_count = (chip->taos_settings.als_time * 100 + 135) / 270;
|
||||
if (!als_count)
|
||||
als_count = 1; /* ensure at least one cycle */
|
||||
|
||||
/* convert back to time (encompasses overrides) */
|
||||
als_time = (als_count * 27 + 5) / 10;
|
||||
|
||||
val = 256 - als_count;
|
||||
ret = i2c_smbus_write_byte_data(chip->client,
|
||||
TSL258X_CMD_REG | TSL258X_ALS_TIME,
|
||||
val);
|
||||
if (ret < 0) {
|
||||
dev_err(&chip->client->dev, "%s failed to set the als time to %d\n",
|
||||
__func__, val);
|
||||
ret = tsl2583_set_als_time(chip);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Set the gain based on taos_settings struct */
|
||||
ret = i2c_smbus_write_byte_data(chip->client,
|
||||
TSL258X_CMD_REG | TSL258X_GAIN,
|
||||
chip->taos_settings.als_gain);
|
||||
if (ret < 0) {
|
||||
dev_err(&chip->client->dev, "%s failed to set the gain to %d\n",
|
||||
__func__, chip->taos_settings.als_gain);
|
||||
ret = tsl2583_set_als_gain(chip);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* set chip struct re scaling and saturation */
|
||||
chip->als_saturation = als_count * 922; /* 90% of full scale */
|
||||
chip->als_time_scale = (als_time + 25) / 50;
|
||||
|
||||
usleep_range(3000, 3500);
|
||||
|
||||
|
@ -707,7 +726,7 @@ static int tsl2583_write_raw(struct iio_dev *indio_dev,
|
|||
for (i = 0; i < ARRAY_SIZE(gainadj); i++) {
|
||||
if (gainadj[i].mean == val) {
|
||||
chip->taos_settings.als_gain = i;
|
||||
ret = 0;
|
||||
ret = tsl2583_set_als_gain(chip);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
@ -717,7 +736,7 @@ static int tsl2583_write_raw(struct iio_dev *indio_dev,
|
|||
if (chan->type == IIO_LIGHT && !val && val2 >= 50 &&
|
||||
val2 <= 650 && !(val2 % 50)) {
|
||||
chip->taos_settings.als_time = val2;
|
||||
ret = 0;
|
||||
ret = tsl2583_set_als_time(chip);
|
||||
}
|
||||
break;
|
||||
default:
|
||||
|
|
Loading…
Reference in New Issue