staging: iio: tsl2x7x: add common function for clearing interrupts
There were three places where the same chunk of code was used to clear interrupts. This patch creates a common function tsl2x7x_clear_interrupts() to reduce duplicate code. Signed-off-by: Brian Masney <masneyb@onstation.org> Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
This commit is contained in:
parent
a4a214143e
commit
eac15d8ded
@ -279,6 +279,20 @@ static const u8 device_channel_config[] = {
|
||||
ALSPRX2
|
||||
};
|
||||
|
||||
static int tsl2x7x_clear_interrupts(struct tsl2X7X_chip *chip, int reg)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_write_byte(chip->client,
|
||||
TSL2X7X_CMD_REG | TSL2X7X_CMD_SPL_FN | reg);
|
||||
if (ret < 0)
|
||||
dev_err(&chip->client->dev,
|
||||
"%s: failed to clear interrupt status %x: %d\n",
|
||||
__func__, reg, ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/**
|
||||
* tsl2x7x_get_lux() - Reads and calculates current lux value.
|
||||
* @indio_dev: pointer to IIO device
|
||||
@ -346,16 +360,9 @@ static int tsl2x7x_get_lux(struct iio_dev *indio_dev)
|
||||
buf[i] = ret;
|
||||
}
|
||||
|
||||
/* clear any existing interrupt status */
|
||||
ret = i2c_smbus_write_byte(chip->client,
|
||||
TSL2X7X_CMD_REG |
|
||||
TSL2X7X_CMD_SPL_FN |
|
||||
TSL2X7X_CMD_ALS_INT_CLR);
|
||||
if (ret < 0) {
|
||||
dev_err(&chip->client->dev,
|
||||
"i2c_write_command failed - err = %d\n", ret);
|
||||
goto out_unlock; /* have no data, so return failure */
|
||||
}
|
||||
ret = tsl2x7x_clear_interrupts(chip, TSL2X7X_CMD_ALS_INT_CLR);
|
||||
if (ret < 0)
|
||||
goto out_unlock;
|
||||
|
||||
/* extract ALS/lux data */
|
||||
ch0 = le16_to_cpup((const __le16 *)&buf[0]);
|
||||
@ -706,17 +713,10 @@ static int tsl2x7x_chip_on(struct iio_dev *indio_dev)
|
||||
"%s: failed in tsl2x7x_IOCTL_INT_SET.\n",
|
||||
__func__);
|
||||
|
||||
/* Clear out any initial interrupts */
|
||||
ret = i2c_smbus_write_byte(chip->client,
|
||||
TSL2X7X_CMD_REG |
|
||||
TSL2X7X_CMD_SPL_FN |
|
||||
TSL2X7X_CMD_PROXALS_INT_CLR);
|
||||
if (ret < 0) {
|
||||
dev_err(&chip->client->dev,
|
||||
"%s: Failed to clear Int status\n",
|
||||
__func__);
|
||||
return ret;
|
||||
}
|
||||
ret = tsl2x7x_clear_interrupts(chip,
|
||||
TSL2X7X_CMD_PROXALS_INT_CLR);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
}
|
||||
|
||||
return ret;
|
||||
@ -1421,14 +1421,10 @@ static irqreturn_t tsl2x7x_event_handler(int irq, void *private)
|
||||
IIO_EV_DIR_EITHER),
|
||||
timestamp);
|
||||
}
|
||||
/* Clear interrupt now that we have handled it. */
|
||||
ret = i2c_smbus_write_byte(chip->client,
|
||||
TSL2X7X_CMD_REG | TSL2X7X_CMD_SPL_FN |
|
||||
TSL2X7X_CMD_PROXALS_INT_CLR);
|
||||
|
||||
ret = tsl2x7x_clear_interrupts(chip, TSL2X7X_CMD_PROXALS_INT_CLR);
|
||||
if (ret < 0)
|
||||
dev_err(&chip->client->dev,
|
||||
"Failed to clear irq from event handler. err = %d\n",
|
||||
ret);
|
||||
return ret;
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
Loading…
x
Reference in New Issue
Block a user