mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-28 11:49:32 +00:00
![Javier Martinez Canillas](/assets/img/avatar_default.png)
The I2C core always reports the MODALIAS uevent as "i2c:<client name" regardless if the driver was matched using the I2C id_table or the of_match_table. So technically there's no need for a driver to export the OF table since currently it's not used. In fact, the I2C device ID table is mandatory for I2C drivers since a i2c_device_id is passed to the driver's probe function even if the I2C core used the OF table to match the driver. And since the I2C core uses different tables, OF-only drivers needs to have duplicated data that has to be kept in sync and also the dev node compatible manufacturer prefix is stripped when reporting the MODALIAS. To avoid the above, the I2C core behavior may be changed in the future to not require an I2C device table for OF-only drivers and report the OF module alias. So, it's better to also export the OF table to prevent breaking module autoloading if that happens. Signed-off-by: Javier Martinez Canillas <javier@osg.samsung.com> Signed-off-by: Jonathan Cameron <jic23@kernel.org>
1654 lines
46 KiB
C
1654 lines
46 KiB
C
/*
|
|
* Copyright (C) 2013 Samsung Electronics Co., Ltd.
|
|
* Author: Jacek Anaszewski <j.anaszewski@samsung.com>
|
|
*
|
|
* IIO features supported by the driver:
|
|
*
|
|
* Read-only raw channels:
|
|
* - illuminance_clear [lux]
|
|
* - illuminance_ir
|
|
* - proximity
|
|
*
|
|
* Triggered buffer:
|
|
* - illuminance_clear
|
|
* - illuminance_ir
|
|
* - proximity
|
|
*
|
|
* Events:
|
|
* - illuminance_clear (rising and falling)
|
|
* - proximity (rising and falling)
|
|
* - both falling and rising thresholds for the proximity events
|
|
* must be set to the values greater than 0.
|
|
*
|
|
* The driver supports triggered buffers for all the three
|
|
* channels as well as high and low threshold events for the
|
|
* illuminance_clear and proxmimity channels. Triggers
|
|
* can be enabled simultaneously with both illuminance_clear
|
|
* events. Proximity events cannot be enabled simultaneously
|
|
* with any triggers or illuminance events. Enabling/disabling
|
|
* one of the proximity events automatically enables/disables
|
|
* the other one.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2, as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include <linux/debugfs.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/irq_work.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/of.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/regulator/consumer.h>
|
|
#include <linux/slab.h>
|
|
#include <asm/unaligned.h>
|
|
#include <linux/iio/buffer.h>
|
|
#include <linux/iio/events.h>
|
|
#include <linux/iio/iio.h>
|
|
#include <linux/iio/sysfs.h>
|
|
#include <linux/iio/trigger.h>
|
|
#include <linux/iio/trigger_consumer.h>
|
|
#include <linux/iio/triggered_buffer.h>
|
|
|
|
#define GP2A_I2C_NAME "gp2ap020a00f"
|
|
|
|
/* Registers */
|
|
#define GP2AP020A00F_OP_REG 0x00 /* Basic operations */
|
|
#define GP2AP020A00F_ALS_REG 0x01 /* ALS related settings */
|
|
#define GP2AP020A00F_PS_REG 0x02 /* PS related settings */
|
|
#define GP2AP020A00F_LED_REG 0x03 /* LED reg */
|
|
#define GP2AP020A00F_TL_L_REG 0x04 /* ALS: Threshold low LSB */
|
|
#define GP2AP020A00F_TL_H_REG 0x05 /* ALS: Threshold low MSB */
|
|
#define GP2AP020A00F_TH_L_REG 0x06 /* ALS: Threshold high LSB */
|
|
#define GP2AP020A00F_TH_H_REG 0x07 /* ALS: Threshold high MSB */
|
|
#define GP2AP020A00F_PL_L_REG 0x08 /* PS: Threshold low LSB */
|
|
#define GP2AP020A00F_PL_H_REG 0x09 /* PS: Threshold low MSB */
|
|
#define GP2AP020A00F_PH_L_REG 0x0a /* PS: Threshold high LSB */
|
|
#define GP2AP020A00F_PH_H_REG 0x0b /* PS: Threshold high MSB */
|
|
#define GP2AP020A00F_D0_L_REG 0x0c /* ALS result: Clear/Illuminance LSB */
|
|
#define GP2AP020A00F_D0_H_REG 0x0d /* ALS result: Clear/Illuminance MSB */
|
|
#define GP2AP020A00F_D1_L_REG 0x0e /* ALS result: IR LSB */
|
|
#define GP2AP020A00F_D1_H_REG 0x0f /* ALS result: IR LSB */
|
|
#define GP2AP020A00F_D2_L_REG 0x10 /* PS result LSB */
|
|
#define GP2AP020A00F_D2_H_REG 0x11 /* PS result MSB */
|
|
#define GP2AP020A00F_NUM_REGS 0x12 /* Number of registers */
|
|
|
|
/* OP_REG bits */
|
|
#define GP2AP020A00F_OP3_MASK 0x80 /* Software shutdown */
|
|
#define GP2AP020A00F_OP3_SHUTDOWN 0x00
|
|
#define GP2AP020A00F_OP3_OPERATION 0x80
|
|
#define GP2AP020A00F_OP2_MASK 0x40 /* Auto shutdown/Continuous mode */
|
|
#define GP2AP020A00F_OP2_AUTO_SHUTDOWN 0x00
|
|
#define GP2AP020A00F_OP2_CONT_OPERATION 0x40
|
|
#define GP2AP020A00F_OP_MASK 0x30 /* Operating mode selection */
|
|
#define GP2AP020A00F_OP_ALS_AND_PS 0x00
|
|
#define GP2AP020A00F_OP_ALS 0x10
|
|
#define GP2AP020A00F_OP_PS 0x20
|
|
#define GP2AP020A00F_OP_DEBUG 0x30
|
|
#define GP2AP020A00F_PROX_MASK 0x08 /* PS: detection/non-detection */
|
|
#define GP2AP020A00F_PROX_NON_DETECT 0x00
|
|
#define GP2AP020A00F_PROX_DETECT 0x08
|
|
#define GP2AP020A00F_FLAG_P 0x04 /* PS: interrupt result */
|
|
#define GP2AP020A00F_FLAG_A 0x02 /* ALS: interrupt result */
|
|
#define GP2AP020A00F_TYPE_MASK 0x01 /* Output data type selection */
|
|
#define GP2AP020A00F_TYPE_MANUAL_CALC 0x00
|
|
#define GP2AP020A00F_TYPE_AUTO_CALC 0x01
|
|
|
|
/* ALS_REG bits */
|
|
#define GP2AP020A00F_PRST_MASK 0xc0 /* Number of measurement cycles */
|
|
#define GP2AP020A00F_PRST_ONCE 0x00
|
|
#define GP2AP020A00F_PRST_4_CYCLES 0x40
|
|
#define GP2AP020A00F_PRST_8_CYCLES 0x80
|
|
#define GP2AP020A00F_PRST_16_CYCLES 0xc0
|
|
#define GP2AP020A00F_RES_A_MASK 0x38 /* ALS: Resolution */
|
|
#define GP2AP020A00F_RES_A_800ms 0x00
|
|
#define GP2AP020A00F_RES_A_400ms 0x08
|
|
#define GP2AP020A00F_RES_A_200ms 0x10
|
|
#define GP2AP020A00F_RES_A_100ms 0x18
|
|
#define GP2AP020A00F_RES_A_25ms 0x20
|
|
#define GP2AP020A00F_RES_A_6_25ms 0x28
|
|
#define GP2AP020A00F_RES_A_1_56ms 0x30
|
|
#define GP2AP020A00F_RES_A_0_39ms 0x38
|
|
#define GP2AP020A00F_RANGE_A_MASK 0x07 /* ALS: Max measurable range */
|
|
#define GP2AP020A00F_RANGE_A_x1 0x00
|
|
#define GP2AP020A00F_RANGE_A_x2 0x01
|
|
#define GP2AP020A00F_RANGE_A_x4 0x02
|
|
#define GP2AP020A00F_RANGE_A_x8 0x03
|
|
#define GP2AP020A00F_RANGE_A_x16 0x04
|
|
#define GP2AP020A00F_RANGE_A_x32 0x05
|
|
#define GP2AP020A00F_RANGE_A_x64 0x06
|
|
#define GP2AP020A00F_RANGE_A_x128 0x07
|
|
|
|
/* PS_REG bits */
|
|
#define GP2AP020A00F_ALC_MASK 0x80 /* Auto light cancel */
|
|
#define GP2AP020A00F_ALC_ON 0x80
|
|
#define GP2AP020A00F_ALC_OFF 0x00
|
|
#define GP2AP020A00F_INTTYPE_MASK 0x40 /* Interrupt type setting */
|
|
#define GP2AP020A00F_INTTYPE_LEVEL 0x00
|
|
#define GP2AP020A00F_INTTYPE_PULSE 0x40
|
|
#define GP2AP020A00F_RES_P_MASK 0x38 /* PS: Resolution */
|
|
#define GP2AP020A00F_RES_P_800ms_x2 0x00
|
|
#define GP2AP020A00F_RES_P_400ms_x2 0x08
|
|
#define GP2AP020A00F_RES_P_200ms_x2 0x10
|
|
#define GP2AP020A00F_RES_P_100ms_x2 0x18
|
|
#define GP2AP020A00F_RES_P_25ms_x2 0x20
|
|
#define GP2AP020A00F_RES_P_6_25ms_x2 0x28
|
|
#define GP2AP020A00F_RES_P_1_56ms_x2 0x30
|
|
#define GP2AP020A00F_RES_P_0_39ms_x2 0x38
|
|
#define GP2AP020A00F_RANGE_P_MASK 0x07 /* PS: Max measurable range */
|
|
#define GP2AP020A00F_RANGE_P_x1 0x00
|
|
#define GP2AP020A00F_RANGE_P_x2 0x01
|
|
#define GP2AP020A00F_RANGE_P_x4 0x02
|
|
#define GP2AP020A00F_RANGE_P_x8 0x03
|
|
#define GP2AP020A00F_RANGE_P_x16 0x04
|
|
#define GP2AP020A00F_RANGE_P_x32 0x05
|
|
#define GP2AP020A00F_RANGE_P_x64 0x06
|
|
#define GP2AP020A00F_RANGE_P_x128 0x07
|
|
|
|
/* LED reg bits */
|
|
#define GP2AP020A00F_INTVAL_MASK 0xc0 /* Intermittent operating */
|
|
#define GP2AP020A00F_INTVAL_0 0x00
|
|
#define GP2AP020A00F_INTVAL_4 0x40
|
|
#define GP2AP020A00F_INTVAL_8 0x80
|
|
#define GP2AP020A00F_INTVAL_16 0xc0
|
|
#define GP2AP020A00F_IS_MASK 0x30 /* ILED drive peak current */
|
|
#define GP2AP020A00F_IS_13_8mA 0x00
|
|
#define GP2AP020A00F_IS_27_5mA 0x10
|
|
#define GP2AP020A00F_IS_55mA 0x20
|
|
#define GP2AP020A00F_IS_110mA 0x30
|
|
#define GP2AP020A00F_PIN_MASK 0x0c /* INT terminal setting */
|
|
#define GP2AP020A00F_PIN_ALS_OR_PS 0x00
|
|
#define GP2AP020A00F_PIN_ALS 0x04
|
|
#define GP2AP020A00F_PIN_PS 0x08
|
|
#define GP2AP020A00F_PIN_PS_DETECT 0x0c
|
|
#define GP2AP020A00F_FREQ_MASK 0x02 /* LED modulation frequency */
|
|
#define GP2AP020A00F_FREQ_327_5kHz 0x00
|
|
#define GP2AP020A00F_FREQ_81_8kHz 0x02
|
|
#define GP2AP020A00F_RST 0x01 /* Software reset */
|
|
|
|
#define GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR 0
|
|
#define GP2AP020A00F_SCAN_MODE_LIGHT_IR 1
|
|
#define GP2AP020A00F_SCAN_MODE_PROXIMITY 2
|
|
#define GP2AP020A00F_CHAN_TIMESTAMP 3
|
|
|
|
#define GP2AP020A00F_DATA_READY_TIMEOUT msecs_to_jiffies(1000)
|
|
#define GP2AP020A00F_DATA_REG(chan) (GP2AP020A00F_D0_L_REG + \
|
|
(chan) * 2)
|
|
#define GP2AP020A00F_THRESH_REG(th_val_id) (GP2AP020A00F_TL_L_REG + \
|
|
(th_val_id) * 2)
|
|
#define GP2AP020A00F_THRESH_VAL_ID(reg_addr) ((reg_addr - 4) / 2)
|
|
|
|
#define GP2AP020A00F_SUBTRACT_MODE 0
|
|
#define GP2AP020A00F_ADD_MODE 1
|
|
|
|
#define GP2AP020A00F_MAX_CHANNELS 3
|
|
|
|
enum gp2ap020a00f_opmode {
|
|
GP2AP020A00F_OPMODE_READ_RAW_CLEAR,
|
|
GP2AP020A00F_OPMODE_READ_RAW_IR,
|
|
GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY,
|
|
GP2AP020A00F_OPMODE_ALS,
|
|
GP2AP020A00F_OPMODE_PS,
|
|
GP2AP020A00F_OPMODE_ALS_AND_PS,
|
|
GP2AP020A00F_OPMODE_PROX_DETECT,
|
|
GP2AP020A00F_OPMODE_SHUTDOWN,
|
|
GP2AP020A00F_NUM_OPMODES,
|
|
};
|
|
|
|
enum gp2ap020a00f_cmd {
|
|
GP2AP020A00F_CMD_READ_RAW_CLEAR,
|
|
GP2AP020A00F_CMD_READ_RAW_IR,
|
|
GP2AP020A00F_CMD_READ_RAW_PROXIMITY,
|
|
GP2AP020A00F_CMD_TRIGGER_CLEAR_EN,
|
|
GP2AP020A00F_CMD_TRIGGER_CLEAR_DIS,
|
|
GP2AP020A00F_CMD_TRIGGER_IR_EN,
|
|
GP2AP020A00F_CMD_TRIGGER_IR_DIS,
|
|
GP2AP020A00F_CMD_TRIGGER_PROX_EN,
|
|
GP2AP020A00F_CMD_TRIGGER_PROX_DIS,
|
|
GP2AP020A00F_CMD_ALS_HIGH_EV_EN,
|
|
GP2AP020A00F_CMD_ALS_HIGH_EV_DIS,
|
|
GP2AP020A00F_CMD_ALS_LOW_EV_EN,
|
|
GP2AP020A00F_CMD_ALS_LOW_EV_DIS,
|
|
GP2AP020A00F_CMD_PROX_HIGH_EV_EN,
|
|
GP2AP020A00F_CMD_PROX_HIGH_EV_DIS,
|
|
GP2AP020A00F_CMD_PROX_LOW_EV_EN,
|
|
GP2AP020A00F_CMD_PROX_LOW_EV_DIS,
|
|
};
|
|
|
|
enum gp2ap020a00f_flags {
|
|
GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER,
|
|
GP2AP020A00F_FLAG_ALS_IR_TRIGGER,
|
|
GP2AP020A00F_FLAG_PROX_TRIGGER,
|
|
GP2AP020A00F_FLAG_PROX_RISING_EV,
|
|
GP2AP020A00F_FLAG_PROX_FALLING_EV,
|
|
GP2AP020A00F_FLAG_ALS_RISING_EV,
|
|
GP2AP020A00F_FLAG_ALS_FALLING_EV,
|
|
GP2AP020A00F_FLAG_LUX_MODE_HI,
|
|
GP2AP020A00F_FLAG_DATA_READY,
|
|
};
|
|
|
|
enum gp2ap020a00f_thresh_val_id {
|
|
GP2AP020A00F_THRESH_TL,
|
|
GP2AP020A00F_THRESH_TH,
|
|
GP2AP020A00F_THRESH_PL,
|
|
GP2AP020A00F_THRESH_PH,
|
|
};
|
|
|
|
struct gp2ap020a00f_data {
|
|
const struct gp2ap020a00f_platform_data *pdata;
|
|
struct i2c_client *client;
|
|
struct mutex lock;
|
|
char *buffer;
|
|
struct regulator *vled_reg;
|
|
unsigned long flags;
|
|
enum gp2ap020a00f_opmode cur_opmode;
|
|
struct iio_trigger *trig;
|
|
struct regmap *regmap;
|
|
unsigned int thresh_val[4];
|
|
u8 debug_reg_addr;
|
|
struct irq_work work;
|
|
wait_queue_head_t data_ready_queue;
|
|
};
|
|
|
|
static const u8 gp2ap020a00f_reg_init_tab[] = {
|
|
[GP2AP020A00F_OP_REG] = GP2AP020A00F_OP3_SHUTDOWN,
|
|
[GP2AP020A00F_ALS_REG] = GP2AP020A00F_RES_A_25ms |
|
|
GP2AP020A00F_RANGE_A_x8,
|
|
[GP2AP020A00F_PS_REG] = GP2AP020A00F_ALC_ON |
|
|
GP2AP020A00F_RES_P_1_56ms_x2 |
|
|
GP2AP020A00F_RANGE_P_x4,
|
|
[GP2AP020A00F_LED_REG] = GP2AP020A00F_INTVAL_0 |
|
|
GP2AP020A00F_IS_110mA |
|
|
GP2AP020A00F_FREQ_327_5kHz,
|
|
[GP2AP020A00F_TL_L_REG] = 0,
|
|
[GP2AP020A00F_TL_H_REG] = 0,
|
|
[GP2AP020A00F_TH_L_REG] = 0,
|
|
[GP2AP020A00F_TH_H_REG] = 0,
|
|
[GP2AP020A00F_PL_L_REG] = 0,
|
|
[GP2AP020A00F_PL_H_REG] = 0,
|
|
[GP2AP020A00F_PH_L_REG] = 0,
|
|
[GP2AP020A00F_PH_H_REG] = 0,
|
|
};
|
|
|
|
static bool gp2ap020a00f_is_volatile_reg(struct device *dev, unsigned int reg)
|
|
{
|
|
switch (reg) {
|
|
case GP2AP020A00F_OP_REG:
|
|
case GP2AP020A00F_D0_L_REG:
|
|
case GP2AP020A00F_D0_H_REG:
|
|
case GP2AP020A00F_D1_L_REG:
|
|
case GP2AP020A00F_D1_H_REG:
|
|
case GP2AP020A00F_D2_L_REG:
|
|
case GP2AP020A00F_D2_H_REG:
|
|
return true;
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static const struct regmap_config gp2ap020a00f_regmap_config = {
|
|
.reg_bits = 8,
|
|
.val_bits = 8,
|
|
|
|
.max_register = GP2AP020A00F_D2_H_REG,
|
|
.cache_type = REGCACHE_RBTREE,
|
|
|
|
.volatile_reg = gp2ap020a00f_is_volatile_reg,
|
|
};
|
|
|
|
static const struct gp2ap020a00f_mutable_config_regs {
|
|
u8 op_reg;
|
|
u8 als_reg;
|
|
u8 ps_reg;
|
|
u8 led_reg;
|
|
} opmode_regs_settings[GP2AP020A00F_NUM_OPMODES] = {
|
|
[GP2AP020A00F_OPMODE_READ_RAW_CLEAR] = {
|
|
GP2AP020A00F_OP_ALS | GP2AP020A00F_OP2_CONT_OPERATION
|
|
| GP2AP020A00F_OP3_OPERATION
|
|
| GP2AP020A00F_TYPE_AUTO_CALC,
|
|
GP2AP020A00F_PRST_ONCE,
|
|
GP2AP020A00F_INTTYPE_LEVEL,
|
|
GP2AP020A00F_PIN_ALS
|
|
},
|
|
[GP2AP020A00F_OPMODE_READ_RAW_IR] = {
|
|
GP2AP020A00F_OP_ALS | GP2AP020A00F_OP2_CONT_OPERATION
|
|
| GP2AP020A00F_OP3_OPERATION
|
|
| GP2AP020A00F_TYPE_MANUAL_CALC,
|
|
GP2AP020A00F_PRST_ONCE,
|
|
GP2AP020A00F_INTTYPE_LEVEL,
|
|
GP2AP020A00F_PIN_ALS
|
|
},
|
|
[GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY] = {
|
|
GP2AP020A00F_OP_PS | GP2AP020A00F_OP2_CONT_OPERATION
|
|
| GP2AP020A00F_OP3_OPERATION
|
|
| GP2AP020A00F_TYPE_MANUAL_CALC,
|
|
GP2AP020A00F_PRST_ONCE,
|
|
GP2AP020A00F_INTTYPE_LEVEL,
|
|
GP2AP020A00F_PIN_PS
|
|
},
|
|
[GP2AP020A00F_OPMODE_PROX_DETECT] = {
|
|
GP2AP020A00F_OP_PS | GP2AP020A00F_OP2_CONT_OPERATION
|
|
| GP2AP020A00F_OP3_OPERATION
|
|
| GP2AP020A00F_TYPE_MANUAL_CALC,
|
|
GP2AP020A00F_PRST_4_CYCLES,
|
|
GP2AP020A00F_INTTYPE_PULSE,
|
|
GP2AP020A00F_PIN_PS_DETECT
|
|
},
|
|
[GP2AP020A00F_OPMODE_ALS] = {
|
|
GP2AP020A00F_OP_ALS | GP2AP020A00F_OP2_CONT_OPERATION
|
|
| GP2AP020A00F_OP3_OPERATION
|
|
| GP2AP020A00F_TYPE_AUTO_CALC,
|
|
GP2AP020A00F_PRST_ONCE,
|
|
GP2AP020A00F_INTTYPE_LEVEL,
|
|
GP2AP020A00F_PIN_ALS
|
|
},
|
|
[GP2AP020A00F_OPMODE_PS] = {
|
|
GP2AP020A00F_OP_PS | GP2AP020A00F_OP2_CONT_OPERATION
|
|
| GP2AP020A00F_OP3_OPERATION
|
|
| GP2AP020A00F_TYPE_MANUAL_CALC,
|
|
GP2AP020A00F_PRST_4_CYCLES,
|
|
GP2AP020A00F_INTTYPE_LEVEL,
|
|
GP2AP020A00F_PIN_PS
|
|
},
|
|
[GP2AP020A00F_OPMODE_ALS_AND_PS] = {
|
|
GP2AP020A00F_OP_ALS_AND_PS
|
|
| GP2AP020A00F_OP2_CONT_OPERATION
|
|
| GP2AP020A00F_OP3_OPERATION
|
|
| GP2AP020A00F_TYPE_AUTO_CALC,
|
|
GP2AP020A00F_PRST_4_CYCLES,
|
|
GP2AP020A00F_INTTYPE_LEVEL,
|
|
GP2AP020A00F_PIN_ALS_OR_PS
|
|
},
|
|
[GP2AP020A00F_OPMODE_SHUTDOWN] = { GP2AP020A00F_OP3_SHUTDOWN, },
|
|
};
|
|
|
|
static int gp2ap020a00f_set_operation_mode(struct gp2ap020a00f_data *data,
|
|
enum gp2ap020a00f_opmode op)
|
|
{
|
|
unsigned int op_reg_val;
|
|
int err;
|
|
|
|
if (op != GP2AP020A00F_OPMODE_SHUTDOWN) {
|
|
err = regmap_read(data->regmap, GP2AP020A00F_OP_REG,
|
|
&op_reg_val);
|
|
if (err < 0)
|
|
return err;
|
|
/*
|
|
* Shutdown the device if the operation being executed entails
|
|
* mode transition.
|
|
*/
|
|
if ((opmode_regs_settings[op].op_reg & GP2AP020A00F_OP_MASK) !=
|
|
(op_reg_val & GP2AP020A00F_OP_MASK)) {
|
|
/* set shutdown mode */
|
|
err = regmap_update_bits(data->regmap,
|
|
GP2AP020A00F_OP_REG, GP2AP020A00F_OP3_MASK,
|
|
GP2AP020A00F_OP3_SHUTDOWN);
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
|
|
err = regmap_update_bits(data->regmap, GP2AP020A00F_ALS_REG,
|
|
GP2AP020A00F_PRST_MASK, opmode_regs_settings[op]
|
|
.als_reg);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = regmap_update_bits(data->regmap, GP2AP020A00F_PS_REG,
|
|
GP2AP020A00F_INTTYPE_MASK, opmode_regs_settings[op]
|
|
.ps_reg);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = regmap_update_bits(data->regmap, GP2AP020A00F_LED_REG,
|
|
GP2AP020A00F_PIN_MASK, opmode_regs_settings[op]
|
|
.led_reg);
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
|
|
/* Set OP_REG and apply operation mode (power on / off) */
|
|
err = regmap_update_bits(data->regmap,
|
|
GP2AP020A00F_OP_REG,
|
|
GP2AP020A00F_OP_MASK | GP2AP020A00F_OP2_MASK |
|
|
GP2AP020A00F_OP3_MASK | GP2AP020A00F_TYPE_MASK,
|
|
opmode_regs_settings[op].op_reg);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
data->cur_opmode = op;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static bool gp2ap020a00f_als_enabled(struct gp2ap020a00f_data *data)
|
|
{
|
|
return test_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &data->flags) ||
|
|
test_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &data->flags) ||
|
|
test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags) ||
|
|
test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags);
|
|
}
|
|
|
|
static bool gp2ap020a00f_prox_detect_enabled(struct gp2ap020a00f_data *data)
|
|
{
|
|
return test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags) ||
|
|
test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags);
|
|
}
|
|
|
|
static int gp2ap020a00f_write_event_threshold(struct gp2ap020a00f_data *data,
|
|
enum gp2ap020a00f_thresh_val_id th_val_id,
|
|
bool enable)
|
|
{
|
|
__le16 thresh_buf = 0;
|
|
unsigned int thresh_reg_val;
|
|
|
|
if (!enable)
|
|
thresh_reg_val = 0;
|
|
else if (test_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags) &&
|
|
th_val_id != GP2AP020A00F_THRESH_PL &&
|
|
th_val_id != GP2AP020A00F_THRESH_PH)
|
|
/*
|
|
* For the high lux mode ALS threshold has to be scaled down
|
|
* to allow for proper comparison with the output value.
|
|
*/
|
|
thresh_reg_val = data->thresh_val[th_val_id] / 16;
|
|
else
|
|
thresh_reg_val = data->thresh_val[th_val_id] > 16000 ?
|
|
16000 :
|
|
data->thresh_val[th_val_id];
|
|
|
|
thresh_buf = cpu_to_le16(thresh_reg_val);
|
|
|
|
return regmap_bulk_write(data->regmap,
|
|
GP2AP020A00F_THRESH_REG(th_val_id),
|
|
(u8 *)&thresh_buf, 2);
|
|
}
|
|
|
|
static int gp2ap020a00f_alter_opmode(struct gp2ap020a00f_data *data,
|
|
enum gp2ap020a00f_opmode diff_mode, int add_sub)
|
|
{
|
|
enum gp2ap020a00f_opmode new_mode;
|
|
|
|
if (diff_mode != GP2AP020A00F_OPMODE_ALS &&
|
|
diff_mode != GP2AP020A00F_OPMODE_PS)
|
|
return -EINVAL;
|
|
|
|
if (add_sub == GP2AP020A00F_ADD_MODE) {
|
|
if (data->cur_opmode == GP2AP020A00F_OPMODE_SHUTDOWN)
|
|
new_mode = diff_mode;
|
|
else
|
|
new_mode = GP2AP020A00F_OPMODE_ALS_AND_PS;
|
|
} else {
|
|
if (data->cur_opmode == GP2AP020A00F_OPMODE_ALS_AND_PS)
|
|
new_mode = (diff_mode == GP2AP020A00F_OPMODE_ALS) ?
|
|
GP2AP020A00F_OPMODE_PS :
|
|
GP2AP020A00F_OPMODE_ALS;
|
|
else
|
|
new_mode = GP2AP020A00F_OPMODE_SHUTDOWN;
|
|
}
|
|
|
|
return gp2ap020a00f_set_operation_mode(data, new_mode);
|
|
}
|
|
|
|
static int gp2ap020a00f_exec_cmd(struct gp2ap020a00f_data *data,
|
|
enum gp2ap020a00f_cmd cmd)
|
|
{
|
|
int err = 0;
|
|
|
|
switch (cmd) {
|
|
case GP2AP020A00F_CMD_READ_RAW_CLEAR:
|
|
if (data->cur_opmode != GP2AP020A00F_OPMODE_SHUTDOWN)
|
|
return -EBUSY;
|
|
err = gp2ap020a00f_set_operation_mode(data,
|
|
GP2AP020A00F_OPMODE_READ_RAW_CLEAR);
|
|
break;
|
|
case GP2AP020A00F_CMD_READ_RAW_IR:
|
|
if (data->cur_opmode != GP2AP020A00F_OPMODE_SHUTDOWN)
|
|
return -EBUSY;
|
|
err = gp2ap020a00f_set_operation_mode(data,
|
|
GP2AP020A00F_OPMODE_READ_RAW_IR);
|
|
break;
|
|
case GP2AP020A00F_CMD_READ_RAW_PROXIMITY:
|
|
if (data->cur_opmode != GP2AP020A00F_OPMODE_SHUTDOWN)
|
|
return -EBUSY;
|
|
err = gp2ap020a00f_set_operation_mode(data,
|
|
GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY);
|
|
break;
|
|
case GP2AP020A00F_CMD_TRIGGER_CLEAR_EN:
|
|
if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT)
|
|
return -EBUSY;
|
|
if (!gp2ap020a00f_als_enabled(data))
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_ALS,
|
|
GP2AP020A00F_ADD_MODE);
|
|
set_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &data->flags);
|
|
break;
|
|
case GP2AP020A00F_CMD_TRIGGER_CLEAR_DIS:
|
|
clear_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &data->flags);
|
|
if (gp2ap020a00f_als_enabled(data))
|
|
break;
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_ALS,
|
|
GP2AP020A00F_SUBTRACT_MODE);
|
|
break;
|
|
case GP2AP020A00F_CMD_TRIGGER_IR_EN:
|
|
if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT)
|
|
return -EBUSY;
|
|
if (!gp2ap020a00f_als_enabled(data))
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_ALS,
|
|
GP2AP020A00F_ADD_MODE);
|
|
set_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &data->flags);
|
|
break;
|
|
case GP2AP020A00F_CMD_TRIGGER_IR_DIS:
|
|
clear_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &data->flags);
|
|
if (gp2ap020a00f_als_enabled(data))
|
|
break;
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_ALS,
|
|
GP2AP020A00F_SUBTRACT_MODE);
|
|
break;
|
|
case GP2AP020A00F_CMD_TRIGGER_PROX_EN:
|
|
if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT)
|
|
return -EBUSY;
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_PS,
|
|
GP2AP020A00F_ADD_MODE);
|
|
set_bit(GP2AP020A00F_FLAG_PROX_TRIGGER, &data->flags);
|
|
break;
|
|
case GP2AP020A00F_CMD_TRIGGER_PROX_DIS:
|
|
clear_bit(GP2AP020A00F_FLAG_PROX_TRIGGER, &data->flags);
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_PS,
|
|
GP2AP020A00F_SUBTRACT_MODE);
|
|
break;
|
|
case GP2AP020A00F_CMD_ALS_HIGH_EV_EN:
|
|
if (test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags))
|
|
return 0;
|
|
if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT)
|
|
return -EBUSY;
|
|
if (!gp2ap020a00f_als_enabled(data)) {
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_ALS,
|
|
GP2AP020A00F_ADD_MODE);
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
set_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags);
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_TH, true);
|
|
break;
|
|
case GP2AP020A00F_CMD_ALS_HIGH_EV_DIS:
|
|
if (!test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags))
|
|
return 0;
|
|
clear_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags);
|
|
if (!gp2ap020a00f_als_enabled(data)) {
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_ALS,
|
|
GP2AP020A00F_SUBTRACT_MODE);
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_TH, false);
|
|
break;
|
|
case GP2AP020A00F_CMD_ALS_LOW_EV_EN:
|
|
if (test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags))
|
|
return 0;
|
|
if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT)
|
|
return -EBUSY;
|
|
if (!gp2ap020a00f_als_enabled(data)) {
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_ALS,
|
|
GP2AP020A00F_ADD_MODE);
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
set_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags);
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_TL, true);
|
|
break;
|
|
case GP2AP020A00F_CMD_ALS_LOW_EV_DIS:
|
|
if (!test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags))
|
|
return 0;
|
|
clear_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags);
|
|
if (!gp2ap020a00f_als_enabled(data)) {
|
|
err = gp2ap020a00f_alter_opmode(data,
|
|
GP2AP020A00F_OPMODE_ALS,
|
|
GP2AP020A00F_SUBTRACT_MODE);
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_TL, false);
|
|
break;
|
|
case GP2AP020A00F_CMD_PROX_HIGH_EV_EN:
|
|
if (test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags))
|
|
return 0;
|
|
if (gp2ap020a00f_als_enabled(data) ||
|
|
data->cur_opmode == GP2AP020A00F_OPMODE_PS)
|
|
return -EBUSY;
|
|
if (!gp2ap020a00f_prox_detect_enabled(data)) {
|
|
err = gp2ap020a00f_set_operation_mode(data,
|
|
GP2AP020A00F_OPMODE_PROX_DETECT);
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
set_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags);
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_PH, true);
|
|
break;
|
|
case GP2AP020A00F_CMD_PROX_HIGH_EV_DIS:
|
|
if (!test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags))
|
|
return 0;
|
|
clear_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags);
|
|
err = gp2ap020a00f_set_operation_mode(data,
|
|
GP2AP020A00F_OPMODE_SHUTDOWN);
|
|
if (err < 0)
|
|
return err;
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_PH, false);
|
|
break;
|
|
case GP2AP020A00F_CMD_PROX_LOW_EV_EN:
|
|
if (test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags))
|
|
return 0;
|
|
if (gp2ap020a00f_als_enabled(data) ||
|
|
data->cur_opmode == GP2AP020A00F_OPMODE_PS)
|
|
return -EBUSY;
|
|
if (!gp2ap020a00f_prox_detect_enabled(data)) {
|
|
err = gp2ap020a00f_set_operation_mode(data,
|
|
GP2AP020A00F_OPMODE_PROX_DETECT);
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
set_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags);
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_PL, true);
|
|
break;
|
|
case GP2AP020A00F_CMD_PROX_LOW_EV_DIS:
|
|
if (!test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags))
|
|
return 0;
|
|
clear_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags);
|
|
err = gp2ap020a00f_set_operation_mode(data,
|
|
GP2AP020A00F_OPMODE_SHUTDOWN);
|
|
if (err < 0)
|
|
return err;
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_PL, false);
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
static int wait_conversion_complete_irq(struct gp2ap020a00f_data *data)
|
|
{
|
|
int ret;
|
|
|
|
ret = wait_event_timeout(data->data_ready_queue,
|
|
test_bit(GP2AP020A00F_FLAG_DATA_READY,
|
|
&data->flags),
|
|
GP2AP020A00F_DATA_READY_TIMEOUT);
|
|
clear_bit(GP2AP020A00F_FLAG_DATA_READY, &data->flags);
|
|
|
|
return ret > 0 ? 0 : -ETIME;
|
|
}
|
|
|
|
static int gp2ap020a00f_read_output(struct gp2ap020a00f_data *data,
|
|
unsigned int output_reg, int *val)
|
|
{
|
|
u8 reg_buf[2];
|
|
int err;
|
|
|
|
err = wait_conversion_complete_irq(data);
|
|
if (err < 0)
|
|
dev_dbg(&data->client->dev, "data ready timeout\n");
|
|
|
|
err = regmap_bulk_read(data->regmap, output_reg, reg_buf, 2);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
*val = le16_to_cpup((__le16 *)reg_buf);
|
|
|
|
return err;
|
|
}
|
|
|
|
static bool gp2ap020a00f_adjust_lux_mode(struct gp2ap020a00f_data *data,
|
|
int output_val)
|
|
{
|
|
u8 new_range = 0xff;
|
|
int err;
|
|
|
|
if (!test_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags)) {
|
|
if (output_val > 16000) {
|
|
set_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags);
|
|
new_range = GP2AP020A00F_RANGE_A_x128;
|
|
}
|
|
} else {
|
|
if (output_val < 1000) {
|
|
clear_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags);
|
|
new_range = GP2AP020A00F_RANGE_A_x8;
|
|
}
|
|
}
|
|
|
|
if (new_range != 0xff) {
|
|
/* Clear als threshold registers to avoid spurious
|
|
* events caused by lux mode transition.
|
|
*/
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_TH, false);
|
|
if (err < 0) {
|
|
dev_err(&data->client->dev,
|
|
"Clearing als threshold register failed.\n");
|
|
return false;
|
|
}
|
|
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_TL, false);
|
|
if (err < 0) {
|
|
dev_err(&data->client->dev,
|
|
"Clearing als threshold register failed.\n");
|
|
return false;
|
|
}
|
|
|
|
/* Change lux mode */
|
|
err = regmap_update_bits(data->regmap,
|
|
GP2AP020A00F_OP_REG,
|
|
GP2AP020A00F_OP3_MASK,
|
|
GP2AP020A00F_OP3_SHUTDOWN);
|
|
|
|
if (err < 0) {
|
|
dev_err(&data->client->dev,
|
|
"Shutting down the device failed.\n");
|
|
return false;
|
|
}
|
|
|
|
err = regmap_update_bits(data->regmap,
|
|
GP2AP020A00F_ALS_REG,
|
|
GP2AP020A00F_RANGE_A_MASK,
|
|
new_range);
|
|
|
|
if (err < 0) {
|
|
dev_err(&data->client->dev,
|
|
"Adjusting device lux mode failed.\n");
|
|
return false;
|
|
}
|
|
|
|
err = regmap_update_bits(data->regmap,
|
|
GP2AP020A00F_OP_REG,
|
|
GP2AP020A00F_OP3_MASK,
|
|
GP2AP020A00F_OP3_OPERATION);
|
|
|
|
if (err < 0) {
|
|
dev_err(&data->client->dev,
|
|
"Powering up the device failed.\n");
|
|
return false;
|
|
}
|
|
|
|
/* Adjust als threshold register values to the new lux mode */
|
|
if (test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags)) {
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_TH, true);
|
|
if (err < 0) {
|
|
dev_err(&data->client->dev,
|
|
"Adjusting als threshold value failed.\n");
|
|
return false;
|
|
}
|
|
}
|
|
|
|
if (test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags)) {
|
|
err = gp2ap020a00f_write_event_threshold(data,
|
|
GP2AP020A00F_THRESH_TL, true);
|
|
if (err < 0) {
|
|
dev_err(&data->client->dev,
|
|
"Adjusting als threshold value failed.\n");
|
|
return false;
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
static void gp2ap020a00f_output_to_lux(struct gp2ap020a00f_data *data,
|
|
int *output_val)
|
|
{
|
|
if (test_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags))
|
|
*output_val *= 16;
|
|
}
|
|
|
|
static void gp2ap020a00f_iio_trigger_work(struct irq_work *work)
|
|
{
|
|
struct gp2ap020a00f_data *data =
|
|
container_of(work, struct gp2ap020a00f_data, work);
|
|
|
|
iio_trigger_poll(data->trig);
|
|
}
|
|
|
|
static irqreturn_t gp2ap020a00f_prox_sensing_handler(int irq, void *data)
|
|
{
|
|
struct iio_dev *indio_dev = data;
|
|
struct gp2ap020a00f_data *priv = iio_priv(indio_dev);
|
|
unsigned int op_reg_val;
|
|
int ret;
|
|
|
|
/* Read interrupt flags */
|
|
ret = regmap_read(priv->regmap, GP2AP020A00F_OP_REG, &op_reg_val);
|
|
if (ret < 0)
|
|
return IRQ_HANDLED;
|
|
|
|
if (gp2ap020a00f_prox_detect_enabled(priv)) {
|
|
if (op_reg_val & GP2AP020A00F_PROX_DETECT) {
|
|
iio_push_event(indio_dev,
|
|
IIO_UNMOD_EVENT_CODE(
|
|
IIO_PROXIMITY,
|
|
GP2AP020A00F_SCAN_MODE_PROXIMITY,
|
|
IIO_EV_TYPE_ROC,
|
|
IIO_EV_DIR_RISING),
|
|
iio_get_time_ns());
|
|
} else {
|
|
iio_push_event(indio_dev,
|
|
IIO_UNMOD_EVENT_CODE(
|
|
IIO_PROXIMITY,
|
|
GP2AP020A00F_SCAN_MODE_PROXIMITY,
|
|
IIO_EV_TYPE_ROC,
|
|
IIO_EV_DIR_FALLING),
|
|
iio_get_time_ns());
|
|
}
|
|
}
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static irqreturn_t gp2ap020a00f_thresh_event_handler(int irq, void *data)
|
|
{
|
|
struct iio_dev *indio_dev = data;
|
|
struct gp2ap020a00f_data *priv = iio_priv(indio_dev);
|
|
u8 op_reg_flags, d0_reg_buf[2];
|
|
unsigned int output_val, op_reg_val;
|
|
int thresh_val_id, ret;
|
|
|
|
/* Read interrupt flags */
|
|
ret = regmap_read(priv->regmap, GP2AP020A00F_OP_REG,
|
|
&op_reg_val);
|
|
if (ret < 0)
|
|
goto done;
|
|
|
|
op_reg_flags = op_reg_val & (GP2AP020A00F_FLAG_A | GP2AP020A00F_FLAG_P
|
|
| GP2AP020A00F_PROX_DETECT);
|
|
|
|
op_reg_val &= (~GP2AP020A00F_FLAG_A & ~GP2AP020A00F_FLAG_P
|
|
& ~GP2AP020A00F_PROX_DETECT);
|
|
|
|
/* Clear interrupt flags (if not in INTTYPE_PULSE mode) */
|
|
if (priv->cur_opmode != GP2AP020A00F_OPMODE_PROX_DETECT) {
|
|
ret = regmap_write(priv->regmap, GP2AP020A00F_OP_REG,
|
|
op_reg_val);
|
|
if (ret < 0)
|
|
goto done;
|
|
}
|
|
|
|
if (op_reg_flags & GP2AP020A00F_FLAG_A) {
|
|
/* Check D0 register to assess if the lux mode
|
|
* transition is required.
|
|
*/
|
|
ret = regmap_bulk_read(priv->regmap, GP2AP020A00F_D0_L_REG,
|
|
d0_reg_buf, 2);
|
|
if (ret < 0)
|
|
goto done;
|
|
|
|
output_val = le16_to_cpup((__le16 *)d0_reg_buf);
|
|
|
|
if (gp2ap020a00f_adjust_lux_mode(priv, output_val))
|
|
goto done;
|
|
|
|
gp2ap020a00f_output_to_lux(priv, &output_val);
|
|
|
|
/*
|
|
* We need to check output value to distinguish
|
|
* between high and low ambient light threshold event.
|
|
*/
|
|
if (test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &priv->flags)) {
|
|
thresh_val_id =
|
|
GP2AP020A00F_THRESH_VAL_ID(GP2AP020A00F_TH_L_REG);
|
|
if (output_val > priv->thresh_val[thresh_val_id])
|
|
iio_push_event(indio_dev,
|
|
IIO_MOD_EVENT_CODE(
|
|
IIO_LIGHT,
|
|
GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR,
|
|
IIO_MOD_LIGHT_CLEAR,
|
|
IIO_EV_TYPE_THRESH,
|
|
IIO_EV_DIR_RISING),
|
|
iio_get_time_ns());
|
|
}
|
|
|
|
if (test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &priv->flags)) {
|
|
thresh_val_id =
|
|
GP2AP020A00F_THRESH_VAL_ID(GP2AP020A00F_TL_L_REG);
|
|
if (output_val < priv->thresh_val[thresh_val_id])
|
|
iio_push_event(indio_dev,
|
|
IIO_MOD_EVENT_CODE(
|
|
IIO_LIGHT,
|
|
GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR,
|
|
IIO_MOD_LIGHT_CLEAR,
|
|
IIO_EV_TYPE_THRESH,
|
|
IIO_EV_DIR_FALLING),
|
|
iio_get_time_ns());
|
|
}
|
|
}
|
|
|
|
if (priv->cur_opmode == GP2AP020A00F_OPMODE_READ_RAW_CLEAR ||
|
|
priv->cur_opmode == GP2AP020A00F_OPMODE_READ_RAW_IR ||
|
|
priv->cur_opmode == GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY) {
|
|
set_bit(GP2AP020A00F_FLAG_DATA_READY, &priv->flags);
|
|
wake_up(&priv->data_ready_queue);
|
|
goto done;
|
|
}
|
|
|
|
if (test_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &priv->flags) ||
|
|
test_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &priv->flags) ||
|
|
test_bit(GP2AP020A00F_FLAG_PROX_TRIGGER, &priv->flags))
|
|
/* This fires off the trigger. */
|
|
irq_work_queue(&priv->work);
|
|
|
|
done:
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static irqreturn_t gp2ap020a00f_trigger_handler(int irq, void *data)
|
|
{
|
|
struct iio_poll_func *pf = data;
|
|
struct iio_dev *indio_dev = pf->indio_dev;
|
|
struct gp2ap020a00f_data *priv = iio_priv(indio_dev);
|
|
size_t d_size = 0;
|
|
int i, out_val, ret;
|
|
|
|
for_each_set_bit(i, indio_dev->active_scan_mask,
|
|
indio_dev->masklength) {
|
|
ret = regmap_bulk_read(priv->regmap,
|
|
GP2AP020A00F_DATA_REG(i),
|
|
&priv->buffer[d_size], 2);
|
|
if (ret < 0)
|
|
goto done;
|
|
|
|
if (i == GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR ||
|
|
i == GP2AP020A00F_SCAN_MODE_LIGHT_IR) {
|
|
out_val = le16_to_cpup((__le16 *)&priv->buffer[d_size]);
|
|
gp2ap020a00f_output_to_lux(priv, &out_val);
|
|
|
|
put_unaligned_le32(out_val, &priv->buffer[d_size]);
|
|
d_size += 4;
|
|
} else {
|
|
d_size += 2;
|
|
}
|
|
}
|
|
|
|
iio_push_to_buffers_with_timestamp(indio_dev, priv->buffer,
|
|
pf->timestamp);
|
|
done:
|
|
iio_trigger_notify_done(indio_dev->trig);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static u8 gp2ap020a00f_get_thresh_reg(const struct iio_chan_spec *chan,
|
|
enum iio_event_direction event_dir)
|
|
{
|
|
switch (chan->type) {
|
|
case IIO_PROXIMITY:
|
|
if (event_dir == IIO_EV_DIR_RISING)
|
|
return GP2AP020A00F_PH_L_REG;
|
|
else
|
|
return GP2AP020A00F_PL_L_REG;
|
|
case IIO_LIGHT:
|
|
if (event_dir == IIO_EV_DIR_RISING)
|
|
return GP2AP020A00F_TH_L_REG;
|
|
else
|
|
return GP2AP020A00F_TL_L_REG;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int gp2ap020a00f_write_event_val(struct iio_dev *indio_dev,
|
|
const struct iio_chan_spec *chan,
|
|
enum iio_event_type type,
|
|
enum iio_event_direction dir,
|
|
enum iio_event_info info,
|
|
int val, int val2)
|
|
{
|
|
struct gp2ap020a00f_data *data = iio_priv(indio_dev);
|
|
bool event_en = false;
|
|
u8 thresh_val_id;
|
|
u8 thresh_reg_l;
|
|
int err = 0;
|
|
|
|
mutex_lock(&data->lock);
|
|
|
|
thresh_reg_l = gp2ap020a00f_get_thresh_reg(chan, dir);
|
|
thresh_val_id = GP2AP020A00F_THRESH_VAL_ID(thresh_reg_l);
|
|
|
|
if (thresh_val_id > GP2AP020A00F_THRESH_PH) {
|
|
err = -EINVAL;
|
|
goto error_unlock;
|
|
}
|
|
|
|
switch (thresh_reg_l) {
|
|
case GP2AP020A00F_TH_L_REG:
|
|
event_en = test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV,
|
|
&data->flags);
|
|
break;
|
|
case GP2AP020A00F_TL_L_REG:
|
|
event_en = test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV,
|
|
&data->flags);
|
|
break;
|
|
case GP2AP020A00F_PH_L_REG:
|
|
if (val == 0) {
|
|
err = -EINVAL;
|
|
goto error_unlock;
|
|
}
|
|
event_en = test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV,
|
|
&data->flags);
|
|
break;
|
|
case GP2AP020A00F_PL_L_REG:
|
|
if (val == 0) {
|
|
err = -EINVAL;
|
|
goto error_unlock;
|
|
}
|
|
event_en = test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV,
|
|
&data->flags);
|
|
break;
|
|
}
|
|
|
|
data->thresh_val[thresh_val_id] = val;
|
|
err = gp2ap020a00f_write_event_threshold(data, thresh_val_id,
|
|
event_en);
|
|
error_unlock:
|
|
mutex_unlock(&data->lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int gp2ap020a00f_read_event_val(struct iio_dev *indio_dev,
|
|
const struct iio_chan_spec *chan,
|
|
enum iio_event_type type,
|
|
enum iio_event_direction dir,
|
|
enum iio_event_info info,
|
|
int *val, int *val2)
|
|
{
|
|
struct gp2ap020a00f_data *data = iio_priv(indio_dev);
|
|
u8 thresh_reg_l;
|
|
int err = IIO_VAL_INT;
|
|
|
|
mutex_lock(&data->lock);
|
|
|
|
thresh_reg_l = gp2ap020a00f_get_thresh_reg(chan, dir);
|
|
|
|
if (thresh_reg_l > GP2AP020A00F_PH_L_REG) {
|
|
err = -EINVAL;
|
|
goto error_unlock;
|
|
}
|
|
|
|
*val = data->thresh_val[GP2AP020A00F_THRESH_VAL_ID(thresh_reg_l)];
|
|
|
|
error_unlock:
|
|
mutex_unlock(&data->lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int gp2ap020a00f_write_prox_event_config(struct iio_dev *indio_dev,
|
|
int state)
|
|
{
|
|
struct gp2ap020a00f_data *data = iio_priv(indio_dev);
|
|
enum gp2ap020a00f_cmd cmd_high_ev, cmd_low_ev;
|
|
int err;
|
|
|
|
cmd_high_ev = state ? GP2AP020A00F_CMD_PROX_HIGH_EV_EN :
|
|
GP2AP020A00F_CMD_PROX_HIGH_EV_DIS;
|
|
cmd_low_ev = state ? GP2AP020A00F_CMD_PROX_LOW_EV_EN :
|
|
GP2AP020A00F_CMD_PROX_LOW_EV_DIS;
|
|
|
|
/*
|
|
* In order to enable proximity detection feature in the device
|
|
* both high and low threshold registers have to be written
|
|
* with different values, greater than zero.
|
|
*/
|
|
if (state) {
|
|
if (data->thresh_val[GP2AP020A00F_THRESH_PL] == 0)
|
|
return -EINVAL;
|
|
|
|
if (data->thresh_val[GP2AP020A00F_THRESH_PH] == 0)
|
|
return -EINVAL;
|
|
}
|
|
|
|
err = gp2ap020a00f_exec_cmd(data, cmd_high_ev);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = gp2ap020a00f_exec_cmd(data, cmd_low_ev);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
free_irq(data->client->irq, indio_dev);
|
|
|
|
if (state)
|
|
err = request_threaded_irq(data->client->irq, NULL,
|
|
&gp2ap020a00f_prox_sensing_handler,
|
|
IRQF_TRIGGER_RISING |
|
|
IRQF_TRIGGER_FALLING |
|
|
IRQF_ONESHOT,
|
|
"gp2ap020a00f_prox_sensing",
|
|
indio_dev);
|
|
else {
|
|
err = request_threaded_irq(data->client->irq, NULL,
|
|
&gp2ap020a00f_thresh_event_handler,
|
|
IRQF_TRIGGER_FALLING |
|
|
IRQF_ONESHOT,
|
|
"gp2ap020a00f_thresh_event",
|
|
indio_dev);
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
static int gp2ap020a00f_write_event_config(struct iio_dev *indio_dev,
|
|
const struct iio_chan_spec *chan,
|
|
enum iio_event_type type,
|
|
enum iio_event_direction dir,
|
|
int state)
|
|
{
|
|
struct gp2ap020a00f_data *data = iio_priv(indio_dev);
|
|
enum gp2ap020a00f_cmd cmd;
|
|
int err;
|
|
|
|
mutex_lock(&data->lock);
|
|
|
|
switch (chan->type) {
|
|
case IIO_PROXIMITY:
|
|
err = gp2ap020a00f_write_prox_event_config(indio_dev, state);
|
|
break;
|
|
case IIO_LIGHT:
|
|
if (dir == IIO_EV_DIR_RISING) {
|
|
cmd = state ? GP2AP020A00F_CMD_ALS_HIGH_EV_EN :
|
|
GP2AP020A00F_CMD_ALS_HIGH_EV_DIS;
|
|
err = gp2ap020a00f_exec_cmd(data, cmd);
|
|
} else {
|
|
cmd = state ? GP2AP020A00F_CMD_ALS_LOW_EV_EN :
|
|
GP2AP020A00F_CMD_ALS_LOW_EV_DIS;
|
|
err = gp2ap020a00f_exec_cmd(data, cmd);
|
|
}
|
|
break;
|
|
default:
|
|
err = -EINVAL;
|
|
}
|
|
|
|
mutex_unlock(&data->lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int gp2ap020a00f_read_event_config(struct iio_dev *indio_dev,
|
|
const struct iio_chan_spec *chan,
|
|
enum iio_event_type type,
|
|
enum iio_event_direction dir)
|
|
{
|
|
struct gp2ap020a00f_data *data = iio_priv(indio_dev);
|
|
int event_en = 0;
|
|
|
|
mutex_lock(&data->lock);
|
|
|
|
switch (chan->type) {
|
|
case IIO_PROXIMITY:
|
|
if (dir == IIO_EV_DIR_RISING)
|
|
event_en = test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV,
|
|
&data->flags);
|
|
else
|
|
event_en = test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV,
|
|
&data->flags);
|
|
break;
|
|
case IIO_LIGHT:
|
|
if (dir == IIO_EV_DIR_RISING)
|
|
event_en = test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV,
|
|
&data->flags);
|
|
else
|
|
event_en = test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV,
|
|
&data->flags);
|
|
break;
|
|
default:
|
|
event_en = -EINVAL;
|
|
break;
|
|
}
|
|
|
|
mutex_unlock(&data->lock);
|
|
|
|
return event_en;
|
|
}
|
|
|
|
static int gp2ap020a00f_read_channel(struct gp2ap020a00f_data *data,
|
|
struct iio_chan_spec const *chan, int *val)
|
|
{
|
|
enum gp2ap020a00f_cmd cmd;
|
|
int err;
|
|
|
|
switch (chan->scan_index) {
|
|
case GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR:
|
|
cmd = GP2AP020A00F_CMD_READ_RAW_CLEAR;
|
|
break;
|
|
case GP2AP020A00F_SCAN_MODE_LIGHT_IR:
|
|
cmd = GP2AP020A00F_CMD_READ_RAW_IR;
|
|
break;
|
|
case GP2AP020A00F_SCAN_MODE_PROXIMITY:
|
|
cmd = GP2AP020A00F_CMD_READ_RAW_PROXIMITY;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
err = gp2ap020a00f_exec_cmd(data, cmd);
|
|
if (err < 0) {
|
|
dev_err(&data->client->dev,
|
|
"gp2ap020a00f_exec_cmd failed\n");
|
|
goto error_ret;
|
|
}
|
|
|
|
err = gp2ap020a00f_read_output(data, chan->address, val);
|
|
if (err < 0)
|
|
dev_err(&data->client->dev,
|
|
"gp2ap020a00f_read_output failed\n");
|
|
|
|
err = gp2ap020a00f_set_operation_mode(data,
|
|
GP2AP020A00F_OPMODE_SHUTDOWN);
|
|
if (err < 0)
|
|
dev_err(&data->client->dev,
|
|
"Failed to shut down the device.\n");
|
|
|
|
if (cmd == GP2AP020A00F_CMD_READ_RAW_CLEAR ||
|
|
cmd == GP2AP020A00F_CMD_READ_RAW_IR)
|
|
gp2ap020a00f_output_to_lux(data, val);
|
|
|
|
error_ret:
|
|
return err;
|
|
}
|
|
|
|
static int gp2ap020a00f_read_raw(struct iio_dev *indio_dev,
|
|
struct iio_chan_spec const *chan,
|
|
int *val, int *val2,
|
|
long mask)
|
|
{
|
|
struct gp2ap020a00f_data *data = iio_priv(indio_dev);
|
|
int err = -EINVAL;
|
|
|
|
mutex_lock(&data->lock);
|
|
|
|
switch (mask) {
|
|
case IIO_CHAN_INFO_RAW:
|
|
if (iio_buffer_enabled(indio_dev)) {
|
|
err = -EBUSY;
|
|
goto error_unlock;
|
|
}
|
|
|
|
err = gp2ap020a00f_read_channel(data, chan, val);
|
|
break;
|
|
}
|
|
|
|
error_unlock:
|
|
mutex_unlock(&data->lock);
|
|
|
|
return err < 0 ? err : IIO_VAL_INT;
|
|
}
|
|
|
|
static const struct iio_event_spec gp2ap020a00f_event_spec_light[] = {
|
|
{
|
|
.type = IIO_EV_TYPE_THRESH,
|
|
.dir = IIO_EV_DIR_RISING,
|
|
.mask_separate = BIT(IIO_EV_INFO_VALUE) |
|
|
BIT(IIO_EV_INFO_ENABLE),
|
|
}, {
|
|
.type = IIO_EV_TYPE_THRESH,
|
|
.dir = IIO_EV_DIR_FALLING,
|
|
.mask_separate = BIT(IIO_EV_INFO_VALUE) |
|
|
BIT(IIO_EV_INFO_ENABLE),
|
|
},
|
|
};
|
|
|
|
static const struct iio_event_spec gp2ap020a00f_event_spec_prox[] = {
|
|
{
|
|
.type = IIO_EV_TYPE_ROC,
|
|
.dir = IIO_EV_DIR_RISING,
|
|
.mask_separate = BIT(IIO_EV_INFO_VALUE) |
|
|
BIT(IIO_EV_INFO_ENABLE),
|
|
}, {
|
|
.type = IIO_EV_TYPE_ROC,
|
|
.dir = IIO_EV_DIR_FALLING,
|
|
.mask_separate = BIT(IIO_EV_INFO_VALUE) |
|
|
BIT(IIO_EV_INFO_ENABLE),
|
|
},
|
|
};
|
|
|
|
static const struct iio_chan_spec gp2ap020a00f_channels[] = {
|
|
{
|
|
.type = IIO_LIGHT,
|
|
.channel2 = IIO_MOD_LIGHT_CLEAR,
|
|
.modified = 1,
|
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
|
|
.scan_type = {
|
|
.sign = 'u',
|
|
.realbits = 24,
|
|
.shift = 0,
|
|
.storagebits = 32,
|
|
.endianness = IIO_LE,
|
|
},
|
|
.scan_index = GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR,
|
|
.address = GP2AP020A00F_D0_L_REG,
|
|
.event_spec = gp2ap020a00f_event_spec_light,
|
|
.num_event_specs = ARRAY_SIZE(gp2ap020a00f_event_spec_light),
|
|
},
|
|
{
|
|
.type = IIO_LIGHT,
|
|
.channel2 = IIO_MOD_LIGHT_IR,
|
|
.modified = 1,
|
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
|
|
.scan_type = {
|
|
.sign = 'u',
|
|
.realbits = 24,
|
|
.shift = 0,
|
|
.storagebits = 32,
|
|
.endianness = IIO_LE,
|
|
},
|
|
.scan_index = GP2AP020A00F_SCAN_MODE_LIGHT_IR,
|
|
.address = GP2AP020A00F_D1_L_REG,
|
|
},
|
|
{
|
|
.type = IIO_PROXIMITY,
|
|
.modified = 0,
|
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
|
|
.scan_type = {
|
|
.sign = 'u',
|
|
.realbits = 16,
|
|
.shift = 0,
|
|
.storagebits = 16,
|
|
.endianness = IIO_LE,
|
|
},
|
|
.scan_index = GP2AP020A00F_SCAN_MODE_PROXIMITY,
|
|
.address = GP2AP020A00F_D2_L_REG,
|
|
.event_spec = gp2ap020a00f_event_spec_prox,
|
|
.num_event_specs = ARRAY_SIZE(gp2ap020a00f_event_spec_prox),
|
|
},
|
|
IIO_CHAN_SOFT_TIMESTAMP(GP2AP020A00F_CHAN_TIMESTAMP),
|
|
};
|
|
|
|
static const struct iio_info gp2ap020a00f_info = {
|
|
.read_raw = &gp2ap020a00f_read_raw,
|
|
.read_event_value = &gp2ap020a00f_read_event_val,
|
|
.read_event_config = &gp2ap020a00f_read_event_config,
|
|
.write_event_value = &gp2ap020a00f_write_event_val,
|
|
.write_event_config = &gp2ap020a00f_write_event_config,
|
|
.driver_module = THIS_MODULE,
|
|
};
|
|
|
|
static int gp2ap020a00f_buffer_postenable(struct iio_dev *indio_dev)
|
|
{
|
|
struct gp2ap020a00f_data *data = iio_priv(indio_dev);
|
|
int i, err = 0;
|
|
|
|
mutex_lock(&data->lock);
|
|
|
|
/*
|
|
* Enable triggers according to the scan_mask. Enabling either
|
|
* LIGHT_CLEAR or LIGHT_IR scan mode results in enabling ALS
|
|
* module in the device, which generates samples in both D0 (clear)
|
|
* and D1 (ir) registers. As the two registers are bound to the
|
|
* two separate IIO channels they are treated in the driver logic
|
|
* as if they were controlled independently.
|
|
*/
|
|
for_each_set_bit(i, indio_dev->active_scan_mask,
|
|
indio_dev->masklength) {
|
|
switch (i) {
|
|
case GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR:
|
|
err = gp2ap020a00f_exec_cmd(data,
|
|
GP2AP020A00F_CMD_TRIGGER_CLEAR_EN);
|
|
break;
|
|
case GP2AP020A00F_SCAN_MODE_LIGHT_IR:
|
|
err = gp2ap020a00f_exec_cmd(data,
|
|
GP2AP020A00F_CMD_TRIGGER_IR_EN);
|
|
break;
|
|
case GP2AP020A00F_SCAN_MODE_PROXIMITY:
|
|
err = gp2ap020a00f_exec_cmd(data,
|
|
GP2AP020A00F_CMD_TRIGGER_PROX_EN);
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (err < 0)
|
|
goto error_unlock;
|
|
|
|
data->buffer = kmalloc(indio_dev->scan_bytes, GFP_KERNEL);
|
|
if (!data->buffer) {
|
|
err = -ENOMEM;
|
|
goto error_unlock;
|
|
}
|
|
|
|
err = iio_triggered_buffer_postenable(indio_dev);
|
|
|
|
error_unlock:
|
|
mutex_unlock(&data->lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int gp2ap020a00f_buffer_predisable(struct iio_dev *indio_dev)
|
|
{
|
|
struct gp2ap020a00f_data *data = iio_priv(indio_dev);
|
|
int i, err;
|
|
|
|
mutex_lock(&data->lock);
|
|
|
|
err = iio_triggered_buffer_predisable(indio_dev);
|
|
if (err < 0)
|
|
goto error_unlock;
|
|
|
|
for_each_set_bit(i, indio_dev->active_scan_mask,
|
|
indio_dev->masklength) {
|
|
switch (i) {
|
|
case GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR:
|
|
err = gp2ap020a00f_exec_cmd(data,
|
|
GP2AP020A00F_CMD_TRIGGER_CLEAR_DIS);
|
|
break;
|
|
case GP2AP020A00F_SCAN_MODE_LIGHT_IR:
|
|
err = gp2ap020a00f_exec_cmd(data,
|
|
GP2AP020A00F_CMD_TRIGGER_IR_DIS);
|
|
break;
|
|
case GP2AP020A00F_SCAN_MODE_PROXIMITY:
|
|
err = gp2ap020a00f_exec_cmd(data,
|
|
GP2AP020A00F_CMD_TRIGGER_PROX_DIS);
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (err == 0)
|
|
kfree(data->buffer);
|
|
|
|
error_unlock:
|
|
mutex_unlock(&data->lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
static const struct iio_buffer_setup_ops gp2ap020a00f_buffer_setup_ops = {
|
|
.postenable = &gp2ap020a00f_buffer_postenable,
|
|
.predisable = &gp2ap020a00f_buffer_predisable,
|
|
};
|
|
|
|
static const struct iio_trigger_ops gp2ap020a00f_trigger_ops = {
|
|
.owner = THIS_MODULE,
|
|
};
|
|
|
|
static int gp2ap020a00f_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
struct gp2ap020a00f_data *data;
|
|
struct iio_dev *indio_dev;
|
|
struct regmap *regmap;
|
|
int err;
|
|
|
|
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
|
|
if (!indio_dev)
|
|
return -ENOMEM;
|
|
|
|
data = iio_priv(indio_dev);
|
|
|
|
data->vled_reg = devm_regulator_get(&client->dev, "vled");
|
|
if (IS_ERR(data->vled_reg))
|
|
return PTR_ERR(data->vled_reg);
|
|
|
|
err = regulator_enable(data->vled_reg);
|
|
if (err)
|
|
return err;
|
|
|
|
regmap = devm_regmap_init_i2c(client, &gp2ap020a00f_regmap_config);
|
|
if (IS_ERR(regmap)) {
|
|
dev_err(&client->dev, "Regmap initialization failed.\n");
|
|
err = PTR_ERR(regmap);
|
|
goto error_regulator_disable;
|
|
}
|
|
|
|
/* Initialize device registers */
|
|
err = regmap_bulk_write(regmap, GP2AP020A00F_OP_REG,
|
|
gp2ap020a00f_reg_init_tab,
|
|
ARRAY_SIZE(gp2ap020a00f_reg_init_tab));
|
|
|
|
if (err < 0) {
|
|
dev_err(&client->dev, "Device initialization failed.\n");
|
|
goto error_regulator_disable;
|
|
}
|
|
|
|
i2c_set_clientdata(client, indio_dev);
|
|
|
|
data->client = client;
|
|
data->cur_opmode = GP2AP020A00F_OPMODE_SHUTDOWN;
|
|
data->regmap = regmap;
|
|
init_waitqueue_head(&data->data_ready_queue);
|
|
|
|
mutex_init(&data->lock);
|
|
indio_dev->dev.parent = &client->dev;
|
|
indio_dev->channels = gp2ap020a00f_channels;
|
|
indio_dev->num_channels = ARRAY_SIZE(gp2ap020a00f_channels);
|
|
indio_dev->info = &gp2ap020a00f_info;
|
|
indio_dev->name = id->name;
|
|
indio_dev->modes = INDIO_DIRECT_MODE;
|
|
|
|
/* Allocate buffer */
|
|
err = iio_triggered_buffer_setup(indio_dev, &iio_pollfunc_store_time,
|
|
&gp2ap020a00f_trigger_handler, &gp2ap020a00f_buffer_setup_ops);
|
|
if (err < 0)
|
|
goto error_regulator_disable;
|
|
|
|
/* Allocate trigger */
|
|
data->trig = devm_iio_trigger_alloc(&client->dev, "%s-trigger",
|
|
indio_dev->name);
|
|
if (data->trig == NULL) {
|
|
err = -ENOMEM;
|
|
dev_err(&indio_dev->dev, "Failed to allocate iio trigger.\n");
|
|
goto error_uninit_buffer;
|
|
}
|
|
|
|
/* This needs to be requested here for read_raw calls to work. */
|
|
err = request_threaded_irq(client->irq, NULL,
|
|
&gp2ap020a00f_thresh_event_handler,
|
|
IRQF_TRIGGER_FALLING |
|
|
IRQF_ONESHOT,
|
|
"gp2ap020a00f_als_event",
|
|
indio_dev);
|
|
if (err < 0) {
|
|
dev_err(&client->dev, "Irq request failed.\n");
|
|
goto error_uninit_buffer;
|
|
}
|
|
|
|
data->trig->ops = &gp2ap020a00f_trigger_ops;
|
|
data->trig->dev.parent = &data->client->dev;
|
|
|
|
init_irq_work(&data->work, gp2ap020a00f_iio_trigger_work);
|
|
|
|
err = iio_trigger_register(data->trig);
|
|
if (err < 0) {
|
|
dev_err(&client->dev, "Failed to register iio trigger.\n");
|
|
goto error_free_irq;
|
|
}
|
|
|
|
err = iio_device_register(indio_dev);
|
|
if (err < 0)
|
|
goto error_trigger_unregister;
|
|
|
|
return 0;
|
|
|
|
error_trigger_unregister:
|
|
iio_trigger_unregister(data->trig);
|
|
error_free_irq:
|
|
free_irq(client->irq, indio_dev);
|
|
error_uninit_buffer:
|
|
iio_triggered_buffer_cleanup(indio_dev);
|
|
error_regulator_disable:
|
|
regulator_disable(data->vled_reg);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int gp2ap020a00f_remove(struct i2c_client *client)
|
|
{
|
|
struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
|
struct gp2ap020a00f_data *data = iio_priv(indio_dev);
|
|
int err;
|
|
|
|
err = gp2ap020a00f_set_operation_mode(data,
|
|
GP2AP020A00F_OPMODE_SHUTDOWN);
|
|
if (err < 0)
|
|
dev_err(&indio_dev->dev, "Failed to power off the device.\n");
|
|
|
|
iio_device_unregister(indio_dev);
|
|
iio_trigger_unregister(data->trig);
|
|
free_irq(client->irq, indio_dev);
|
|
iio_triggered_buffer_cleanup(indio_dev);
|
|
regulator_disable(data->vled_reg);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct i2c_device_id gp2ap020a00f_id[] = {
|
|
{ GP2A_I2C_NAME, 0 },
|
|
{ }
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(i2c, gp2ap020a00f_id);
|
|
|
|
#ifdef CONFIG_OF
|
|
static const struct of_device_id gp2ap020a00f_of_match[] = {
|
|
{ .compatible = "sharp,gp2ap020a00f" },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, gp2ap020a00f_of_match);
|
|
#endif
|
|
|
|
static struct i2c_driver gp2ap020a00f_driver = {
|
|
.driver = {
|
|
.name = GP2A_I2C_NAME,
|
|
.of_match_table = of_match_ptr(gp2ap020a00f_of_match),
|
|
},
|
|
.probe = gp2ap020a00f_probe,
|
|
.remove = gp2ap020a00f_remove,
|
|
.id_table = gp2ap020a00f_id,
|
|
};
|
|
|
|
module_i2c_driver(gp2ap020a00f_driver);
|
|
|
|
MODULE_AUTHOR("Jacek Anaszewski <j.anaszewski@samsung.com>");
|
|
MODULE_DESCRIPTION("Sharp GP2AP020A00F Proximity/ALS sensor driver");
|
|
MODULE_LICENSE("GPL v2");
|