162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (C) 2013 Samsung Electronics Co., Ltd. 462306a36Sopenharmony_ci * Author: Jacek Anaszewski <j.anaszewski@samsung.com> 562306a36Sopenharmony_ci * 662306a36Sopenharmony_ci * IIO features supported by the driver: 762306a36Sopenharmony_ci * 862306a36Sopenharmony_ci * Read-only raw channels: 962306a36Sopenharmony_ci * - illuminance_clear [lux] 1062306a36Sopenharmony_ci * - illuminance_ir 1162306a36Sopenharmony_ci * - proximity 1262306a36Sopenharmony_ci * 1362306a36Sopenharmony_ci * Triggered buffer: 1462306a36Sopenharmony_ci * - illuminance_clear 1562306a36Sopenharmony_ci * - illuminance_ir 1662306a36Sopenharmony_ci * - proximity 1762306a36Sopenharmony_ci * 1862306a36Sopenharmony_ci * Events: 1962306a36Sopenharmony_ci * - illuminance_clear (rising and falling) 2062306a36Sopenharmony_ci * - proximity (rising and falling) 2162306a36Sopenharmony_ci * - both falling and rising thresholds for the proximity events 2262306a36Sopenharmony_ci * must be set to the values greater than 0. 2362306a36Sopenharmony_ci * 2462306a36Sopenharmony_ci * The driver supports triggered buffers for all the three 2562306a36Sopenharmony_ci * channels as well as high and low threshold events for the 2662306a36Sopenharmony_ci * illuminance_clear and proxmimity channels. Triggers 2762306a36Sopenharmony_ci * can be enabled simultaneously with both illuminance_clear 2862306a36Sopenharmony_ci * events. Proximity events cannot be enabled simultaneously 2962306a36Sopenharmony_ci * with any triggers or illuminance events. Enabling/disabling 3062306a36Sopenharmony_ci * one of the proximity events automatically enables/disables 3162306a36Sopenharmony_ci * the other one. 3262306a36Sopenharmony_ci */ 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_ci#include <linux/debugfs.h> 3562306a36Sopenharmony_ci#include <linux/delay.h> 3662306a36Sopenharmony_ci#include <linux/i2c.h> 3762306a36Sopenharmony_ci#include <linux/interrupt.h> 3862306a36Sopenharmony_ci#include <linux/irq.h> 3962306a36Sopenharmony_ci#include <linux/irq_work.h> 4062306a36Sopenharmony_ci#include <linux/module.h> 4162306a36Sopenharmony_ci#include <linux/mod_devicetable.h> 4262306a36Sopenharmony_ci#include <linux/mutex.h> 4362306a36Sopenharmony_ci#include <linux/regmap.h> 4462306a36Sopenharmony_ci#include <linux/regulator/consumer.h> 4562306a36Sopenharmony_ci#include <linux/slab.h> 4662306a36Sopenharmony_ci#include <asm/unaligned.h> 4762306a36Sopenharmony_ci#include <linux/iio/buffer.h> 4862306a36Sopenharmony_ci#include <linux/iio/events.h> 4962306a36Sopenharmony_ci#include <linux/iio/iio.h> 5062306a36Sopenharmony_ci#include <linux/iio/sysfs.h> 5162306a36Sopenharmony_ci#include <linux/iio/trigger.h> 5262306a36Sopenharmony_ci#include <linux/iio/trigger_consumer.h> 5362306a36Sopenharmony_ci#include <linux/iio/triggered_buffer.h> 5462306a36Sopenharmony_ci 5562306a36Sopenharmony_ci#define GP2A_I2C_NAME "gp2ap020a00f" 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ci/* Registers */ 5862306a36Sopenharmony_ci#define GP2AP020A00F_OP_REG 0x00 /* Basic operations */ 5962306a36Sopenharmony_ci#define GP2AP020A00F_ALS_REG 0x01 /* ALS related settings */ 6062306a36Sopenharmony_ci#define GP2AP020A00F_PS_REG 0x02 /* PS related settings */ 6162306a36Sopenharmony_ci#define GP2AP020A00F_LED_REG 0x03 /* LED reg */ 6262306a36Sopenharmony_ci#define GP2AP020A00F_TL_L_REG 0x04 /* ALS: Threshold low LSB */ 6362306a36Sopenharmony_ci#define GP2AP020A00F_TL_H_REG 0x05 /* ALS: Threshold low MSB */ 6462306a36Sopenharmony_ci#define GP2AP020A00F_TH_L_REG 0x06 /* ALS: Threshold high LSB */ 6562306a36Sopenharmony_ci#define GP2AP020A00F_TH_H_REG 0x07 /* ALS: Threshold high MSB */ 6662306a36Sopenharmony_ci#define GP2AP020A00F_PL_L_REG 0x08 /* PS: Threshold low LSB */ 6762306a36Sopenharmony_ci#define GP2AP020A00F_PL_H_REG 0x09 /* PS: Threshold low MSB */ 6862306a36Sopenharmony_ci#define GP2AP020A00F_PH_L_REG 0x0a /* PS: Threshold high LSB */ 6962306a36Sopenharmony_ci#define GP2AP020A00F_PH_H_REG 0x0b /* PS: Threshold high MSB */ 7062306a36Sopenharmony_ci#define GP2AP020A00F_D0_L_REG 0x0c /* ALS result: Clear/Illuminance LSB */ 7162306a36Sopenharmony_ci#define GP2AP020A00F_D0_H_REG 0x0d /* ALS result: Clear/Illuminance MSB */ 7262306a36Sopenharmony_ci#define GP2AP020A00F_D1_L_REG 0x0e /* ALS result: IR LSB */ 7362306a36Sopenharmony_ci#define GP2AP020A00F_D1_H_REG 0x0f /* ALS result: IR LSB */ 7462306a36Sopenharmony_ci#define GP2AP020A00F_D2_L_REG 0x10 /* PS result LSB */ 7562306a36Sopenharmony_ci#define GP2AP020A00F_D2_H_REG 0x11 /* PS result MSB */ 7662306a36Sopenharmony_ci#define GP2AP020A00F_NUM_REGS 0x12 /* Number of registers */ 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_ci/* OP_REG bits */ 7962306a36Sopenharmony_ci#define GP2AP020A00F_OP3_MASK 0x80 /* Software shutdown */ 8062306a36Sopenharmony_ci#define GP2AP020A00F_OP3_SHUTDOWN 0x00 8162306a36Sopenharmony_ci#define GP2AP020A00F_OP3_OPERATION 0x80 8262306a36Sopenharmony_ci#define GP2AP020A00F_OP2_MASK 0x40 /* Auto shutdown/Continuous mode */ 8362306a36Sopenharmony_ci#define GP2AP020A00F_OP2_AUTO_SHUTDOWN 0x00 8462306a36Sopenharmony_ci#define GP2AP020A00F_OP2_CONT_OPERATION 0x40 8562306a36Sopenharmony_ci#define GP2AP020A00F_OP_MASK 0x30 /* Operating mode selection */ 8662306a36Sopenharmony_ci#define GP2AP020A00F_OP_ALS_AND_PS 0x00 8762306a36Sopenharmony_ci#define GP2AP020A00F_OP_ALS 0x10 8862306a36Sopenharmony_ci#define GP2AP020A00F_OP_PS 0x20 8962306a36Sopenharmony_ci#define GP2AP020A00F_OP_DEBUG 0x30 9062306a36Sopenharmony_ci#define GP2AP020A00F_PROX_MASK 0x08 /* PS: detection/non-detection */ 9162306a36Sopenharmony_ci#define GP2AP020A00F_PROX_NON_DETECT 0x00 9262306a36Sopenharmony_ci#define GP2AP020A00F_PROX_DETECT 0x08 9362306a36Sopenharmony_ci#define GP2AP020A00F_FLAG_P 0x04 /* PS: interrupt result */ 9462306a36Sopenharmony_ci#define GP2AP020A00F_FLAG_A 0x02 /* ALS: interrupt result */ 9562306a36Sopenharmony_ci#define GP2AP020A00F_TYPE_MASK 0x01 /* Output data type selection */ 9662306a36Sopenharmony_ci#define GP2AP020A00F_TYPE_MANUAL_CALC 0x00 9762306a36Sopenharmony_ci#define GP2AP020A00F_TYPE_AUTO_CALC 0x01 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci/* ALS_REG bits */ 10062306a36Sopenharmony_ci#define GP2AP020A00F_PRST_MASK 0xc0 /* Number of measurement cycles */ 10162306a36Sopenharmony_ci#define GP2AP020A00F_PRST_ONCE 0x00 10262306a36Sopenharmony_ci#define GP2AP020A00F_PRST_4_CYCLES 0x40 10362306a36Sopenharmony_ci#define GP2AP020A00F_PRST_8_CYCLES 0x80 10462306a36Sopenharmony_ci#define GP2AP020A00F_PRST_16_CYCLES 0xc0 10562306a36Sopenharmony_ci#define GP2AP020A00F_RES_A_MASK 0x38 /* ALS: Resolution */ 10662306a36Sopenharmony_ci#define GP2AP020A00F_RES_A_800ms 0x00 10762306a36Sopenharmony_ci#define GP2AP020A00F_RES_A_400ms 0x08 10862306a36Sopenharmony_ci#define GP2AP020A00F_RES_A_200ms 0x10 10962306a36Sopenharmony_ci#define GP2AP020A00F_RES_A_100ms 0x18 11062306a36Sopenharmony_ci#define GP2AP020A00F_RES_A_25ms 0x20 11162306a36Sopenharmony_ci#define GP2AP020A00F_RES_A_6_25ms 0x28 11262306a36Sopenharmony_ci#define GP2AP020A00F_RES_A_1_56ms 0x30 11362306a36Sopenharmony_ci#define GP2AP020A00F_RES_A_0_39ms 0x38 11462306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_A_MASK 0x07 /* ALS: Max measurable range */ 11562306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x1 0x00 11662306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x2 0x01 11762306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x4 0x02 11862306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x8 0x03 11962306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x16 0x04 12062306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x32 0x05 12162306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x64 0x06 12262306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x128 0x07 12362306a36Sopenharmony_ci 12462306a36Sopenharmony_ci/* PS_REG bits */ 12562306a36Sopenharmony_ci#define GP2AP020A00F_ALC_MASK 0x80 /* Auto light cancel */ 12662306a36Sopenharmony_ci#define GP2AP020A00F_ALC_ON 0x80 12762306a36Sopenharmony_ci#define GP2AP020A00F_ALC_OFF 0x00 12862306a36Sopenharmony_ci#define GP2AP020A00F_INTTYPE_MASK 0x40 /* Interrupt type setting */ 12962306a36Sopenharmony_ci#define GP2AP020A00F_INTTYPE_LEVEL 0x00 13062306a36Sopenharmony_ci#define GP2AP020A00F_INTTYPE_PULSE 0x40 13162306a36Sopenharmony_ci#define GP2AP020A00F_RES_P_MASK 0x38 /* PS: Resolution */ 13262306a36Sopenharmony_ci#define GP2AP020A00F_RES_P_800ms_x2 0x00 13362306a36Sopenharmony_ci#define GP2AP020A00F_RES_P_400ms_x2 0x08 13462306a36Sopenharmony_ci#define GP2AP020A00F_RES_P_200ms_x2 0x10 13562306a36Sopenharmony_ci#define GP2AP020A00F_RES_P_100ms_x2 0x18 13662306a36Sopenharmony_ci#define GP2AP020A00F_RES_P_25ms_x2 0x20 13762306a36Sopenharmony_ci#define GP2AP020A00F_RES_P_6_25ms_x2 0x28 13862306a36Sopenharmony_ci#define GP2AP020A00F_RES_P_1_56ms_x2 0x30 13962306a36Sopenharmony_ci#define GP2AP020A00F_RES_P_0_39ms_x2 0x38 14062306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_P_MASK 0x07 /* PS: Max measurable range */ 14162306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x1 0x00 14262306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x2 0x01 14362306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x4 0x02 14462306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x8 0x03 14562306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x16 0x04 14662306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x32 0x05 14762306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x64 0x06 14862306a36Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x128 0x07 14962306a36Sopenharmony_ci 15062306a36Sopenharmony_ci/* LED reg bits */ 15162306a36Sopenharmony_ci#define GP2AP020A00F_INTVAL_MASK 0xc0 /* Intermittent operating */ 15262306a36Sopenharmony_ci#define GP2AP020A00F_INTVAL_0 0x00 15362306a36Sopenharmony_ci#define GP2AP020A00F_INTVAL_4 0x40 15462306a36Sopenharmony_ci#define GP2AP020A00F_INTVAL_8 0x80 15562306a36Sopenharmony_ci#define GP2AP020A00F_INTVAL_16 0xc0 15662306a36Sopenharmony_ci#define GP2AP020A00F_IS_MASK 0x30 /* ILED drive peak current */ 15762306a36Sopenharmony_ci#define GP2AP020A00F_IS_13_8mA 0x00 15862306a36Sopenharmony_ci#define GP2AP020A00F_IS_27_5mA 0x10 15962306a36Sopenharmony_ci#define GP2AP020A00F_IS_55mA 0x20 16062306a36Sopenharmony_ci#define GP2AP020A00F_IS_110mA 0x30 16162306a36Sopenharmony_ci#define GP2AP020A00F_PIN_MASK 0x0c /* INT terminal setting */ 16262306a36Sopenharmony_ci#define GP2AP020A00F_PIN_ALS_OR_PS 0x00 16362306a36Sopenharmony_ci#define GP2AP020A00F_PIN_ALS 0x04 16462306a36Sopenharmony_ci#define GP2AP020A00F_PIN_PS 0x08 16562306a36Sopenharmony_ci#define GP2AP020A00F_PIN_PS_DETECT 0x0c 16662306a36Sopenharmony_ci#define GP2AP020A00F_FREQ_MASK 0x02 /* LED modulation frequency */ 16762306a36Sopenharmony_ci#define GP2AP020A00F_FREQ_327_5kHz 0x00 16862306a36Sopenharmony_ci#define GP2AP020A00F_FREQ_81_8kHz 0x02 16962306a36Sopenharmony_ci#define GP2AP020A00F_RST 0x01 /* Software reset */ 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_ci#define GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR 0 17262306a36Sopenharmony_ci#define GP2AP020A00F_SCAN_MODE_LIGHT_IR 1 17362306a36Sopenharmony_ci#define GP2AP020A00F_SCAN_MODE_PROXIMITY 2 17462306a36Sopenharmony_ci#define GP2AP020A00F_CHAN_TIMESTAMP 3 17562306a36Sopenharmony_ci 17662306a36Sopenharmony_ci#define GP2AP020A00F_DATA_READY_TIMEOUT msecs_to_jiffies(1000) 17762306a36Sopenharmony_ci#define GP2AP020A00F_DATA_REG(chan) (GP2AP020A00F_D0_L_REG + \ 17862306a36Sopenharmony_ci (chan) * 2) 17962306a36Sopenharmony_ci#define GP2AP020A00F_THRESH_REG(th_val_id) (GP2AP020A00F_TL_L_REG + \ 18062306a36Sopenharmony_ci (th_val_id) * 2) 18162306a36Sopenharmony_ci#define GP2AP020A00F_THRESH_VAL_ID(reg_addr) ((reg_addr - 4) / 2) 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_ci#define GP2AP020A00F_SUBTRACT_MODE 0 18462306a36Sopenharmony_ci#define GP2AP020A00F_ADD_MODE 1 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_ci#define GP2AP020A00F_MAX_CHANNELS 3 18762306a36Sopenharmony_ci 18862306a36Sopenharmony_cienum gp2ap020a00f_opmode { 18962306a36Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_CLEAR, 19062306a36Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_IR, 19162306a36Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY, 19262306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 19362306a36Sopenharmony_ci GP2AP020A00F_OPMODE_PS, 19462306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS_AND_PS, 19562306a36Sopenharmony_ci GP2AP020A00F_OPMODE_PROX_DETECT, 19662306a36Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN, 19762306a36Sopenharmony_ci GP2AP020A00F_NUM_OPMODES, 19862306a36Sopenharmony_ci}; 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_cienum gp2ap020a00f_cmd { 20162306a36Sopenharmony_ci GP2AP020A00F_CMD_READ_RAW_CLEAR, 20262306a36Sopenharmony_ci GP2AP020A00F_CMD_READ_RAW_IR, 20362306a36Sopenharmony_ci GP2AP020A00F_CMD_READ_RAW_PROXIMITY, 20462306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_CLEAR_EN, 20562306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_CLEAR_DIS, 20662306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_IR_EN, 20762306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_IR_DIS, 20862306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_PROX_EN, 20962306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_PROX_DIS, 21062306a36Sopenharmony_ci GP2AP020A00F_CMD_ALS_HIGH_EV_EN, 21162306a36Sopenharmony_ci GP2AP020A00F_CMD_ALS_HIGH_EV_DIS, 21262306a36Sopenharmony_ci GP2AP020A00F_CMD_ALS_LOW_EV_EN, 21362306a36Sopenharmony_ci GP2AP020A00F_CMD_ALS_LOW_EV_DIS, 21462306a36Sopenharmony_ci GP2AP020A00F_CMD_PROX_HIGH_EV_EN, 21562306a36Sopenharmony_ci GP2AP020A00F_CMD_PROX_HIGH_EV_DIS, 21662306a36Sopenharmony_ci GP2AP020A00F_CMD_PROX_LOW_EV_EN, 21762306a36Sopenharmony_ci GP2AP020A00F_CMD_PROX_LOW_EV_DIS, 21862306a36Sopenharmony_ci}; 21962306a36Sopenharmony_ci 22062306a36Sopenharmony_cienum gp2ap020a00f_flags { 22162306a36Sopenharmony_ci GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, 22262306a36Sopenharmony_ci GP2AP020A00F_FLAG_ALS_IR_TRIGGER, 22362306a36Sopenharmony_ci GP2AP020A00F_FLAG_PROX_TRIGGER, 22462306a36Sopenharmony_ci GP2AP020A00F_FLAG_PROX_RISING_EV, 22562306a36Sopenharmony_ci GP2AP020A00F_FLAG_PROX_FALLING_EV, 22662306a36Sopenharmony_ci GP2AP020A00F_FLAG_ALS_RISING_EV, 22762306a36Sopenharmony_ci GP2AP020A00F_FLAG_ALS_FALLING_EV, 22862306a36Sopenharmony_ci GP2AP020A00F_FLAG_LUX_MODE_HI, 22962306a36Sopenharmony_ci GP2AP020A00F_FLAG_DATA_READY, 23062306a36Sopenharmony_ci}; 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_cienum gp2ap020a00f_thresh_val_id { 23362306a36Sopenharmony_ci GP2AP020A00F_THRESH_TL, 23462306a36Sopenharmony_ci GP2AP020A00F_THRESH_TH, 23562306a36Sopenharmony_ci GP2AP020A00F_THRESH_PL, 23662306a36Sopenharmony_ci GP2AP020A00F_THRESH_PH, 23762306a36Sopenharmony_ci}; 23862306a36Sopenharmony_ci 23962306a36Sopenharmony_cistruct gp2ap020a00f_data { 24062306a36Sopenharmony_ci const struct gp2ap020a00f_platform_data *pdata; 24162306a36Sopenharmony_ci struct i2c_client *client; 24262306a36Sopenharmony_ci struct mutex lock; 24362306a36Sopenharmony_ci char *buffer; 24462306a36Sopenharmony_ci struct regulator *vled_reg; 24562306a36Sopenharmony_ci unsigned long flags; 24662306a36Sopenharmony_ci enum gp2ap020a00f_opmode cur_opmode; 24762306a36Sopenharmony_ci struct iio_trigger *trig; 24862306a36Sopenharmony_ci struct regmap *regmap; 24962306a36Sopenharmony_ci unsigned int thresh_val[4]; 25062306a36Sopenharmony_ci u8 debug_reg_addr; 25162306a36Sopenharmony_ci struct irq_work work; 25262306a36Sopenharmony_ci wait_queue_head_t data_ready_queue; 25362306a36Sopenharmony_ci}; 25462306a36Sopenharmony_ci 25562306a36Sopenharmony_cistatic const u8 gp2ap020a00f_reg_init_tab[] = { 25662306a36Sopenharmony_ci [GP2AP020A00F_OP_REG] = GP2AP020A00F_OP3_SHUTDOWN, 25762306a36Sopenharmony_ci [GP2AP020A00F_ALS_REG] = GP2AP020A00F_RES_A_25ms | 25862306a36Sopenharmony_ci GP2AP020A00F_RANGE_A_x8, 25962306a36Sopenharmony_ci [GP2AP020A00F_PS_REG] = GP2AP020A00F_ALC_ON | 26062306a36Sopenharmony_ci GP2AP020A00F_RES_P_1_56ms_x2 | 26162306a36Sopenharmony_ci GP2AP020A00F_RANGE_P_x4, 26262306a36Sopenharmony_ci [GP2AP020A00F_LED_REG] = GP2AP020A00F_INTVAL_0 | 26362306a36Sopenharmony_ci GP2AP020A00F_IS_110mA | 26462306a36Sopenharmony_ci GP2AP020A00F_FREQ_327_5kHz, 26562306a36Sopenharmony_ci [GP2AP020A00F_TL_L_REG] = 0, 26662306a36Sopenharmony_ci [GP2AP020A00F_TL_H_REG] = 0, 26762306a36Sopenharmony_ci [GP2AP020A00F_TH_L_REG] = 0, 26862306a36Sopenharmony_ci [GP2AP020A00F_TH_H_REG] = 0, 26962306a36Sopenharmony_ci [GP2AP020A00F_PL_L_REG] = 0, 27062306a36Sopenharmony_ci [GP2AP020A00F_PL_H_REG] = 0, 27162306a36Sopenharmony_ci [GP2AP020A00F_PH_L_REG] = 0, 27262306a36Sopenharmony_ci [GP2AP020A00F_PH_H_REG] = 0, 27362306a36Sopenharmony_ci}; 27462306a36Sopenharmony_ci 27562306a36Sopenharmony_cistatic bool gp2ap020a00f_is_volatile_reg(struct device *dev, unsigned int reg) 27662306a36Sopenharmony_ci{ 27762306a36Sopenharmony_ci switch (reg) { 27862306a36Sopenharmony_ci case GP2AP020A00F_OP_REG: 27962306a36Sopenharmony_ci case GP2AP020A00F_D0_L_REG: 28062306a36Sopenharmony_ci case GP2AP020A00F_D0_H_REG: 28162306a36Sopenharmony_ci case GP2AP020A00F_D1_L_REG: 28262306a36Sopenharmony_ci case GP2AP020A00F_D1_H_REG: 28362306a36Sopenharmony_ci case GP2AP020A00F_D2_L_REG: 28462306a36Sopenharmony_ci case GP2AP020A00F_D2_H_REG: 28562306a36Sopenharmony_ci return true; 28662306a36Sopenharmony_ci default: 28762306a36Sopenharmony_ci return false; 28862306a36Sopenharmony_ci } 28962306a36Sopenharmony_ci} 29062306a36Sopenharmony_ci 29162306a36Sopenharmony_cistatic const struct regmap_config gp2ap020a00f_regmap_config = { 29262306a36Sopenharmony_ci .reg_bits = 8, 29362306a36Sopenharmony_ci .val_bits = 8, 29462306a36Sopenharmony_ci 29562306a36Sopenharmony_ci .max_register = GP2AP020A00F_D2_H_REG, 29662306a36Sopenharmony_ci .cache_type = REGCACHE_RBTREE, 29762306a36Sopenharmony_ci 29862306a36Sopenharmony_ci .volatile_reg = gp2ap020a00f_is_volatile_reg, 29962306a36Sopenharmony_ci}; 30062306a36Sopenharmony_ci 30162306a36Sopenharmony_cistatic const struct gp2ap020a00f_mutable_config_regs { 30262306a36Sopenharmony_ci u8 op_reg; 30362306a36Sopenharmony_ci u8 als_reg; 30462306a36Sopenharmony_ci u8 ps_reg; 30562306a36Sopenharmony_ci u8 led_reg; 30662306a36Sopenharmony_ci} opmode_regs_settings[GP2AP020A00F_NUM_OPMODES] = { 30762306a36Sopenharmony_ci [GP2AP020A00F_OPMODE_READ_RAW_CLEAR] = { 30862306a36Sopenharmony_ci GP2AP020A00F_OP_ALS | GP2AP020A00F_OP2_CONT_OPERATION 30962306a36Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 31062306a36Sopenharmony_ci | GP2AP020A00F_TYPE_AUTO_CALC, 31162306a36Sopenharmony_ci GP2AP020A00F_PRST_ONCE, 31262306a36Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 31362306a36Sopenharmony_ci GP2AP020A00F_PIN_ALS 31462306a36Sopenharmony_ci }, 31562306a36Sopenharmony_ci [GP2AP020A00F_OPMODE_READ_RAW_IR] = { 31662306a36Sopenharmony_ci GP2AP020A00F_OP_ALS | GP2AP020A00F_OP2_CONT_OPERATION 31762306a36Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 31862306a36Sopenharmony_ci | GP2AP020A00F_TYPE_MANUAL_CALC, 31962306a36Sopenharmony_ci GP2AP020A00F_PRST_ONCE, 32062306a36Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 32162306a36Sopenharmony_ci GP2AP020A00F_PIN_ALS 32262306a36Sopenharmony_ci }, 32362306a36Sopenharmony_ci [GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY] = { 32462306a36Sopenharmony_ci GP2AP020A00F_OP_PS | GP2AP020A00F_OP2_CONT_OPERATION 32562306a36Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 32662306a36Sopenharmony_ci | GP2AP020A00F_TYPE_MANUAL_CALC, 32762306a36Sopenharmony_ci GP2AP020A00F_PRST_ONCE, 32862306a36Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 32962306a36Sopenharmony_ci GP2AP020A00F_PIN_PS 33062306a36Sopenharmony_ci }, 33162306a36Sopenharmony_ci [GP2AP020A00F_OPMODE_PROX_DETECT] = { 33262306a36Sopenharmony_ci GP2AP020A00F_OP_PS | GP2AP020A00F_OP2_CONT_OPERATION 33362306a36Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 33462306a36Sopenharmony_ci | GP2AP020A00F_TYPE_MANUAL_CALC, 33562306a36Sopenharmony_ci GP2AP020A00F_PRST_4_CYCLES, 33662306a36Sopenharmony_ci GP2AP020A00F_INTTYPE_PULSE, 33762306a36Sopenharmony_ci GP2AP020A00F_PIN_PS_DETECT 33862306a36Sopenharmony_ci }, 33962306a36Sopenharmony_ci [GP2AP020A00F_OPMODE_ALS] = { 34062306a36Sopenharmony_ci GP2AP020A00F_OP_ALS | GP2AP020A00F_OP2_CONT_OPERATION 34162306a36Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 34262306a36Sopenharmony_ci | GP2AP020A00F_TYPE_AUTO_CALC, 34362306a36Sopenharmony_ci GP2AP020A00F_PRST_ONCE, 34462306a36Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 34562306a36Sopenharmony_ci GP2AP020A00F_PIN_ALS 34662306a36Sopenharmony_ci }, 34762306a36Sopenharmony_ci [GP2AP020A00F_OPMODE_PS] = { 34862306a36Sopenharmony_ci GP2AP020A00F_OP_PS | GP2AP020A00F_OP2_CONT_OPERATION 34962306a36Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 35062306a36Sopenharmony_ci | GP2AP020A00F_TYPE_MANUAL_CALC, 35162306a36Sopenharmony_ci GP2AP020A00F_PRST_4_CYCLES, 35262306a36Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 35362306a36Sopenharmony_ci GP2AP020A00F_PIN_PS 35462306a36Sopenharmony_ci }, 35562306a36Sopenharmony_ci [GP2AP020A00F_OPMODE_ALS_AND_PS] = { 35662306a36Sopenharmony_ci GP2AP020A00F_OP_ALS_AND_PS 35762306a36Sopenharmony_ci | GP2AP020A00F_OP2_CONT_OPERATION 35862306a36Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 35962306a36Sopenharmony_ci | GP2AP020A00F_TYPE_AUTO_CALC, 36062306a36Sopenharmony_ci GP2AP020A00F_PRST_4_CYCLES, 36162306a36Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 36262306a36Sopenharmony_ci GP2AP020A00F_PIN_ALS_OR_PS 36362306a36Sopenharmony_ci }, 36462306a36Sopenharmony_ci [GP2AP020A00F_OPMODE_SHUTDOWN] = { GP2AP020A00F_OP3_SHUTDOWN, }, 36562306a36Sopenharmony_ci}; 36662306a36Sopenharmony_ci 36762306a36Sopenharmony_cistatic int gp2ap020a00f_set_operation_mode(struct gp2ap020a00f_data *data, 36862306a36Sopenharmony_ci enum gp2ap020a00f_opmode op) 36962306a36Sopenharmony_ci{ 37062306a36Sopenharmony_ci unsigned int op_reg_val; 37162306a36Sopenharmony_ci int err; 37262306a36Sopenharmony_ci 37362306a36Sopenharmony_ci if (op != GP2AP020A00F_OPMODE_SHUTDOWN) { 37462306a36Sopenharmony_ci err = regmap_read(data->regmap, GP2AP020A00F_OP_REG, 37562306a36Sopenharmony_ci &op_reg_val); 37662306a36Sopenharmony_ci if (err < 0) 37762306a36Sopenharmony_ci return err; 37862306a36Sopenharmony_ci /* 37962306a36Sopenharmony_ci * Shutdown the device if the operation being executed entails 38062306a36Sopenharmony_ci * mode transition. 38162306a36Sopenharmony_ci */ 38262306a36Sopenharmony_ci if ((opmode_regs_settings[op].op_reg & GP2AP020A00F_OP_MASK) != 38362306a36Sopenharmony_ci (op_reg_val & GP2AP020A00F_OP_MASK)) { 38462306a36Sopenharmony_ci /* set shutdown mode */ 38562306a36Sopenharmony_ci err = regmap_update_bits(data->regmap, 38662306a36Sopenharmony_ci GP2AP020A00F_OP_REG, GP2AP020A00F_OP3_MASK, 38762306a36Sopenharmony_ci GP2AP020A00F_OP3_SHUTDOWN); 38862306a36Sopenharmony_ci if (err < 0) 38962306a36Sopenharmony_ci return err; 39062306a36Sopenharmony_ci } 39162306a36Sopenharmony_ci 39262306a36Sopenharmony_ci err = regmap_update_bits(data->regmap, GP2AP020A00F_ALS_REG, 39362306a36Sopenharmony_ci GP2AP020A00F_PRST_MASK, opmode_regs_settings[op] 39462306a36Sopenharmony_ci .als_reg); 39562306a36Sopenharmony_ci if (err < 0) 39662306a36Sopenharmony_ci return err; 39762306a36Sopenharmony_ci 39862306a36Sopenharmony_ci err = regmap_update_bits(data->regmap, GP2AP020A00F_PS_REG, 39962306a36Sopenharmony_ci GP2AP020A00F_INTTYPE_MASK, opmode_regs_settings[op] 40062306a36Sopenharmony_ci .ps_reg); 40162306a36Sopenharmony_ci if (err < 0) 40262306a36Sopenharmony_ci return err; 40362306a36Sopenharmony_ci 40462306a36Sopenharmony_ci err = regmap_update_bits(data->regmap, GP2AP020A00F_LED_REG, 40562306a36Sopenharmony_ci GP2AP020A00F_PIN_MASK, opmode_regs_settings[op] 40662306a36Sopenharmony_ci .led_reg); 40762306a36Sopenharmony_ci if (err < 0) 40862306a36Sopenharmony_ci return err; 40962306a36Sopenharmony_ci } 41062306a36Sopenharmony_ci 41162306a36Sopenharmony_ci /* Set OP_REG and apply operation mode (power on / off) */ 41262306a36Sopenharmony_ci err = regmap_update_bits(data->regmap, 41362306a36Sopenharmony_ci GP2AP020A00F_OP_REG, 41462306a36Sopenharmony_ci GP2AP020A00F_OP_MASK | GP2AP020A00F_OP2_MASK | 41562306a36Sopenharmony_ci GP2AP020A00F_OP3_MASK | GP2AP020A00F_TYPE_MASK, 41662306a36Sopenharmony_ci opmode_regs_settings[op].op_reg); 41762306a36Sopenharmony_ci if (err < 0) 41862306a36Sopenharmony_ci return err; 41962306a36Sopenharmony_ci 42062306a36Sopenharmony_ci data->cur_opmode = op; 42162306a36Sopenharmony_ci 42262306a36Sopenharmony_ci return 0; 42362306a36Sopenharmony_ci} 42462306a36Sopenharmony_ci 42562306a36Sopenharmony_cistatic bool gp2ap020a00f_als_enabled(struct gp2ap020a00f_data *data) 42662306a36Sopenharmony_ci{ 42762306a36Sopenharmony_ci return test_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &data->flags) || 42862306a36Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &data->flags) || 42962306a36Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags) || 43062306a36Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags); 43162306a36Sopenharmony_ci} 43262306a36Sopenharmony_ci 43362306a36Sopenharmony_cistatic bool gp2ap020a00f_prox_detect_enabled(struct gp2ap020a00f_data *data) 43462306a36Sopenharmony_ci{ 43562306a36Sopenharmony_ci return test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags) || 43662306a36Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags); 43762306a36Sopenharmony_ci} 43862306a36Sopenharmony_ci 43962306a36Sopenharmony_cistatic int gp2ap020a00f_write_event_threshold(struct gp2ap020a00f_data *data, 44062306a36Sopenharmony_ci enum gp2ap020a00f_thresh_val_id th_val_id, 44162306a36Sopenharmony_ci bool enable) 44262306a36Sopenharmony_ci{ 44362306a36Sopenharmony_ci __le16 thresh_buf = 0; 44462306a36Sopenharmony_ci unsigned int thresh_reg_val; 44562306a36Sopenharmony_ci 44662306a36Sopenharmony_ci if (!enable) 44762306a36Sopenharmony_ci thresh_reg_val = 0; 44862306a36Sopenharmony_ci else if (test_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags) && 44962306a36Sopenharmony_ci th_val_id != GP2AP020A00F_THRESH_PL && 45062306a36Sopenharmony_ci th_val_id != GP2AP020A00F_THRESH_PH) 45162306a36Sopenharmony_ci /* 45262306a36Sopenharmony_ci * For the high lux mode ALS threshold has to be scaled down 45362306a36Sopenharmony_ci * to allow for proper comparison with the output value. 45462306a36Sopenharmony_ci */ 45562306a36Sopenharmony_ci thresh_reg_val = data->thresh_val[th_val_id] / 16; 45662306a36Sopenharmony_ci else 45762306a36Sopenharmony_ci thresh_reg_val = data->thresh_val[th_val_id] > 16000 ? 45862306a36Sopenharmony_ci 16000 : 45962306a36Sopenharmony_ci data->thresh_val[th_val_id]; 46062306a36Sopenharmony_ci 46162306a36Sopenharmony_ci thresh_buf = cpu_to_le16(thresh_reg_val); 46262306a36Sopenharmony_ci 46362306a36Sopenharmony_ci return regmap_bulk_write(data->regmap, 46462306a36Sopenharmony_ci GP2AP020A00F_THRESH_REG(th_val_id), 46562306a36Sopenharmony_ci (u8 *)&thresh_buf, 2); 46662306a36Sopenharmony_ci} 46762306a36Sopenharmony_ci 46862306a36Sopenharmony_cistatic int gp2ap020a00f_alter_opmode(struct gp2ap020a00f_data *data, 46962306a36Sopenharmony_ci enum gp2ap020a00f_opmode diff_mode, int add_sub) 47062306a36Sopenharmony_ci{ 47162306a36Sopenharmony_ci enum gp2ap020a00f_opmode new_mode; 47262306a36Sopenharmony_ci 47362306a36Sopenharmony_ci if (diff_mode != GP2AP020A00F_OPMODE_ALS && 47462306a36Sopenharmony_ci diff_mode != GP2AP020A00F_OPMODE_PS) 47562306a36Sopenharmony_ci return -EINVAL; 47662306a36Sopenharmony_ci 47762306a36Sopenharmony_ci if (add_sub == GP2AP020A00F_ADD_MODE) { 47862306a36Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_SHUTDOWN) 47962306a36Sopenharmony_ci new_mode = diff_mode; 48062306a36Sopenharmony_ci else 48162306a36Sopenharmony_ci new_mode = GP2AP020A00F_OPMODE_ALS_AND_PS; 48262306a36Sopenharmony_ci } else { 48362306a36Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_ALS_AND_PS) 48462306a36Sopenharmony_ci new_mode = (diff_mode == GP2AP020A00F_OPMODE_ALS) ? 48562306a36Sopenharmony_ci GP2AP020A00F_OPMODE_PS : 48662306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS; 48762306a36Sopenharmony_ci else 48862306a36Sopenharmony_ci new_mode = GP2AP020A00F_OPMODE_SHUTDOWN; 48962306a36Sopenharmony_ci } 49062306a36Sopenharmony_ci 49162306a36Sopenharmony_ci return gp2ap020a00f_set_operation_mode(data, new_mode); 49262306a36Sopenharmony_ci} 49362306a36Sopenharmony_ci 49462306a36Sopenharmony_cistatic int gp2ap020a00f_exec_cmd(struct gp2ap020a00f_data *data, 49562306a36Sopenharmony_ci enum gp2ap020a00f_cmd cmd) 49662306a36Sopenharmony_ci{ 49762306a36Sopenharmony_ci int err = 0; 49862306a36Sopenharmony_ci 49962306a36Sopenharmony_ci switch (cmd) { 50062306a36Sopenharmony_ci case GP2AP020A00F_CMD_READ_RAW_CLEAR: 50162306a36Sopenharmony_ci if (data->cur_opmode != GP2AP020A00F_OPMODE_SHUTDOWN) 50262306a36Sopenharmony_ci return -EBUSY; 50362306a36Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 50462306a36Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_CLEAR); 50562306a36Sopenharmony_ci break; 50662306a36Sopenharmony_ci case GP2AP020A00F_CMD_READ_RAW_IR: 50762306a36Sopenharmony_ci if (data->cur_opmode != GP2AP020A00F_OPMODE_SHUTDOWN) 50862306a36Sopenharmony_ci return -EBUSY; 50962306a36Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 51062306a36Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_IR); 51162306a36Sopenharmony_ci break; 51262306a36Sopenharmony_ci case GP2AP020A00F_CMD_READ_RAW_PROXIMITY: 51362306a36Sopenharmony_ci if (data->cur_opmode != GP2AP020A00F_OPMODE_SHUTDOWN) 51462306a36Sopenharmony_ci return -EBUSY; 51562306a36Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 51662306a36Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY); 51762306a36Sopenharmony_ci break; 51862306a36Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_CLEAR_EN: 51962306a36Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 52062306a36Sopenharmony_ci return -EBUSY; 52162306a36Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) 52262306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 52362306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 52462306a36Sopenharmony_ci GP2AP020A00F_ADD_MODE); 52562306a36Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &data->flags); 52662306a36Sopenharmony_ci break; 52762306a36Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_CLEAR_DIS: 52862306a36Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &data->flags); 52962306a36Sopenharmony_ci if (gp2ap020a00f_als_enabled(data)) 53062306a36Sopenharmony_ci break; 53162306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 53262306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 53362306a36Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 53462306a36Sopenharmony_ci break; 53562306a36Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_IR_EN: 53662306a36Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 53762306a36Sopenharmony_ci return -EBUSY; 53862306a36Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) 53962306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 54062306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 54162306a36Sopenharmony_ci GP2AP020A00F_ADD_MODE); 54262306a36Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &data->flags); 54362306a36Sopenharmony_ci break; 54462306a36Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_IR_DIS: 54562306a36Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &data->flags); 54662306a36Sopenharmony_ci if (gp2ap020a00f_als_enabled(data)) 54762306a36Sopenharmony_ci break; 54862306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 54962306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 55062306a36Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 55162306a36Sopenharmony_ci break; 55262306a36Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_PROX_EN: 55362306a36Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 55462306a36Sopenharmony_ci return -EBUSY; 55562306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 55662306a36Sopenharmony_ci GP2AP020A00F_OPMODE_PS, 55762306a36Sopenharmony_ci GP2AP020A00F_ADD_MODE); 55862306a36Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_PROX_TRIGGER, &data->flags); 55962306a36Sopenharmony_ci break; 56062306a36Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_PROX_DIS: 56162306a36Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_PROX_TRIGGER, &data->flags); 56262306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 56362306a36Sopenharmony_ci GP2AP020A00F_OPMODE_PS, 56462306a36Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 56562306a36Sopenharmony_ci break; 56662306a36Sopenharmony_ci case GP2AP020A00F_CMD_ALS_HIGH_EV_EN: 56762306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags)) 56862306a36Sopenharmony_ci return 0; 56962306a36Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 57062306a36Sopenharmony_ci return -EBUSY; 57162306a36Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) { 57262306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 57362306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 57462306a36Sopenharmony_ci GP2AP020A00F_ADD_MODE); 57562306a36Sopenharmony_ci if (err < 0) 57662306a36Sopenharmony_ci return err; 57762306a36Sopenharmony_ci } 57862306a36Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags); 57962306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 58062306a36Sopenharmony_ci GP2AP020A00F_THRESH_TH, true); 58162306a36Sopenharmony_ci break; 58262306a36Sopenharmony_ci case GP2AP020A00F_CMD_ALS_HIGH_EV_DIS: 58362306a36Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags)) 58462306a36Sopenharmony_ci return 0; 58562306a36Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags); 58662306a36Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) { 58762306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 58862306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 58962306a36Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 59062306a36Sopenharmony_ci if (err < 0) 59162306a36Sopenharmony_ci return err; 59262306a36Sopenharmony_ci } 59362306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 59462306a36Sopenharmony_ci GP2AP020A00F_THRESH_TH, false); 59562306a36Sopenharmony_ci break; 59662306a36Sopenharmony_ci case GP2AP020A00F_CMD_ALS_LOW_EV_EN: 59762306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags)) 59862306a36Sopenharmony_ci return 0; 59962306a36Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 60062306a36Sopenharmony_ci return -EBUSY; 60162306a36Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) { 60262306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 60362306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 60462306a36Sopenharmony_ci GP2AP020A00F_ADD_MODE); 60562306a36Sopenharmony_ci if (err < 0) 60662306a36Sopenharmony_ci return err; 60762306a36Sopenharmony_ci } 60862306a36Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags); 60962306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 61062306a36Sopenharmony_ci GP2AP020A00F_THRESH_TL, true); 61162306a36Sopenharmony_ci break; 61262306a36Sopenharmony_ci case GP2AP020A00F_CMD_ALS_LOW_EV_DIS: 61362306a36Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags)) 61462306a36Sopenharmony_ci return 0; 61562306a36Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags); 61662306a36Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) { 61762306a36Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 61862306a36Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 61962306a36Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 62062306a36Sopenharmony_ci if (err < 0) 62162306a36Sopenharmony_ci return err; 62262306a36Sopenharmony_ci } 62362306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 62462306a36Sopenharmony_ci GP2AP020A00F_THRESH_TL, false); 62562306a36Sopenharmony_ci break; 62662306a36Sopenharmony_ci case GP2AP020A00F_CMD_PROX_HIGH_EV_EN: 62762306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags)) 62862306a36Sopenharmony_ci return 0; 62962306a36Sopenharmony_ci if (gp2ap020a00f_als_enabled(data) || 63062306a36Sopenharmony_ci data->cur_opmode == GP2AP020A00F_OPMODE_PS) 63162306a36Sopenharmony_ci return -EBUSY; 63262306a36Sopenharmony_ci if (!gp2ap020a00f_prox_detect_enabled(data)) { 63362306a36Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 63462306a36Sopenharmony_ci GP2AP020A00F_OPMODE_PROX_DETECT); 63562306a36Sopenharmony_ci if (err < 0) 63662306a36Sopenharmony_ci return err; 63762306a36Sopenharmony_ci } 63862306a36Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags); 63962306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 64062306a36Sopenharmony_ci GP2AP020A00F_THRESH_PH, true); 64162306a36Sopenharmony_ci break; 64262306a36Sopenharmony_ci case GP2AP020A00F_CMD_PROX_HIGH_EV_DIS: 64362306a36Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags)) 64462306a36Sopenharmony_ci return 0; 64562306a36Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags); 64662306a36Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 64762306a36Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN); 64862306a36Sopenharmony_ci if (err < 0) 64962306a36Sopenharmony_ci return err; 65062306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 65162306a36Sopenharmony_ci GP2AP020A00F_THRESH_PH, false); 65262306a36Sopenharmony_ci break; 65362306a36Sopenharmony_ci case GP2AP020A00F_CMD_PROX_LOW_EV_EN: 65462306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags)) 65562306a36Sopenharmony_ci return 0; 65662306a36Sopenharmony_ci if (gp2ap020a00f_als_enabled(data) || 65762306a36Sopenharmony_ci data->cur_opmode == GP2AP020A00F_OPMODE_PS) 65862306a36Sopenharmony_ci return -EBUSY; 65962306a36Sopenharmony_ci if (!gp2ap020a00f_prox_detect_enabled(data)) { 66062306a36Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 66162306a36Sopenharmony_ci GP2AP020A00F_OPMODE_PROX_DETECT); 66262306a36Sopenharmony_ci if (err < 0) 66362306a36Sopenharmony_ci return err; 66462306a36Sopenharmony_ci } 66562306a36Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags); 66662306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 66762306a36Sopenharmony_ci GP2AP020A00F_THRESH_PL, true); 66862306a36Sopenharmony_ci break; 66962306a36Sopenharmony_ci case GP2AP020A00F_CMD_PROX_LOW_EV_DIS: 67062306a36Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags)) 67162306a36Sopenharmony_ci return 0; 67262306a36Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags); 67362306a36Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 67462306a36Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN); 67562306a36Sopenharmony_ci if (err < 0) 67662306a36Sopenharmony_ci return err; 67762306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 67862306a36Sopenharmony_ci GP2AP020A00F_THRESH_PL, false); 67962306a36Sopenharmony_ci break; 68062306a36Sopenharmony_ci } 68162306a36Sopenharmony_ci 68262306a36Sopenharmony_ci return err; 68362306a36Sopenharmony_ci} 68462306a36Sopenharmony_ci 68562306a36Sopenharmony_cistatic int wait_conversion_complete_irq(struct gp2ap020a00f_data *data) 68662306a36Sopenharmony_ci{ 68762306a36Sopenharmony_ci int ret; 68862306a36Sopenharmony_ci 68962306a36Sopenharmony_ci ret = wait_event_timeout(data->data_ready_queue, 69062306a36Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_DATA_READY, 69162306a36Sopenharmony_ci &data->flags), 69262306a36Sopenharmony_ci GP2AP020A00F_DATA_READY_TIMEOUT); 69362306a36Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_DATA_READY, &data->flags); 69462306a36Sopenharmony_ci 69562306a36Sopenharmony_ci return ret > 0 ? 0 : -ETIME; 69662306a36Sopenharmony_ci} 69762306a36Sopenharmony_ci 69862306a36Sopenharmony_cistatic int gp2ap020a00f_read_output(struct gp2ap020a00f_data *data, 69962306a36Sopenharmony_ci unsigned int output_reg, int *val) 70062306a36Sopenharmony_ci{ 70162306a36Sopenharmony_ci u8 reg_buf[2]; 70262306a36Sopenharmony_ci int err; 70362306a36Sopenharmony_ci 70462306a36Sopenharmony_ci err = wait_conversion_complete_irq(data); 70562306a36Sopenharmony_ci if (err < 0) 70662306a36Sopenharmony_ci dev_dbg(&data->client->dev, "data ready timeout\n"); 70762306a36Sopenharmony_ci 70862306a36Sopenharmony_ci err = regmap_bulk_read(data->regmap, output_reg, reg_buf, 2); 70962306a36Sopenharmony_ci if (err < 0) 71062306a36Sopenharmony_ci return err; 71162306a36Sopenharmony_ci 71262306a36Sopenharmony_ci *val = le16_to_cpup((__le16 *)reg_buf); 71362306a36Sopenharmony_ci 71462306a36Sopenharmony_ci return err; 71562306a36Sopenharmony_ci} 71662306a36Sopenharmony_ci 71762306a36Sopenharmony_cistatic bool gp2ap020a00f_adjust_lux_mode(struct gp2ap020a00f_data *data, 71862306a36Sopenharmony_ci int output_val) 71962306a36Sopenharmony_ci{ 72062306a36Sopenharmony_ci u8 new_range = 0xff; 72162306a36Sopenharmony_ci int err; 72262306a36Sopenharmony_ci 72362306a36Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags)) { 72462306a36Sopenharmony_ci if (output_val > 16000) { 72562306a36Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags); 72662306a36Sopenharmony_ci new_range = GP2AP020A00F_RANGE_A_x128; 72762306a36Sopenharmony_ci } 72862306a36Sopenharmony_ci } else { 72962306a36Sopenharmony_ci if (output_val < 1000) { 73062306a36Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags); 73162306a36Sopenharmony_ci new_range = GP2AP020A00F_RANGE_A_x8; 73262306a36Sopenharmony_ci } 73362306a36Sopenharmony_ci } 73462306a36Sopenharmony_ci 73562306a36Sopenharmony_ci if (new_range != 0xff) { 73662306a36Sopenharmony_ci /* Clear als threshold registers to avoid spurious 73762306a36Sopenharmony_ci * events caused by lux mode transition. 73862306a36Sopenharmony_ci */ 73962306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 74062306a36Sopenharmony_ci GP2AP020A00F_THRESH_TH, false); 74162306a36Sopenharmony_ci if (err < 0) { 74262306a36Sopenharmony_ci dev_err(&data->client->dev, 74362306a36Sopenharmony_ci "Clearing als threshold register failed.\n"); 74462306a36Sopenharmony_ci return false; 74562306a36Sopenharmony_ci } 74662306a36Sopenharmony_ci 74762306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 74862306a36Sopenharmony_ci GP2AP020A00F_THRESH_TL, false); 74962306a36Sopenharmony_ci if (err < 0) { 75062306a36Sopenharmony_ci dev_err(&data->client->dev, 75162306a36Sopenharmony_ci "Clearing als threshold register failed.\n"); 75262306a36Sopenharmony_ci return false; 75362306a36Sopenharmony_ci } 75462306a36Sopenharmony_ci 75562306a36Sopenharmony_ci /* Change lux mode */ 75662306a36Sopenharmony_ci err = regmap_update_bits(data->regmap, 75762306a36Sopenharmony_ci GP2AP020A00F_OP_REG, 75862306a36Sopenharmony_ci GP2AP020A00F_OP3_MASK, 75962306a36Sopenharmony_ci GP2AP020A00F_OP3_SHUTDOWN); 76062306a36Sopenharmony_ci 76162306a36Sopenharmony_ci if (err < 0) { 76262306a36Sopenharmony_ci dev_err(&data->client->dev, 76362306a36Sopenharmony_ci "Shutting down the device failed.\n"); 76462306a36Sopenharmony_ci return false; 76562306a36Sopenharmony_ci } 76662306a36Sopenharmony_ci 76762306a36Sopenharmony_ci err = regmap_update_bits(data->regmap, 76862306a36Sopenharmony_ci GP2AP020A00F_ALS_REG, 76962306a36Sopenharmony_ci GP2AP020A00F_RANGE_A_MASK, 77062306a36Sopenharmony_ci new_range); 77162306a36Sopenharmony_ci 77262306a36Sopenharmony_ci if (err < 0) { 77362306a36Sopenharmony_ci dev_err(&data->client->dev, 77462306a36Sopenharmony_ci "Adjusting device lux mode failed.\n"); 77562306a36Sopenharmony_ci return false; 77662306a36Sopenharmony_ci } 77762306a36Sopenharmony_ci 77862306a36Sopenharmony_ci err = regmap_update_bits(data->regmap, 77962306a36Sopenharmony_ci GP2AP020A00F_OP_REG, 78062306a36Sopenharmony_ci GP2AP020A00F_OP3_MASK, 78162306a36Sopenharmony_ci GP2AP020A00F_OP3_OPERATION); 78262306a36Sopenharmony_ci 78362306a36Sopenharmony_ci if (err < 0) { 78462306a36Sopenharmony_ci dev_err(&data->client->dev, 78562306a36Sopenharmony_ci "Powering up the device failed.\n"); 78662306a36Sopenharmony_ci return false; 78762306a36Sopenharmony_ci } 78862306a36Sopenharmony_ci 78962306a36Sopenharmony_ci /* Adjust als threshold register values to the new lux mode */ 79062306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags)) { 79162306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 79262306a36Sopenharmony_ci GP2AP020A00F_THRESH_TH, true); 79362306a36Sopenharmony_ci if (err < 0) { 79462306a36Sopenharmony_ci dev_err(&data->client->dev, 79562306a36Sopenharmony_ci "Adjusting als threshold value failed.\n"); 79662306a36Sopenharmony_ci return false; 79762306a36Sopenharmony_ci } 79862306a36Sopenharmony_ci } 79962306a36Sopenharmony_ci 80062306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags)) { 80162306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 80262306a36Sopenharmony_ci GP2AP020A00F_THRESH_TL, true); 80362306a36Sopenharmony_ci if (err < 0) { 80462306a36Sopenharmony_ci dev_err(&data->client->dev, 80562306a36Sopenharmony_ci "Adjusting als threshold value failed.\n"); 80662306a36Sopenharmony_ci return false; 80762306a36Sopenharmony_ci } 80862306a36Sopenharmony_ci } 80962306a36Sopenharmony_ci 81062306a36Sopenharmony_ci return true; 81162306a36Sopenharmony_ci } 81262306a36Sopenharmony_ci 81362306a36Sopenharmony_ci return false; 81462306a36Sopenharmony_ci} 81562306a36Sopenharmony_ci 81662306a36Sopenharmony_cistatic void gp2ap020a00f_output_to_lux(struct gp2ap020a00f_data *data, 81762306a36Sopenharmony_ci int *output_val) 81862306a36Sopenharmony_ci{ 81962306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags)) 82062306a36Sopenharmony_ci *output_val *= 16; 82162306a36Sopenharmony_ci} 82262306a36Sopenharmony_ci 82362306a36Sopenharmony_cistatic void gp2ap020a00f_iio_trigger_work(struct irq_work *work) 82462306a36Sopenharmony_ci{ 82562306a36Sopenharmony_ci struct gp2ap020a00f_data *data = 82662306a36Sopenharmony_ci container_of(work, struct gp2ap020a00f_data, work); 82762306a36Sopenharmony_ci 82862306a36Sopenharmony_ci iio_trigger_poll(data->trig); 82962306a36Sopenharmony_ci} 83062306a36Sopenharmony_ci 83162306a36Sopenharmony_cistatic irqreturn_t gp2ap020a00f_prox_sensing_handler(int irq, void *data) 83262306a36Sopenharmony_ci{ 83362306a36Sopenharmony_ci struct iio_dev *indio_dev = data; 83462306a36Sopenharmony_ci struct gp2ap020a00f_data *priv = iio_priv(indio_dev); 83562306a36Sopenharmony_ci unsigned int op_reg_val; 83662306a36Sopenharmony_ci int ret; 83762306a36Sopenharmony_ci 83862306a36Sopenharmony_ci /* Read interrupt flags */ 83962306a36Sopenharmony_ci ret = regmap_read(priv->regmap, GP2AP020A00F_OP_REG, &op_reg_val); 84062306a36Sopenharmony_ci if (ret < 0) 84162306a36Sopenharmony_ci return IRQ_HANDLED; 84262306a36Sopenharmony_ci 84362306a36Sopenharmony_ci if (gp2ap020a00f_prox_detect_enabled(priv)) { 84462306a36Sopenharmony_ci if (op_reg_val & GP2AP020A00F_PROX_DETECT) { 84562306a36Sopenharmony_ci iio_push_event(indio_dev, 84662306a36Sopenharmony_ci IIO_UNMOD_EVENT_CODE( 84762306a36Sopenharmony_ci IIO_PROXIMITY, 84862306a36Sopenharmony_ci GP2AP020A00F_SCAN_MODE_PROXIMITY, 84962306a36Sopenharmony_ci IIO_EV_TYPE_ROC, 85062306a36Sopenharmony_ci IIO_EV_DIR_RISING), 85162306a36Sopenharmony_ci iio_get_time_ns(indio_dev)); 85262306a36Sopenharmony_ci } else { 85362306a36Sopenharmony_ci iio_push_event(indio_dev, 85462306a36Sopenharmony_ci IIO_UNMOD_EVENT_CODE( 85562306a36Sopenharmony_ci IIO_PROXIMITY, 85662306a36Sopenharmony_ci GP2AP020A00F_SCAN_MODE_PROXIMITY, 85762306a36Sopenharmony_ci IIO_EV_TYPE_ROC, 85862306a36Sopenharmony_ci IIO_EV_DIR_FALLING), 85962306a36Sopenharmony_ci iio_get_time_ns(indio_dev)); 86062306a36Sopenharmony_ci } 86162306a36Sopenharmony_ci } 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_ci return IRQ_HANDLED; 86462306a36Sopenharmony_ci} 86562306a36Sopenharmony_ci 86662306a36Sopenharmony_cistatic irqreturn_t gp2ap020a00f_thresh_event_handler(int irq, void *data) 86762306a36Sopenharmony_ci{ 86862306a36Sopenharmony_ci struct iio_dev *indio_dev = data; 86962306a36Sopenharmony_ci struct gp2ap020a00f_data *priv = iio_priv(indio_dev); 87062306a36Sopenharmony_ci u8 op_reg_flags, d0_reg_buf[2]; 87162306a36Sopenharmony_ci unsigned int output_val, op_reg_val; 87262306a36Sopenharmony_ci int thresh_val_id, ret; 87362306a36Sopenharmony_ci 87462306a36Sopenharmony_ci /* Read interrupt flags */ 87562306a36Sopenharmony_ci ret = regmap_read(priv->regmap, GP2AP020A00F_OP_REG, 87662306a36Sopenharmony_ci &op_reg_val); 87762306a36Sopenharmony_ci if (ret < 0) 87862306a36Sopenharmony_ci goto done; 87962306a36Sopenharmony_ci 88062306a36Sopenharmony_ci op_reg_flags = op_reg_val & (GP2AP020A00F_FLAG_A | GP2AP020A00F_FLAG_P 88162306a36Sopenharmony_ci | GP2AP020A00F_PROX_DETECT); 88262306a36Sopenharmony_ci 88362306a36Sopenharmony_ci op_reg_val &= (~GP2AP020A00F_FLAG_A & ~GP2AP020A00F_FLAG_P 88462306a36Sopenharmony_ci & ~GP2AP020A00F_PROX_DETECT); 88562306a36Sopenharmony_ci 88662306a36Sopenharmony_ci /* Clear interrupt flags (if not in INTTYPE_PULSE mode) */ 88762306a36Sopenharmony_ci if (priv->cur_opmode != GP2AP020A00F_OPMODE_PROX_DETECT) { 88862306a36Sopenharmony_ci ret = regmap_write(priv->regmap, GP2AP020A00F_OP_REG, 88962306a36Sopenharmony_ci op_reg_val); 89062306a36Sopenharmony_ci if (ret < 0) 89162306a36Sopenharmony_ci goto done; 89262306a36Sopenharmony_ci } 89362306a36Sopenharmony_ci 89462306a36Sopenharmony_ci if (op_reg_flags & GP2AP020A00F_FLAG_A) { 89562306a36Sopenharmony_ci /* Check D0 register to assess if the lux mode 89662306a36Sopenharmony_ci * transition is required. 89762306a36Sopenharmony_ci */ 89862306a36Sopenharmony_ci ret = regmap_bulk_read(priv->regmap, GP2AP020A00F_D0_L_REG, 89962306a36Sopenharmony_ci d0_reg_buf, 2); 90062306a36Sopenharmony_ci if (ret < 0) 90162306a36Sopenharmony_ci goto done; 90262306a36Sopenharmony_ci 90362306a36Sopenharmony_ci output_val = le16_to_cpup((__le16 *)d0_reg_buf); 90462306a36Sopenharmony_ci 90562306a36Sopenharmony_ci if (gp2ap020a00f_adjust_lux_mode(priv, output_val)) 90662306a36Sopenharmony_ci goto done; 90762306a36Sopenharmony_ci 90862306a36Sopenharmony_ci gp2ap020a00f_output_to_lux(priv, &output_val); 90962306a36Sopenharmony_ci 91062306a36Sopenharmony_ci /* 91162306a36Sopenharmony_ci * We need to check output value to distinguish 91262306a36Sopenharmony_ci * between high and low ambient light threshold event. 91362306a36Sopenharmony_ci */ 91462306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &priv->flags)) { 91562306a36Sopenharmony_ci thresh_val_id = 91662306a36Sopenharmony_ci GP2AP020A00F_THRESH_VAL_ID(GP2AP020A00F_TH_L_REG); 91762306a36Sopenharmony_ci if (output_val > priv->thresh_val[thresh_val_id]) 91862306a36Sopenharmony_ci iio_push_event(indio_dev, 91962306a36Sopenharmony_ci IIO_MOD_EVENT_CODE( 92062306a36Sopenharmony_ci IIO_LIGHT, 92162306a36Sopenharmony_ci GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR, 92262306a36Sopenharmony_ci IIO_MOD_LIGHT_CLEAR, 92362306a36Sopenharmony_ci IIO_EV_TYPE_THRESH, 92462306a36Sopenharmony_ci IIO_EV_DIR_RISING), 92562306a36Sopenharmony_ci iio_get_time_ns(indio_dev)); 92662306a36Sopenharmony_ci } 92762306a36Sopenharmony_ci 92862306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &priv->flags)) { 92962306a36Sopenharmony_ci thresh_val_id = 93062306a36Sopenharmony_ci GP2AP020A00F_THRESH_VAL_ID(GP2AP020A00F_TL_L_REG); 93162306a36Sopenharmony_ci if (output_val < priv->thresh_val[thresh_val_id]) 93262306a36Sopenharmony_ci iio_push_event(indio_dev, 93362306a36Sopenharmony_ci IIO_MOD_EVENT_CODE( 93462306a36Sopenharmony_ci IIO_LIGHT, 93562306a36Sopenharmony_ci GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR, 93662306a36Sopenharmony_ci IIO_MOD_LIGHT_CLEAR, 93762306a36Sopenharmony_ci IIO_EV_TYPE_THRESH, 93862306a36Sopenharmony_ci IIO_EV_DIR_FALLING), 93962306a36Sopenharmony_ci iio_get_time_ns(indio_dev)); 94062306a36Sopenharmony_ci } 94162306a36Sopenharmony_ci } 94262306a36Sopenharmony_ci 94362306a36Sopenharmony_ci if (priv->cur_opmode == GP2AP020A00F_OPMODE_READ_RAW_CLEAR || 94462306a36Sopenharmony_ci priv->cur_opmode == GP2AP020A00F_OPMODE_READ_RAW_IR || 94562306a36Sopenharmony_ci priv->cur_opmode == GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY) { 94662306a36Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_DATA_READY, &priv->flags); 94762306a36Sopenharmony_ci wake_up(&priv->data_ready_queue); 94862306a36Sopenharmony_ci goto done; 94962306a36Sopenharmony_ci } 95062306a36Sopenharmony_ci 95162306a36Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &priv->flags) || 95262306a36Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &priv->flags) || 95362306a36Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_PROX_TRIGGER, &priv->flags)) 95462306a36Sopenharmony_ci /* This fires off the trigger. */ 95562306a36Sopenharmony_ci irq_work_queue(&priv->work); 95662306a36Sopenharmony_ci 95762306a36Sopenharmony_cidone: 95862306a36Sopenharmony_ci return IRQ_HANDLED; 95962306a36Sopenharmony_ci} 96062306a36Sopenharmony_ci 96162306a36Sopenharmony_cistatic irqreturn_t gp2ap020a00f_trigger_handler(int irq, void *data) 96262306a36Sopenharmony_ci{ 96362306a36Sopenharmony_ci struct iio_poll_func *pf = data; 96462306a36Sopenharmony_ci struct iio_dev *indio_dev = pf->indio_dev; 96562306a36Sopenharmony_ci struct gp2ap020a00f_data *priv = iio_priv(indio_dev); 96662306a36Sopenharmony_ci size_t d_size = 0; 96762306a36Sopenharmony_ci int i, out_val, ret; 96862306a36Sopenharmony_ci 96962306a36Sopenharmony_ci for_each_set_bit(i, indio_dev->active_scan_mask, 97062306a36Sopenharmony_ci indio_dev->masklength) { 97162306a36Sopenharmony_ci ret = regmap_bulk_read(priv->regmap, 97262306a36Sopenharmony_ci GP2AP020A00F_DATA_REG(i), 97362306a36Sopenharmony_ci &priv->buffer[d_size], 2); 97462306a36Sopenharmony_ci if (ret < 0) 97562306a36Sopenharmony_ci goto done; 97662306a36Sopenharmony_ci 97762306a36Sopenharmony_ci if (i == GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR || 97862306a36Sopenharmony_ci i == GP2AP020A00F_SCAN_MODE_LIGHT_IR) { 97962306a36Sopenharmony_ci out_val = le16_to_cpup((__le16 *)&priv->buffer[d_size]); 98062306a36Sopenharmony_ci gp2ap020a00f_output_to_lux(priv, &out_val); 98162306a36Sopenharmony_ci 98262306a36Sopenharmony_ci put_unaligned_le32(out_val, &priv->buffer[d_size]); 98362306a36Sopenharmony_ci d_size += 4; 98462306a36Sopenharmony_ci } else { 98562306a36Sopenharmony_ci d_size += 2; 98662306a36Sopenharmony_ci } 98762306a36Sopenharmony_ci } 98862306a36Sopenharmony_ci 98962306a36Sopenharmony_ci iio_push_to_buffers_with_timestamp(indio_dev, priv->buffer, 99062306a36Sopenharmony_ci pf->timestamp); 99162306a36Sopenharmony_cidone: 99262306a36Sopenharmony_ci iio_trigger_notify_done(indio_dev->trig); 99362306a36Sopenharmony_ci 99462306a36Sopenharmony_ci return IRQ_HANDLED; 99562306a36Sopenharmony_ci} 99662306a36Sopenharmony_ci 99762306a36Sopenharmony_cistatic u8 gp2ap020a00f_get_thresh_reg(const struct iio_chan_spec *chan, 99862306a36Sopenharmony_ci enum iio_event_direction event_dir) 99962306a36Sopenharmony_ci{ 100062306a36Sopenharmony_ci switch (chan->type) { 100162306a36Sopenharmony_ci case IIO_PROXIMITY: 100262306a36Sopenharmony_ci if (event_dir == IIO_EV_DIR_RISING) 100362306a36Sopenharmony_ci return GP2AP020A00F_PH_L_REG; 100462306a36Sopenharmony_ci else 100562306a36Sopenharmony_ci return GP2AP020A00F_PL_L_REG; 100662306a36Sopenharmony_ci case IIO_LIGHT: 100762306a36Sopenharmony_ci if (event_dir == IIO_EV_DIR_RISING) 100862306a36Sopenharmony_ci return GP2AP020A00F_TH_L_REG; 100962306a36Sopenharmony_ci else 101062306a36Sopenharmony_ci return GP2AP020A00F_TL_L_REG; 101162306a36Sopenharmony_ci default: 101262306a36Sopenharmony_ci break; 101362306a36Sopenharmony_ci } 101462306a36Sopenharmony_ci 101562306a36Sopenharmony_ci return -EINVAL; 101662306a36Sopenharmony_ci} 101762306a36Sopenharmony_ci 101862306a36Sopenharmony_cistatic int gp2ap020a00f_write_event_val(struct iio_dev *indio_dev, 101962306a36Sopenharmony_ci const struct iio_chan_spec *chan, 102062306a36Sopenharmony_ci enum iio_event_type type, 102162306a36Sopenharmony_ci enum iio_event_direction dir, 102262306a36Sopenharmony_ci enum iio_event_info info, 102362306a36Sopenharmony_ci int val, int val2) 102462306a36Sopenharmony_ci{ 102562306a36Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 102662306a36Sopenharmony_ci bool event_en = false; 102762306a36Sopenharmony_ci u8 thresh_val_id; 102862306a36Sopenharmony_ci u8 thresh_reg_l; 102962306a36Sopenharmony_ci int err = 0; 103062306a36Sopenharmony_ci 103162306a36Sopenharmony_ci mutex_lock(&data->lock); 103262306a36Sopenharmony_ci 103362306a36Sopenharmony_ci thresh_reg_l = gp2ap020a00f_get_thresh_reg(chan, dir); 103462306a36Sopenharmony_ci thresh_val_id = GP2AP020A00F_THRESH_VAL_ID(thresh_reg_l); 103562306a36Sopenharmony_ci 103662306a36Sopenharmony_ci if (thresh_val_id > GP2AP020A00F_THRESH_PH) { 103762306a36Sopenharmony_ci err = -EINVAL; 103862306a36Sopenharmony_ci goto error_unlock; 103962306a36Sopenharmony_ci } 104062306a36Sopenharmony_ci 104162306a36Sopenharmony_ci switch (thresh_reg_l) { 104262306a36Sopenharmony_ci case GP2AP020A00F_TH_L_REG: 104362306a36Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, 104462306a36Sopenharmony_ci &data->flags); 104562306a36Sopenharmony_ci break; 104662306a36Sopenharmony_ci case GP2AP020A00F_TL_L_REG: 104762306a36Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, 104862306a36Sopenharmony_ci &data->flags); 104962306a36Sopenharmony_ci break; 105062306a36Sopenharmony_ci case GP2AP020A00F_PH_L_REG: 105162306a36Sopenharmony_ci if (val == 0) { 105262306a36Sopenharmony_ci err = -EINVAL; 105362306a36Sopenharmony_ci goto error_unlock; 105462306a36Sopenharmony_ci } 105562306a36Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, 105662306a36Sopenharmony_ci &data->flags); 105762306a36Sopenharmony_ci break; 105862306a36Sopenharmony_ci case GP2AP020A00F_PL_L_REG: 105962306a36Sopenharmony_ci if (val == 0) { 106062306a36Sopenharmony_ci err = -EINVAL; 106162306a36Sopenharmony_ci goto error_unlock; 106262306a36Sopenharmony_ci } 106362306a36Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, 106462306a36Sopenharmony_ci &data->flags); 106562306a36Sopenharmony_ci break; 106662306a36Sopenharmony_ci } 106762306a36Sopenharmony_ci 106862306a36Sopenharmony_ci data->thresh_val[thresh_val_id] = val; 106962306a36Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, thresh_val_id, 107062306a36Sopenharmony_ci event_en); 107162306a36Sopenharmony_cierror_unlock: 107262306a36Sopenharmony_ci mutex_unlock(&data->lock); 107362306a36Sopenharmony_ci 107462306a36Sopenharmony_ci return err; 107562306a36Sopenharmony_ci} 107662306a36Sopenharmony_ci 107762306a36Sopenharmony_cistatic int gp2ap020a00f_read_event_val(struct iio_dev *indio_dev, 107862306a36Sopenharmony_ci const struct iio_chan_spec *chan, 107962306a36Sopenharmony_ci enum iio_event_type type, 108062306a36Sopenharmony_ci enum iio_event_direction dir, 108162306a36Sopenharmony_ci enum iio_event_info info, 108262306a36Sopenharmony_ci int *val, int *val2) 108362306a36Sopenharmony_ci{ 108462306a36Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 108562306a36Sopenharmony_ci u8 thresh_reg_l; 108662306a36Sopenharmony_ci int err = IIO_VAL_INT; 108762306a36Sopenharmony_ci 108862306a36Sopenharmony_ci mutex_lock(&data->lock); 108962306a36Sopenharmony_ci 109062306a36Sopenharmony_ci thresh_reg_l = gp2ap020a00f_get_thresh_reg(chan, dir); 109162306a36Sopenharmony_ci 109262306a36Sopenharmony_ci if (thresh_reg_l > GP2AP020A00F_PH_L_REG) { 109362306a36Sopenharmony_ci err = -EINVAL; 109462306a36Sopenharmony_ci goto error_unlock; 109562306a36Sopenharmony_ci } 109662306a36Sopenharmony_ci 109762306a36Sopenharmony_ci *val = data->thresh_val[GP2AP020A00F_THRESH_VAL_ID(thresh_reg_l)]; 109862306a36Sopenharmony_ci 109962306a36Sopenharmony_cierror_unlock: 110062306a36Sopenharmony_ci mutex_unlock(&data->lock); 110162306a36Sopenharmony_ci 110262306a36Sopenharmony_ci return err; 110362306a36Sopenharmony_ci} 110462306a36Sopenharmony_ci 110562306a36Sopenharmony_cistatic int gp2ap020a00f_write_prox_event_config(struct iio_dev *indio_dev, 110662306a36Sopenharmony_ci int state) 110762306a36Sopenharmony_ci{ 110862306a36Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 110962306a36Sopenharmony_ci enum gp2ap020a00f_cmd cmd_high_ev, cmd_low_ev; 111062306a36Sopenharmony_ci int err; 111162306a36Sopenharmony_ci 111262306a36Sopenharmony_ci cmd_high_ev = state ? GP2AP020A00F_CMD_PROX_HIGH_EV_EN : 111362306a36Sopenharmony_ci GP2AP020A00F_CMD_PROX_HIGH_EV_DIS; 111462306a36Sopenharmony_ci cmd_low_ev = state ? GP2AP020A00F_CMD_PROX_LOW_EV_EN : 111562306a36Sopenharmony_ci GP2AP020A00F_CMD_PROX_LOW_EV_DIS; 111662306a36Sopenharmony_ci 111762306a36Sopenharmony_ci /* 111862306a36Sopenharmony_ci * In order to enable proximity detection feature in the device 111962306a36Sopenharmony_ci * both high and low threshold registers have to be written 112062306a36Sopenharmony_ci * with different values, greater than zero. 112162306a36Sopenharmony_ci */ 112262306a36Sopenharmony_ci if (state) { 112362306a36Sopenharmony_ci if (data->thresh_val[GP2AP020A00F_THRESH_PL] == 0) 112462306a36Sopenharmony_ci return -EINVAL; 112562306a36Sopenharmony_ci 112662306a36Sopenharmony_ci if (data->thresh_val[GP2AP020A00F_THRESH_PH] == 0) 112762306a36Sopenharmony_ci return -EINVAL; 112862306a36Sopenharmony_ci } 112962306a36Sopenharmony_ci 113062306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd_high_ev); 113162306a36Sopenharmony_ci if (err < 0) 113262306a36Sopenharmony_ci return err; 113362306a36Sopenharmony_ci 113462306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd_low_ev); 113562306a36Sopenharmony_ci if (err < 0) 113662306a36Sopenharmony_ci return err; 113762306a36Sopenharmony_ci 113862306a36Sopenharmony_ci free_irq(data->client->irq, indio_dev); 113962306a36Sopenharmony_ci 114062306a36Sopenharmony_ci if (state) 114162306a36Sopenharmony_ci err = request_threaded_irq(data->client->irq, NULL, 114262306a36Sopenharmony_ci &gp2ap020a00f_prox_sensing_handler, 114362306a36Sopenharmony_ci IRQF_TRIGGER_RISING | 114462306a36Sopenharmony_ci IRQF_TRIGGER_FALLING | 114562306a36Sopenharmony_ci IRQF_ONESHOT, 114662306a36Sopenharmony_ci "gp2ap020a00f_prox_sensing", 114762306a36Sopenharmony_ci indio_dev); 114862306a36Sopenharmony_ci else { 114962306a36Sopenharmony_ci err = request_threaded_irq(data->client->irq, NULL, 115062306a36Sopenharmony_ci &gp2ap020a00f_thresh_event_handler, 115162306a36Sopenharmony_ci IRQF_TRIGGER_FALLING | 115262306a36Sopenharmony_ci IRQF_ONESHOT, 115362306a36Sopenharmony_ci "gp2ap020a00f_thresh_event", 115462306a36Sopenharmony_ci indio_dev); 115562306a36Sopenharmony_ci } 115662306a36Sopenharmony_ci 115762306a36Sopenharmony_ci return err; 115862306a36Sopenharmony_ci} 115962306a36Sopenharmony_ci 116062306a36Sopenharmony_cistatic int gp2ap020a00f_write_event_config(struct iio_dev *indio_dev, 116162306a36Sopenharmony_ci const struct iio_chan_spec *chan, 116262306a36Sopenharmony_ci enum iio_event_type type, 116362306a36Sopenharmony_ci enum iio_event_direction dir, 116462306a36Sopenharmony_ci int state) 116562306a36Sopenharmony_ci{ 116662306a36Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 116762306a36Sopenharmony_ci enum gp2ap020a00f_cmd cmd; 116862306a36Sopenharmony_ci int err; 116962306a36Sopenharmony_ci 117062306a36Sopenharmony_ci mutex_lock(&data->lock); 117162306a36Sopenharmony_ci 117262306a36Sopenharmony_ci switch (chan->type) { 117362306a36Sopenharmony_ci case IIO_PROXIMITY: 117462306a36Sopenharmony_ci err = gp2ap020a00f_write_prox_event_config(indio_dev, state); 117562306a36Sopenharmony_ci break; 117662306a36Sopenharmony_ci case IIO_LIGHT: 117762306a36Sopenharmony_ci if (dir == IIO_EV_DIR_RISING) { 117862306a36Sopenharmony_ci cmd = state ? GP2AP020A00F_CMD_ALS_HIGH_EV_EN : 117962306a36Sopenharmony_ci GP2AP020A00F_CMD_ALS_HIGH_EV_DIS; 118062306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd); 118162306a36Sopenharmony_ci } else { 118262306a36Sopenharmony_ci cmd = state ? GP2AP020A00F_CMD_ALS_LOW_EV_EN : 118362306a36Sopenharmony_ci GP2AP020A00F_CMD_ALS_LOW_EV_DIS; 118462306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd); 118562306a36Sopenharmony_ci } 118662306a36Sopenharmony_ci break; 118762306a36Sopenharmony_ci default: 118862306a36Sopenharmony_ci err = -EINVAL; 118962306a36Sopenharmony_ci } 119062306a36Sopenharmony_ci 119162306a36Sopenharmony_ci mutex_unlock(&data->lock); 119262306a36Sopenharmony_ci 119362306a36Sopenharmony_ci return err; 119462306a36Sopenharmony_ci} 119562306a36Sopenharmony_ci 119662306a36Sopenharmony_cistatic int gp2ap020a00f_read_event_config(struct iio_dev *indio_dev, 119762306a36Sopenharmony_ci const struct iio_chan_spec *chan, 119862306a36Sopenharmony_ci enum iio_event_type type, 119962306a36Sopenharmony_ci enum iio_event_direction dir) 120062306a36Sopenharmony_ci{ 120162306a36Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 120262306a36Sopenharmony_ci int event_en = 0; 120362306a36Sopenharmony_ci 120462306a36Sopenharmony_ci mutex_lock(&data->lock); 120562306a36Sopenharmony_ci 120662306a36Sopenharmony_ci switch (chan->type) { 120762306a36Sopenharmony_ci case IIO_PROXIMITY: 120862306a36Sopenharmony_ci if (dir == IIO_EV_DIR_RISING) 120962306a36Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, 121062306a36Sopenharmony_ci &data->flags); 121162306a36Sopenharmony_ci else 121262306a36Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, 121362306a36Sopenharmony_ci &data->flags); 121462306a36Sopenharmony_ci break; 121562306a36Sopenharmony_ci case IIO_LIGHT: 121662306a36Sopenharmony_ci if (dir == IIO_EV_DIR_RISING) 121762306a36Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, 121862306a36Sopenharmony_ci &data->flags); 121962306a36Sopenharmony_ci else 122062306a36Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, 122162306a36Sopenharmony_ci &data->flags); 122262306a36Sopenharmony_ci break; 122362306a36Sopenharmony_ci default: 122462306a36Sopenharmony_ci event_en = -EINVAL; 122562306a36Sopenharmony_ci break; 122662306a36Sopenharmony_ci } 122762306a36Sopenharmony_ci 122862306a36Sopenharmony_ci mutex_unlock(&data->lock); 122962306a36Sopenharmony_ci 123062306a36Sopenharmony_ci return event_en; 123162306a36Sopenharmony_ci} 123262306a36Sopenharmony_ci 123362306a36Sopenharmony_cistatic int gp2ap020a00f_read_channel(struct gp2ap020a00f_data *data, 123462306a36Sopenharmony_ci struct iio_chan_spec const *chan, int *val) 123562306a36Sopenharmony_ci{ 123662306a36Sopenharmony_ci enum gp2ap020a00f_cmd cmd; 123762306a36Sopenharmony_ci int err; 123862306a36Sopenharmony_ci 123962306a36Sopenharmony_ci switch (chan->scan_index) { 124062306a36Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR: 124162306a36Sopenharmony_ci cmd = GP2AP020A00F_CMD_READ_RAW_CLEAR; 124262306a36Sopenharmony_ci break; 124362306a36Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_IR: 124462306a36Sopenharmony_ci cmd = GP2AP020A00F_CMD_READ_RAW_IR; 124562306a36Sopenharmony_ci break; 124662306a36Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_PROXIMITY: 124762306a36Sopenharmony_ci cmd = GP2AP020A00F_CMD_READ_RAW_PROXIMITY; 124862306a36Sopenharmony_ci break; 124962306a36Sopenharmony_ci default: 125062306a36Sopenharmony_ci return -EINVAL; 125162306a36Sopenharmony_ci } 125262306a36Sopenharmony_ci 125362306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd); 125462306a36Sopenharmony_ci if (err < 0) { 125562306a36Sopenharmony_ci dev_err(&data->client->dev, 125662306a36Sopenharmony_ci "gp2ap020a00f_exec_cmd failed\n"); 125762306a36Sopenharmony_ci goto error_ret; 125862306a36Sopenharmony_ci } 125962306a36Sopenharmony_ci 126062306a36Sopenharmony_ci err = gp2ap020a00f_read_output(data, chan->address, val); 126162306a36Sopenharmony_ci if (err < 0) 126262306a36Sopenharmony_ci dev_err(&data->client->dev, 126362306a36Sopenharmony_ci "gp2ap020a00f_read_output failed\n"); 126462306a36Sopenharmony_ci 126562306a36Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 126662306a36Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN); 126762306a36Sopenharmony_ci if (err < 0) 126862306a36Sopenharmony_ci dev_err(&data->client->dev, 126962306a36Sopenharmony_ci "Failed to shut down the device.\n"); 127062306a36Sopenharmony_ci 127162306a36Sopenharmony_ci if (cmd == GP2AP020A00F_CMD_READ_RAW_CLEAR || 127262306a36Sopenharmony_ci cmd == GP2AP020A00F_CMD_READ_RAW_IR) 127362306a36Sopenharmony_ci gp2ap020a00f_output_to_lux(data, val); 127462306a36Sopenharmony_ci 127562306a36Sopenharmony_cierror_ret: 127662306a36Sopenharmony_ci return err; 127762306a36Sopenharmony_ci} 127862306a36Sopenharmony_ci 127962306a36Sopenharmony_cistatic int gp2ap020a00f_read_raw(struct iio_dev *indio_dev, 128062306a36Sopenharmony_ci struct iio_chan_spec const *chan, 128162306a36Sopenharmony_ci int *val, int *val2, 128262306a36Sopenharmony_ci long mask) 128362306a36Sopenharmony_ci{ 128462306a36Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 128562306a36Sopenharmony_ci int err = -EINVAL; 128662306a36Sopenharmony_ci 128762306a36Sopenharmony_ci if (mask == IIO_CHAN_INFO_RAW) { 128862306a36Sopenharmony_ci err = iio_device_claim_direct_mode(indio_dev); 128962306a36Sopenharmony_ci if (err) 129062306a36Sopenharmony_ci return err; 129162306a36Sopenharmony_ci 129262306a36Sopenharmony_ci err = gp2ap020a00f_read_channel(data, chan, val); 129362306a36Sopenharmony_ci iio_device_release_direct_mode(indio_dev); 129462306a36Sopenharmony_ci } 129562306a36Sopenharmony_ci return err < 0 ? err : IIO_VAL_INT; 129662306a36Sopenharmony_ci} 129762306a36Sopenharmony_ci 129862306a36Sopenharmony_cistatic const struct iio_event_spec gp2ap020a00f_event_spec_light[] = { 129962306a36Sopenharmony_ci { 130062306a36Sopenharmony_ci .type = IIO_EV_TYPE_THRESH, 130162306a36Sopenharmony_ci .dir = IIO_EV_DIR_RISING, 130262306a36Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_VALUE) | 130362306a36Sopenharmony_ci BIT(IIO_EV_INFO_ENABLE), 130462306a36Sopenharmony_ci }, { 130562306a36Sopenharmony_ci .type = IIO_EV_TYPE_THRESH, 130662306a36Sopenharmony_ci .dir = IIO_EV_DIR_FALLING, 130762306a36Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_VALUE) | 130862306a36Sopenharmony_ci BIT(IIO_EV_INFO_ENABLE), 130962306a36Sopenharmony_ci }, 131062306a36Sopenharmony_ci}; 131162306a36Sopenharmony_ci 131262306a36Sopenharmony_cistatic const struct iio_event_spec gp2ap020a00f_event_spec_prox[] = { 131362306a36Sopenharmony_ci { 131462306a36Sopenharmony_ci .type = IIO_EV_TYPE_ROC, 131562306a36Sopenharmony_ci .dir = IIO_EV_DIR_RISING, 131662306a36Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_VALUE) | 131762306a36Sopenharmony_ci BIT(IIO_EV_INFO_ENABLE), 131862306a36Sopenharmony_ci }, { 131962306a36Sopenharmony_ci .type = IIO_EV_TYPE_ROC, 132062306a36Sopenharmony_ci .dir = IIO_EV_DIR_FALLING, 132162306a36Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_VALUE) | 132262306a36Sopenharmony_ci BIT(IIO_EV_INFO_ENABLE), 132362306a36Sopenharmony_ci }, 132462306a36Sopenharmony_ci}; 132562306a36Sopenharmony_ci 132662306a36Sopenharmony_cistatic const struct iio_chan_spec gp2ap020a00f_channels[] = { 132762306a36Sopenharmony_ci { 132862306a36Sopenharmony_ci .type = IIO_LIGHT, 132962306a36Sopenharmony_ci .channel2 = IIO_MOD_LIGHT_CLEAR, 133062306a36Sopenharmony_ci .modified = 1, 133162306a36Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 133262306a36Sopenharmony_ci .scan_type = { 133362306a36Sopenharmony_ci .sign = 'u', 133462306a36Sopenharmony_ci .realbits = 24, 133562306a36Sopenharmony_ci .shift = 0, 133662306a36Sopenharmony_ci .storagebits = 32, 133762306a36Sopenharmony_ci .endianness = IIO_LE, 133862306a36Sopenharmony_ci }, 133962306a36Sopenharmony_ci .scan_index = GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR, 134062306a36Sopenharmony_ci .address = GP2AP020A00F_D0_L_REG, 134162306a36Sopenharmony_ci .event_spec = gp2ap020a00f_event_spec_light, 134262306a36Sopenharmony_ci .num_event_specs = ARRAY_SIZE(gp2ap020a00f_event_spec_light), 134362306a36Sopenharmony_ci }, 134462306a36Sopenharmony_ci { 134562306a36Sopenharmony_ci .type = IIO_LIGHT, 134662306a36Sopenharmony_ci .channel2 = IIO_MOD_LIGHT_IR, 134762306a36Sopenharmony_ci .modified = 1, 134862306a36Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 134962306a36Sopenharmony_ci .scan_type = { 135062306a36Sopenharmony_ci .sign = 'u', 135162306a36Sopenharmony_ci .realbits = 24, 135262306a36Sopenharmony_ci .shift = 0, 135362306a36Sopenharmony_ci .storagebits = 32, 135462306a36Sopenharmony_ci .endianness = IIO_LE, 135562306a36Sopenharmony_ci }, 135662306a36Sopenharmony_ci .scan_index = GP2AP020A00F_SCAN_MODE_LIGHT_IR, 135762306a36Sopenharmony_ci .address = GP2AP020A00F_D1_L_REG, 135862306a36Sopenharmony_ci }, 135962306a36Sopenharmony_ci { 136062306a36Sopenharmony_ci .type = IIO_PROXIMITY, 136162306a36Sopenharmony_ci .modified = 0, 136262306a36Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 136362306a36Sopenharmony_ci .scan_type = { 136462306a36Sopenharmony_ci .sign = 'u', 136562306a36Sopenharmony_ci .realbits = 16, 136662306a36Sopenharmony_ci .shift = 0, 136762306a36Sopenharmony_ci .storagebits = 16, 136862306a36Sopenharmony_ci .endianness = IIO_LE, 136962306a36Sopenharmony_ci }, 137062306a36Sopenharmony_ci .scan_index = GP2AP020A00F_SCAN_MODE_PROXIMITY, 137162306a36Sopenharmony_ci .address = GP2AP020A00F_D2_L_REG, 137262306a36Sopenharmony_ci .event_spec = gp2ap020a00f_event_spec_prox, 137362306a36Sopenharmony_ci .num_event_specs = ARRAY_SIZE(gp2ap020a00f_event_spec_prox), 137462306a36Sopenharmony_ci }, 137562306a36Sopenharmony_ci IIO_CHAN_SOFT_TIMESTAMP(GP2AP020A00F_CHAN_TIMESTAMP), 137662306a36Sopenharmony_ci}; 137762306a36Sopenharmony_ci 137862306a36Sopenharmony_cistatic const struct iio_info gp2ap020a00f_info = { 137962306a36Sopenharmony_ci .read_raw = &gp2ap020a00f_read_raw, 138062306a36Sopenharmony_ci .read_event_value = &gp2ap020a00f_read_event_val, 138162306a36Sopenharmony_ci .read_event_config = &gp2ap020a00f_read_event_config, 138262306a36Sopenharmony_ci .write_event_value = &gp2ap020a00f_write_event_val, 138362306a36Sopenharmony_ci .write_event_config = &gp2ap020a00f_write_event_config, 138462306a36Sopenharmony_ci}; 138562306a36Sopenharmony_ci 138662306a36Sopenharmony_cistatic int gp2ap020a00f_buffer_postenable(struct iio_dev *indio_dev) 138762306a36Sopenharmony_ci{ 138862306a36Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 138962306a36Sopenharmony_ci int i, err = 0; 139062306a36Sopenharmony_ci 139162306a36Sopenharmony_ci mutex_lock(&data->lock); 139262306a36Sopenharmony_ci 139362306a36Sopenharmony_ci /* 139462306a36Sopenharmony_ci * Enable triggers according to the scan_mask. Enabling either 139562306a36Sopenharmony_ci * LIGHT_CLEAR or LIGHT_IR scan mode results in enabling ALS 139662306a36Sopenharmony_ci * module in the device, which generates samples in both D0 (clear) 139762306a36Sopenharmony_ci * and D1 (ir) registers. As the two registers are bound to the 139862306a36Sopenharmony_ci * two separate IIO channels they are treated in the driver logic 139962306a36Sopenharmony_ci * as if they were controlled independently. 140062306a36Sopenharmony_ci */ 140162306a36Sopenharmony_ci for_each_set_bit(i, indio_dev->active_scan_mask, 140262306a36Sopenharmony_ci indio_dev->masklength) { 140362306a36Sopenharmony_ci switch (i) { 140462306a36Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR: 140562306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 140662306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_CLEAR_EN); 140762306a36Sopenharmony_ci break; 140862306a36Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_IR: 140962306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 141062306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_IR_EN); 141162306a36Sopenharmony_ci break; 141262306a36Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_PROXIMITY: 141362306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 141462306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_PROX_EN); 141562306a36Sopenharmony_ci break; 141662306a36Sopenharmony_ci } 141762306a36Sopenharmony_ci } 141862306a36Sopenharmony_ci 141962306a36Sopenharmony_ci if (err < 0) 142062306a36Sopenharmony_ci goto error_unlock; 142162306a36Sopenharmony_ci 142262306a36Sopenharmony_ci data->buffer = kmalloc(indio_dev->scan_bytes, GFP_KERNEL); 142362306a36Sopenharmony_ci if (!data->buffer) 142462306a36Sopenharmony_ci err = -ENOMEM; 142562306a36Sopenharmony_ci 142662306a36Sopenharmony_cierror_unlock: 142762306a36Sopenharmony_ci mutex_unlock(&data->lock); 142862306a36Sopenharmony_ci 142962306a36Sopenharmony_ci return err; 143062306a36Sopenharmony_ci} 143162306a36Sopenharmony_ci 143262306a36Sopenharmony_cistatic int gp2ap020a00f_buffer_predisable(struct iio_dev *indio_dev) 143362306a36Sopenharmony_ci{ 143462306a36Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 143562306a36Sopenharmony_ci int i, err = 0; 143662306a36Sopenharmony_ci 143762306a36Sopenharmony_ci mutex_lock(&data->lock); 143862306a36Sopenharmony_ci 143962306a36Sopenharmony_ci for_each_set_bit(i, indio_dev->active_scan_mask, 144062306a36Sopenharmony_ci indio_dev->masklength) { 144162306a36Sopenharmony_ci switch (i) { 144262306a36Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR: 144362306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 144462306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_CLEAR_DIS); 144562306a36Sopenharmony_ci break; 144662306a36Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_IR: 144762306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 144862306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_IR_DIS); 144962306a36Sopenharmony_ci break; 145062306a36Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_PROXIMITY: 145162306a36Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 145262306a36Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_PROX_DIS); 145362306a36Sopenharmony_ci break; 145462306a36Sopenharmony_ci } 145562306a36Sopenharmony_ci } 145662306a36Sopenharmony_ci 145762306a36Sopenharmony_ci if (err == 0) 145862306a36Sopenharmony_ci kfree(data->buffer); 145962306a36Sopenharmony_ci 146062306a36Sopenharmony_ci mutex_unlock(&data->lock); 146162306a36Sopenharmony_ci 146262306a36Sopenharmony_ci return err; 146362306a36Sopenharmony_ci} 146462306a36Sopenharmony_ci 146562306a36Sopenharmony_cistatic const struct iio_buffer_setup_ops gp2ap020a00f_buffer_setup_ops = { 146662306a36Sopenharmony_ci .postenable = &gp2ap020a00f_buffer_postenable, 146762306a36Sopenharmony_ci .predisable = &gp2ap020a00f_buffer_predisable, 146862306a36Sopenharmony_ci}; 146962306a36Sopenharmony_ci 147062306a36Sopenharmony_cistatic int gp2ap020a00f_probe(struct i2c_client *client) 147162306a36Sopenharmony_ci{ 147262306a36Sopenharmony_ci const struct i2c_device_id *id = i2c_client_get_device_id(client); 147362306a36Sopenharmony_ci struct gp2ap020a00f_data *data; 147462306a36Sopenharmony_ci struct iio_dev *indio_dev; 147562306a36Sopenharmony_ci struct regmap *regmap; 147662306a36Sopenharmony_ci int err; 147762306a36Sopenharmony_ci 147862306a36Sopenharmony_ci indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 147962306a36Sopenharmony_ci if (!indio_dev) 148062306a36Sopenharmony_ci return -ENOMEM; 148162306a36Sopenharmony_ci 148262306a36Sopenharmony_ci data = iio_priv(indio_dev); 148362306a36Sopenharmony_ci 148462306a36Sopenharmony_ci data->vled_reg = devm_regulator_get(&client->dev, "vled"); 148562306a36Sopenharmony_ci if (IS_ERR(data->vled_reg)) 148662306a36Sopenharmony_ci return PTR_ERR(data->vled_reg); 148762306a36Sopenharmony_ci 148862306a36Sopenharmony_ci err = regulator_enable(data->vled_reg); 148962306a36Sopenharmony_ci if (err) 149062306a36Sopenharmony_ci return err; 149162306a36Sopenharmony_ci 149262306a36Sopenharmony_ci regmap = devm_regmap_init_i2c(client, &gp2ap020a00f_regmap_config); 149362306a36Sopenharmony_ci if (IS_ERR(regmap)) { 149462306a36Sopenharmony_ci dev_err(&client->dev, "Regmap initialization failed.\n"); 149562306a36Sopenharmony_ci err = PTR_ERR(regmap); 149662306a36Sopenharmony_ci goto error_regulator_disable; 149762306a36Sopenharmony_ci } 149862306a36Sopenharmony_ci 149962306a36Sopenharmony_ci /* Initialize device registers */ 150062306a36Sopenharmony_ci err = regmap_bulk_write(regmap, GP2AP020A00F_OP_REG, 150162306a36Sopenharmony_ci gp2ap020a00f_reg_init_tab, 150262306a36Sopenharmony_ci ARRAY_SIZE(gp2ap020a00f_reg_init_tab)); 150362306a36Sopenharmony_ci 150462306a36Sopenharmony_ci if (err < 0) { 150562306a36Sopenharmony_ci dev_err(&client->dev, "Device initialization failed.\n"); 150662306a36Sopenharmony_ci goto error_regulator_disable; 150762306a36Sopenharmony_ci } 150862306a36Sopenharmony_ci 150962306a36Sopenharmony_ci i2c_set_clientdata(client, indio_dev); 151062306a36Sopenharmony_ci 151162306a36Sopenharmony_ci data->client = client; 151262306a36Sopenharmony_ci data->cur_opmode = GP2AP020A00F_OPMODE_SHUTDOWN; 151362306a36Sopenharmony_ci data->regmap = regmap; 151462306a36Sopenharmony_ci init_waitqueue_head(&data->data_ready_queue); 151562306a36Sopenharmony_ci 151662306a36Sopenharmony_ci mutex_init(&data->lock); 151762306a36Sopenharmony_ci indio_dev->channels = gp2ap020a00f_channels; 151862306a36Sopenharmony_ci indio_dev->num_channels = ARRAY_SIZE(gp2ap020a00f_channels); 151962306a36Sopenharmony_ci indio_dev->info = &gp2ap020a00f_info; 152062306a36Sopenharmony_ci indio_dev->name = id->name; 152162306a36Sopenharmony_ci indio_dev->modes = INDIO_DIRECT_MODE; 152262306a36Sopenharmony_ci 152362306a36Sopenharmony_ci /* Allocate buffer */ 152462306a36Sopenharmony_ci err = iio_triggered_buffer_setup(indio_dev, &iio_pollfunc_store_time, 152562306a36Sopenharmony_ci &gp2ap020a00f_trigger_handler, &gp2ap020a00f_buffer_setup_ops); 152662306a36Sopenharmony_ci if (err < 0) 152762306a36Sopenharmony_ci goto error_regulator_disable; 152862306a36Sopenharmony_ci 152962306a36Sopenharmony_ci /* Allocate trigger */ 153062306a36Sopenharmony_ci data->trig = devm_iio_trigger_alloc(&client->dev, "%s-trigger", 153162306a36Sopenharmony_ci indio_dev->name); 153262306a36Sopenharmony_ci if (data->trig == NULL) { 153362306a36Sopenharmony_ci err = -ENOMEM; 153462306a36Sopenharmony_ci dev_err(&indio_dev->dev, "Failed to allocate iio trigger.\n"); 153562306a36Sopenharmony_ci goto error_uninit_buffer; 153662306a36Sopenharmony_ci } 153762306a36Sopenharmony_ci 153862306a36Sopenharmony_ci /* This needs to be requested here for read_raw calls to work. */ 153962306a36Sopenharmony_ci err = request_threaded_irq(client->irq, NULL, 154062306a36Sopenharmony_ci &gp2ap020a00f_thresh_event_handler, 154162306a36Sopenharmony_ci IRQF_TRIGGER_FALLING | 154262306a36Sopenharmony_ci IRQF_ONESHOT, 154362306a36Sopenharmony_ci "gp2ap020a00f_als_event", 154462306a36Sopenharmony_ci indio_dev); 154562306a36Sopenharmony_ci if (err < 0) { 154662306a36Sopenharmony_ci dev_err(&client->dev, "Irq request failed.\n"); 154762306a36Sopenharmony_ci goto error_uninit_buffer; 154862306a36Sopenharmony_ci } 154962306a36Sopenharmony_ci 155062306a36Sopenharmony_ci init_irq_work(&data->work, gp2ap020a00f_iio_trigger_work); 155162306a36Sopenharmony_ci 155262306a36Sopenharmony_ci err = iio_trigger_register(data->trig); 155362306a36Sopenharmony_ci if (err < 0) { 155462306a36Sopenharmony_ci dev_err(&client->dev, "Failed to register iio trigger.\n"); 155562306a36Sopenharmony_ci goto error_free_irq; 155662306a36Sopenharmony_ci } 155762306a36Sopenharmony_ci 155862306a36Sopenharmony_ci err = iio_device_register(indio_dev); 155962306a36Sopenharmony_ci if (err < 0) 156062306a36Sopenharmony_ci goto error_trigger_unregister; 156162306a36Sopenharmony_ci 156262306a36Sopenharmony_ci return 0; 156362306a36Sopenharmony_ci 156462306a36Sopenharmony_cierror_trigger_unregister: 156562306a36Sopenharmony_ci iio_trigger_unregister(data->trig); 156662306a36Sopenharmony_cierror_free_irq: 156762306a36Sopenharmony_ci free_irq(client->irq, indio_dev); 156862306a36Sopenharmony_cierror_uninit_buffer: 156962306a36Sopenharmony_ci iio_triggered_buffer_cleanup(indio_dev); 157062306a36Sopenharmony_cierror_regulator_disable: 157162306a36Sopenharmony_ci regulator_disable(data->vled_reg); 157262306a36Sopenharmony_ci 157362306a36Sopenharmony_ci return err; 157462306a36Sopenharmony_ci} 157562306a36Sopenharmony_ci 157662306a36Sopenharmony_cistatic void gp2ap020a00f_remove(struct i2c_client *client) 157762306a36Sopenharmony_ci{ 157862306a36Sopenharmony_ci struct iio_dev *indio_dev = i2c_get_clientdata(client); 157962306a36Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 158062306a36Sopenharmony_ci int err; 158162306a36Sopenharmony_ci 158262306a36Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 158362306a36Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN); 158462306a36Sopenharmony_ci if (err < 0) 158562306a36Sopenharmony_ci dev_err(&indio_dev->dev, "Failed to power off the device.\n"); 158662306a36Sopenharmony_ci 158762306a36Sopenharmony_ci iio_device_unregister(indio_dev); 158862306a36Sopenharmony_ci iio_trigger_unregister(data->trig); 158962306a36Sopenharmony_ci free_irq(client->irq, indio_dev); 159062306a36Sopenharmony_ci iio_triggered_buffer_cleanup(indio_dev); 159162306a36Sopenharmony_ci regulator_disable(data->vled_reg); 159262306a36Sopenharmony_ci} 159362306a36Sopenharmony_ci 159462306a36Sopenharmony_cistatic const struct i2c_device_id gp2ap020a00f_id[] = { 159562306a36Sopenharmony_ci { GP2A_I2C_NAME, 0 }, 159662306a36Sopenharmony_ci { } 159762306a36Sopenharmony_ci}; 159862306a36Sopenharmony_ci 159962306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, gp2ap020a00f_id); 160062306a36Sopenharmony_ci 160162306a36Sopenharmony_cistatic const struct of_device_id gp2ap020a00f_of_match[] = { 160262306a36Sopenharmony_ci { .compatible = "sharp,gp2ap020a00f" }, 160362306a36Sopenharmony_ci { } 160462306a36Sopenharmony_ci}; 160562306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, gp2ap020a00f_of_match); 160662306a36Sopenharmony_ci 160762306a36Sopenharmony_cistatic struct i2c_driver gp2ap020a00f_driver = { 160862306a36Sopenharmony_ci .driver = { 160962306a36Sopenharmony_ci .name = GP2A_I2C_NAME, 161062306a36Sopenharmony_ci .of_match_table = gp2ap020a00f_of_match, 161162306a36Sopenharmony_ci }, 161262306a36Sopenharmony_ci .probe = gp2ap020a00f_probe, 161362306a36Sopenharmony_ci .remove = gp2ap020a00f_remove, 161462306a36Sopenharmony_ci .id_table = gp2ap020a00f_id, 161562306a36Sopenharmony_ci}; 161662306a36Sopenharmony_ci 161762306a36Sopenharmony_cimodule_i2c_driver(gp2ap020a00f_driver); 161862306a36Sopenharmony_ci 161962306a36Sopenharmony_ciMODULE_AUTHOR("Jacek Anaszewski <j.anaszewski@samsung.com>"); 162062306a36Sopenharmony_ciMODULE_DESCRIPTION("Sharp GP2AP020A00F Proximity/ALS sensor driver"); 162162306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 1622