void clear_interrupt_status_work_func(struct work_struct *work)
{
struct stml0xx_data *ps_stml0xx = container_of(work,
struct stml0xx_data,
clear_interrupt_status_work);
uint8_t buf[3];
dev_dbg(&ps_stml0xx->spi->dev, "clear_interrupt_status_work_func");
mutex_lock(&ps_stml0xx->lock);
if (ps_stml0xx->mode == BOOTMODE)
goto EXIT;
if (ps_stml0xx->is_suspended)
goto EXIT;
stml0xx_wake(ps_stml0xx);
/* read interrupt mask register to clear
any interrupt during suspend state */
stml0xx_spi_send_read_reg(INTERRUPT_STATUS, buf, 3);
stml0xx_sleep(ps_stml0xx);
EXIT:
mutex_unlock(&ps_stml0xx->lock);
}
void stml0xx_irq_work_func(struct work_struct *work)
{
int err;
u32 irq_status;
struct stml0xx_data *ps_stml0xx = stml0xx_misc_data;
unsigned char buf[SPI_MSG_SIZE];
dev_dbg(&stml0xx_misc_data->spi->dev, "stml0xx_irq_work_func");
mutex_lock(&ps_stml0xx->lock);
stml0xx_wake(ps_stml0xx);
if (ps_stml0xx->mode == BOOTMODE)
goto EXIT;
if (ps_stml0xx->is_suspended)
goto EXIT;
/* read interrupt mask register */
err = stml0xx_spi_send_read_reg(INTERRUPT_STATUS, buf, 3);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading from stml0xx failed");
goto EXIT;
}
irq_status = (buf[IRQ_NOWAKE_HI] << 16) |
(buf[IRQ_NOWAKE_MED] << 8) | buf[IRQ_NOWAKE_LO];
if (irq_status & M_ACCEL) {
/* read accelerometer values from STML0XX */
err = stml0xx_spi_send_read_reg(ACCEL_X, buf, 6);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Accel from stml0xx failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_ACCEL, buf, 6, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending acc(x,y,z)values:x=%d,y=%d,z=%d",
STM16_TO_HOST(ACCEL_RD_X), STM16_TO_HOST(ACCEL_RD_Y),
STM16_TO_HOST(ACCEL_RD_Z));
}
if (irq_status & M_ACCEL2) {
/* read 2nd accelerometer values from STML0XX */
err = stml0xx_spi_send_read_reg(ACCEL2_X, buf, 6);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading 2nd Accel from stml0xx failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_ACCEL2, buf, 6, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending acc2(x,y,z)values:x=%d,y=%d,z=%d",
STM16_TO_HOST(ACCEL_RD_X), STM16_TO_HOST(ACCEL_RD_Y),
STM16_TO_HOST(ACCEL_RD_Z));
}
if (irq_status & M_LIN_ACCEL) {
dev_err(&stml0xx_misc_data->spi->dev,
"Invalid M_LIN_ACCEL bit set. irq_status = 0x%06x",
irq_status);
/* read linear accelerometer values from STML0XX */
err = stml0xx_spi_send_read_reg(LIN_ACCEL_X, buf, 6);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Linear Accel from stml0xx failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_LIN_ACCEL,
buf, 6, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending lin_acc(x,y,z)values:x=%d,y=%d,z=%d",
STM16_TO_HOST(ACCEL_RD_X), STM16_TO_HOST(ACCEL_RD_Y),
STM16_TO_HOST(ACCEL_RD_Z));
}
if (irq_status & M_ECOMPASS) {
unsigned char status;
/*Read orientation values */
err = stml0xx_spi_send_read_reg(MAG_HX, buf, 13);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Ecompass failed");
goto EXIT;
}
status = buf[COMPASS_STATUS];
stml0xx_as_data_buffer_write(ps_stml0xx, DT_MAG,
buf, 6, status);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending mag(x,y,z)values:x=%d,y=%d,z=%d",
STM16_TO_HOST(MAG_X), STM16_TO_HOST(MAG_Y),
STM16_TO_HOST(MAG_Z));
stml0xx_as_data_buffer_write(ps_stml0xx, DT_ORIENT,
buf + 6, 6, status);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending orient(x,y,z)values:x=%d,y=%d,z=%d",
STM16_TO_HOST(ORIENT_X), STM16_TO_HOST(ORIENT_Y),
STM16_TO_HOST(ORIENT_Z));
}
if (irq_status & M_GYRO) {
err = stml0xx_spi_send_read_reg(GYRO_X, buf, 6);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Gyroscope failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_GYRO, buf, 6, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending gyro(x,y,z)values:x=%d,y=%d,z=%d",
STM16_TO_HOST(GYRO_RD_X), STM16_TO_HOST(GYRO_RD_Y),
STM16_TO_HOST(GYRO_RD_Z));
}
/*MODIFIED UNCALIBRATED GYRO */
if (irq_status & M_UNCALIB_GYRO) {
err = stml0xx_spi_send_read_reg(UNCALIB_GYRO_X, buf, 12);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Gyroscope failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_UNCALIB_GYRO,
buf, 12, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending Gyro uncalib(x,y,z)values:%d,%d,%d;%d,%d,%d",
STM16_TO_HOST(GYRO_RD_X), STM16_TO_HOST(GYRO_RD_Y),
STM16_TO_HOST(GYRO_RD_Z),
STM16_TO_HOST(GYRO_UNCALIB_X),
STM16_TO_HOST(GYRO_UNCALIB_Y),
STM16_TO_HOST(GYRO_UNCALIB_Z));
}
if (irq_status & M_UNCALIB_MAG) {
err = stml0xx_spi_send_read_reg(UNCALIB_MAG_X, buf, 12);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Gyroscope failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_UNCALIB_MAG,
buf, 12, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending Gyro uncalib(x,y,z)values:%d,%d,%d;%d,%d,%d",
STM16_TO_HOST(MAG_X), STM16_TO_HOST(MAG_Y),
STM16_TO_HOST(MAG_Z), STM16_TO_HOST(MAG_UNCALIB_X),
STM16_TO_HOST(MAG_UNCALIB_Y),
STM16_TO_HOST(MAG_UNCALIB_Z));
}
if (irq_status & M_ALS) {
err = stml0xx_spi_send_read_reg(ALS_LUX, buf, 2);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading ALS from stml0xx failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_ALS, buf, 2, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending ALS %d", STM16_TO_HOST(ALS_VALUE));
}
if (irq_status & M_TEMPERATURE) {
/* Read temperature value */
err = stml0xx_spi_send_read_reg(TEMPERATURE_DATA, buf, 2);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Temperature failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_TEMP, buf, 2, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending temp(x)value:%d", STM16_TO_HOST(TEMP_VALUE));
}
if (irq_status & M_PRESSURE) {
dev_err(&stml0xx_misc_data->spi->dev,
"Invalid M_PRESSURE bit set. irq_status = 0x%06x",
irq_status);
/* Read pressure value */
err = stml0xx_spi_send_read_reg(CURRENT_PRESSURE, buf, 4);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Pressure failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_PRESSURE,
buf, 4, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending pressure %d", STM32_TO_HOST(PRESSURE_VALUE));
}
if (irq_status & M_GRAVITY) {
dev_err(&stml0xx_misc_data->spi->dev,
"Invalid M_GRAVITY bit set. irq_status = 0x%06x",
irq_status);
/* read gravity values from STML0XX */
err = stml0xx_spi_send_read_reg(GRAVITY_X, buf, 6);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Gravity from stml0xx failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_GRAVITY, buf, 6, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending gravity(x,y,z)values:x=%d,y=%d,z=%d",
STM16_TO_HOST(GRAV_X), STM16_TO_HOST(GRAV_Y),
STM16_TO_HOST(GRAV_Z));
}
if (irq_status & M_DISP_ROTATE) {
/* Read Display Rotate value */
err = stml0xx_spi_send_read_reg(DISP_ROTATE_DATA, buf, 1);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading disp_rotate failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_DISP_ROTATE,
buf, 1, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending disp_rotate(x)value: %d", buf[DISP_VALUE]);
}
if (irq_status & M_DISP_BRIGHTNESS) {
err = stml0xx_spi_send_read_reg(DISPLAY_BRIGHTNESS, buf, 1);
if (err < 0) {
dev_err(&stml0xx_misc_data->spi->dev,
"Reading Display Brightness failed");
goto EXIT;
}
stml0xx_as_data_buffer_write(ps_stml0xx, DT_DISP_BRIGHT,
buf, 1, 0);
dev_dbg(&stml0xx_misc_data->spi->dev,
"Sending Display Brightness %d", buf[DISP_VALUE]);
}
EXIT:
stml0xx_sleep(ps_stml0xx);
/* For now HAE needs events even if the activity is still */
mutex_unlock(&ps_stml0xx->lock);
wake_unlock(&ps_stml0xx->wakelock);
}
