18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (C) 2013 Samsung Electronics Co., Ltd. 48c2ecf20Sopenharmony_ci * Author: Jacek Anaszewski <j.anaszewski@samsung.com> 58c2ecf20Sopenharmony_ci * 68c2ecf20Sopenharmony_ci * IIO features supported by the driver: 78c2ecf20Sopenharmony_ci * 88c2ecf20Sopenharmony_ci * Read-only raw channels: 98c2ecf20Sopenharmony_ci * - illuminance_clear [lux] 108c2ecf20Sopenharmony_ci * - illuminance_ir 118c2ecf20Sopenharmony_ci * - proximity 128c2ecf20Sopenharmony_ci * 138c2ecf20Sopenharmony_ci * Triggered buffer: 148c2ecf20Sopenharmony_ci * - illuminance_clear 158c2ecf20Sopenharmony_ci * - illuminance_ir 168c2ecf20Sopenharmony_ci * - proximity 178c2ecf20Sopenharmony_ci * 188c2ecf20Sopenharmony_ci * Events: 198c2ecf20Sopenharmony_ci * - illuminance_clear (rising and falling) 208c2ecf20Sopenharmony_ci * - proximity (rising and falling) 218c2ecf20Sopenharmony_ci * - both falling and rising thresholds for the proximity events 228c2ecf20Sopenharmony_ci * must be set to the values greater than 0. 238c2ecf20Sopenharmony_ci * 248c2ecf20Sopenharmony_ci * The driver supports triggered buffers for all the three 258c2ecf20Sopenharmony_ci * channels as well as high and low threshold events for the 268c2ecf20Sopenharmony_ci * illuminance_clear and proxmimity channels. Triggers 278c2ecf20Sopenharmony_ci * can be enabled simultaneously with both illuminance_clear 288c2ecf20Sopenharmony_ci * events. Proximity events cannot be enabled simultaneously 298c2ecf20Sopenharmony_ci * with any triggers or illuminance events. Enabling/disabling 308c2ecf20Sopenharmony_ci * one of the proximity events automatically enables/disables 318c2ecf20Sopenharmony_ci * the other one. 328c2ecf20Sopenharmony_ci */ 338c2ecf20Sopenharmony_ci 348c2ecf20Sopenharmony_ci#include <linux/debugfs.h> 358c2ecf20Sopenharmony_ci#include <linux/delay.h> 368c2ecf20Sopenharmony_ci#include <linux/i2c.h> 378c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 388c2ecf20Sopenharmony_ci#include <linux/irq.h> 398c2ecf20Sopenharmony_ci#include <linux/irq_work.h> 408c2ecf20Sopenharmony_ci#include <linux/module.h> 418c2ecf20Sopenharmony_ci#include <linux/mod_devicetable.h> 428c2ecf20Sopenharmony_ci#include <linux/mutex.h> 438c2ecf20Sopenharmony_ci#include <linux/regmap.h> 448c2ecf20Sopenharmony_ci#include <linux/regulator/consumer.h> 458c2ecf20Sopenharmony_ci#include <linux/slab.h> 468c2ecf20Sopenharmony_ci#include <asm/unaligned.h> 478c2ecf20Sopenharmony_ci#include <linux/iio/buffer.h> 488c2ecf20Sopenharmony_ci#include <linux/iio/events.h> 498c2ecf20Sopenharmony_ci#include <linux/iio/iio.h> 508c2ecf20Sopenharmony_ci#include <linux/iio/sysfs.h> 518c2ecf20Sopenharmony_ci#include <linux/iio/trigger.h> 528c2ecf20Sopenharmony_ci#include <linux/iio/trigger_consumer.h> 538c2ecf20Sopenharmony_ci#include <linux/iio/triggered_buffer.h> 548c2ecf20Sopenharmony_ci 558c2ecf20Sopenharmony_ci#define GP2A_I2C_NAME "gp2ap020a00f" 568c2ecf20Sopenharmony_ci 578c2ecf20Sopenharmony_ci/* Registers */ 588c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP_REG 0x00 /* Basic operations */ 598c2ecf20Sopenharmony_ci#define GP2AP020A00F_ALS_REG 0x01 /* ALS related settings */ 608c2ecf20Sopenharmony_ci#define GP2AP020A00F_PS_REG 0x02 /* PS related settings */ 618c2ecf20Sopenharmony_ci#define GP2AP020A00F_LED_REG 0x03 /* LED reg */ 628c2ecf20Sopenharmony_ci#define GP2AP020A00F_TL_L_REG 0x04 /* ALS: Threshold low LSB */ 638c2ecf20Sopenharmony_ci#define GP2AP020A00F_TL_H_REG 0x05 /* ALS: Threshold low MSB */ 648c2ecf20Sopenharmony_ci#define GP2AP020A00F_TH_L_REG 0x06 /* ALS: Threshold high LSB */ 658c2ecf20Sopenharmony_ci#define GP2AP020A00F_TH_H_REG 0x07 /* ALS: Threshold high MSB */ 668c2ecf20Sopenharmony_ci#define GP2AP020A00F_PL_L_REG 0x08 /* PS: Threshold low LSB */ 678c2ecf20Sopenharmony_ci#define GP2AP020A00F_PL_H_REG 0x09 /* PS: Threshold low MSB */ 688c2ecf20Sopenharmony_ci#define GP2AP020A00F_PH_L_REG 0x0a /* PS: Threshold high LSB */ 698c2ecf20Sopenharmony_ci#define GP2AP020A00F_PH_H_REG 0x0b /* PS: Threshold high MSB */ 708c2ecf20Sopenharmony_ci#define GP2AP020A00F_D0_L_REG 0x0c /* ALS result: Clear/Illuminance LSB */ 718c2ecf20Sopenharmony_ci#define GP2AP020A00F_D0_H_REG 0x0d /* ALS result: Clear/Illuminance MSB */ 728c2ecf20Sopenharmony_ci#define GP2AP020A00F_D1_L_REG 0x0e /* ALS result: IR LSB */ 738c2ecf20Sopenharmony_ci#define GP2AP020A00F_D1_H_REG 0x0f /* ALS result: IR LSB */ 748c2ecf20Sopenharmony_ci#define GP2AP020A00F_D2_L_REG 0x10 /* PS result LSB */ 758c2ecf20Sopenharmony_ci#define GP2AP020A00F_D2_H_REG 0x11 /* PS result MSB */ 768c2ecf20Sopenharmony_ci#define GP2AP020A00F_NUM_REGS 0x12 /* Number of registers */ 778c2ecf20Sopenharmony_ci 788c2ecf20Sopenharmony_ci/* OP_REG bits */ 798c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP3_MASK 0x80 /* Software shutdown */ 808c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP3_SHUTDOWN 0x00 818c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP3_OPERATION 0x80 828c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP2_MASK 0x40 /* Auto shutdown/Continuous mode */ 838c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP2_AUTO_SHUTDOWN 0x00 848c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP2_CONT_OPERATION 0x40 858c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP_MASK 0x30 /* Operating mode selection */ 868c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP_ALS_AND_PS 0x00 878c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP_ALS 0x10 888c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP_PS 0x20 898c2ecf20Sopenharmony_ci#define GP2AP020A00F_OP_DEBUG 0x30 908c2ecf20Sopenharmony_ci#define GP2AP020A00F_PROX_MASK 0x08 /* PS: detection/non-detection */ 918c2ecf20Sopenharmony_ci#define GP2AP020A00F_PROX_NON_DETECT 0x00 928c2ecf20Sopenharmony_ci#define GP2AP020A00F_PROX_DETECT 0x08 938c2ecf20Sopenharmony_ci#define GP2AP020A00F_FLAG_P 0x04 /* PS: interrupt result */ 948c2ecf20Sopenharmony_ci#define GP2AP020A00F_FLAG_A 0x02 /* ALS: interrupt result */ 958c2ecf20Sopenharmony_ci#define GP2AP020A00F_TYPE_MASK 0x01 /* Output data type selection */ 968c2ecf20Sopenharmony_ci#define GP2AP020A00F_TYPE_MANUAL_CALC 0x00 978c2ecf20Sopenharmony_ci#define GP2AP020A00F_TYPE_AUTO_CALC 0x01 988c2ecf20Sopenharmony_ci 998c2ecf20Sopenharmony_ci/* ALS_REG bits */ 1008c2ecf20Sopenharmony_ci#define GP2AP020A00F_PRST_MASK 0xc0 /* Number of measurement cycles */ 1018c2ecf20Sopenharmony_ci#define GP2AP020A00F_PRST_ONCE 0x00 1028c2ecf20Sopenharmony_ci#define GP2AP020A00F_PRST_4_CYCLES 0x40 1038c2ecf20Sopenharmony_ci#define GP2AP020A00F_PRST_8_CYCLES 0x80 1048c2ecf20Sopenharmony_ci#define GP2AP020A00F_PRST_16_CYCLES 0xc0 1058c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_A_MASK 0x38 /* ALS: Resolution */ 1068c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_A_800ms 0x00 1078c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_A_400ms 0x08 1088c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_A_200ms 0x10 1098c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_A_100ms 0x18 1108c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_A_25ms 0x20 1118c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_A_6_25ms 0x28 1128c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_A_1_56ms 0x30 1138c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_A_0_39ms 0x38 1148c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_A_MASK 0x07 /* ALS: Max measurable range */ 1158c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x1 0x00 1168c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x2 0x01 1178c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x4 0x02 1188c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x8 0x03 1198c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x16 0x04 1208c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x32 0x05 1218c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x64 0x06 1228c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_A_x128 0x07 1238c2ecf20Sopenharmony_ci 1248c2ecf20Sopenharmony_ci/* PS_REG bits */ 1258c2ecf20Sopenharmony_ci#define GP2AP020A00F_ALC_MASK 0x80 /* Auto light cancel */ 1268c2ecf20Sopenharmony_ci#define GP2AP020A00F_ALC_ON 0x80 1278c2ecf20Sopenharmony_ci#define GP2AP020A00F_ALC_OFF 0x00 1288c2ecf20Sopenharmony_ci#define GP2AP020A00F_INTTYPE_MASK 0x40 /* Interrupt type setting */ 1298c2ecf20Sopenharmony_ci#define GP2AP020A00F_INTTYPE_LEVEL 0x00 1308c2ecf20Sopenharmony_ci#define GP2AP020A00F_INTTYPE_PULSE 0x40 1318c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_P_MASK 0x38 /* PS: Resolution */ 1328c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_P_800ms_x2 0x00 1338c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_P_400ms_x2 0x08 1348c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_P_200ms_x2 0x10 1358c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_P_100ms_x2 0x18 1368c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_P_25ms_x2 0x20 1378c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_P_6_25ms_x2 0x28 1388c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_P_1_56ms_x2 0x30 1398c2ecf20Sopenharmony_ci#define GP2AP020A00F_RES_P_0_39ms_x2 0x38 1408c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_P_MASK 0x07 /* PS: Max measurable range */ 1418c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x1 0x00 1428c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x2 0x01 1438c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x4 0x02 1448c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x8 0x03 1458c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x16 0x04 1468c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x32 0x05 1478c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x64 0x06 1488c2ecf20Sopenharmony_ci#define GP2AP020A00F_RANGE_P_x128 0x07 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_ci/* LED reg bits */ 1518c2ecf20Sopenharmony_ci#define GP2AP020A00F_INTVAL_MASK 0xc0 /* Intermittent operating */ 1528c2ecf20Sopenharmony_ci#define GP2AP020A00F_INTVAL_0 0x00 1538c2ecf20Sopenharmony_ci#define GP2AP020A00F_INTVAL_4 0x40 1548c2ecf20Sopenharmony_ci#define GP2AP020A00F_INTVAL_8 0x80 1558c2ecf20Sopenharmony_ci#define GP2AP020A00F_INTVAL_16 0xc0 1568c2ecf20Sopenharmony_ci#define GP2AP020A00F_IS_MASK 0x30 /* ILED drive peak current */ 1578c2ecf20Sopenharmony_ci#define GP2AP020A00F_IS_13_8mA 0x00 1588c2ecf20Sopenharmony_ci#define GP2AP020A00F_IS_27_5mA 0x10 1598c2ecf20Sopenharmony_ci#define GP2AP020A00F_IS_55mA 0x20 1608c2ecf20Sopenharmony_ci#define GP2AP020A00F_IS_110mA 0x30 1618c2ecf20Sopenharmony_ci#define GP2AP020A00F_PIN_MASK 0x0c /* INT terminal setting */ 1628c2ecf20Sopenharmony_ci#define GP2AP020A00F_PIN_ALS_OR_PS 0x00 1638c2ecf20Sopenharmony_ci#define GP2AP020A00F_PIN_ALS 0x04 1648c2ecf20Sopenharmony_ci#define GP2AP020A00F_PIN_PS 0x08 1658c2ecf20Sopenharmony_ci#define GP2AP020A00F_PIN_PS_DETECT 0x0c 1668c2ecf20Sopenharmony_ci#define GP2AP020A00F_FREQ_MASK 0x02 /* LED modulation frequency */ 1678c2ecf20Sopenharmony_ci#define GP2AP020A00F_FREQ_327_5kHz 0x00 1688c2ecf20Sopenharmony_ci#define GP2AP020A00F_FREQ_81_8kHz 0x02 1698c2ecf20Sopenharmony_ci#define GP2AP020A00F_RST 0x01 /* Software reset */ 1708c2ecf20Sopenharmony_ci 1718c2ecf20Sopenharmony_ci#define GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR 0 1728c2ecf20Sopenharmony_ci#define GP2AP020A00F_SCAN_MODE_LIGHT_IR 1 1738c2ecf20Sopenharmony_ci#define GP2AP020A00F_SCAN_MODE_PROXIMITY 2 1748c2ecf20Sopenharmony_ci#define GP2AP020A00F_CHAN_TIMESTAMP 3 1758c2ecf20Sopenharmony_ci 1768c2ecf20Sopenharmony_ci#define GP2AP020A00F_DATA_READY_TIMEOUT msecs_to_jiffies(1000) 1778c2ecf20Sopenharmony_ci#define GP2AP020A00F_DATA_REG(chan) (GP2AP020A00F_D0_L_REG + \ 1788c2ecf20Sopenharmony_ci (chan) * 2) 1798c2ecf20Sopenharmony_ci#define GP2AP020A00F_THRESH_REG(th_val_id) (GP2AP020A00F_TL_L_REG + \ 1808c2ecf20Sopenharmony_ci (th_val_id) * 2) 1818c2ecf20Sopenharmony_ci#define GP2AP020A00F_THRESH_VAL_ID(reg_addr) ((reg_addr - 4) / 2) 1828c2ecf20Sopenharmony_ci 1838c2ecf20Sopenharmony_ci#define GP2AP020A00F_SUBTRACT_MODE 0 1848c2ecf20Sopenharmony_ci#define GP2AP020A00F_ADD_MODE 1 1858c2ecf20Sopenharmony_ci 1868c2ecf20Sopenharmony_ci#define GP2AP020A00F_MAX_CHANNELS 3 1878c2ecf20Sopenharmony_ci 1888c2ecf20Sopenharmony_cienum gp2ap020a00f_opmode { 1898c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_CLEAR, 1908c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_IR, 1918c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY, 1928c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 1938c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_PS, 1948c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS_AND_PS, 1958c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_PROX_DETECT, 1968c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN, 1978c2ecf20Sopenharmony_ci GP2AP020A00F_NUM_OPMODES, 1988c2ecf20Sopenharmony_ci}; 1998c2ecf20Sopenharmony_ci 2008c2ecf20Sopenharmony_cienum gp2ap020a00f_cmd { 2018c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_READ_RAW_CLEAR, 2028c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_READ_RAW_IR, 2038c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_READ_RAW_PROXIMITY, 2048c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_CLEAR_EN, 2058c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_CLEAR_DIS, 2068c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_IR_EN, 2078c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_IR_DIS, 2088c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_PROX_EN, 2098c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_PROX_DIS, 2108c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_ALS_HIGH_EV_EN, 2118c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_ALS_HIGH_EV_DIS, 2128c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_ALS_LOW_EV_EN, 2138c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_ALS_LOW_EV_DIS, 2148c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_PROX_HIGH_EV_EN, 2158c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_PROX_HIGH_EV_DIS, 2168c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_PROX_LOW_EV_EN, 2178c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_PROX_LOW_EV_DIS, 2188c2ecf20Sopenharmony_ci}; 2198c2ecf20Sopenharmony_ci 2208c2ecf20Sopenharmony_cienum gp2ap020a00f_flags { 2218c2ecf20Sopenharmony_ci GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, 2228c2ecf20Sopenharmony_ci GP2AP020A00F_FLAG_ALS_IR_TRIGGER, 2238c2ecf20Sopenharmony_ci GP2AP020A00F_FLAG_PROX_TRIGGER, 2248c2ecf20Sopenharmony_ci GP2AP020A00F_FLAG_PROX_RISING_EV, 2258c2ecf20Sopenharmony_ci GP2AP020A00F_FLAG_PROX_FALLING_EV, 2268c2ecf20Sopenharmony_ci GP2AP020A00F_FLAG_ALS_RISING_EV, 2278c2ecf20Sopenharmony_ci GP2AP020A00F_FLAG_ALS_FALLING_EV, 2288c2ecf20Sopenharmony_ci GP2AP020A00F_FLAG_LUX_MODE_HI, 2298c2ecf20Sopenharmony_ci GP2AP020A00F_FLAG_DATA_READY, 2308c2ecf20Sopenharmony_ci}; 2318c2ecf20Sopenharmony_ci 2328c2ecf20Sopenharmony_cienum gp2ap020a00f_thresh_val_id { 2338c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TL, 2348c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TH, 2358c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_PL, 2368c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_PH, 2378c2ecf20Sopenharmony_ci}; 2388c2ecf20Sopenharmony_ci 2398c2ecf20Sopenharmony_cistruct gp2ap020a00f_data { 2408c2ecf20Sopenharmony_ci const struct gp2ap020a00f_platform_data *pdata; 2418c2ecf20Sopenharmony_ci struct i2c_client *client; 2428c2ecf20Sopenharmony_ci struct mutex lock; 2438c2ecf20Sopenharmony_ci char *buffer; 2448c2ecf20Sopenharmony_ci struct regulator *vled_reg; 2458c2ecf20Sopenharmony_ci unsigned long flags; 2468c2ecf20Sopenharmony_ci enum gp2ap020a00f_opmode cur_opmode; 2478c2ecf20Sopenharmony_ci struct iio_trigger *trig; 2488c2ecf20Sopenharmony_ci struct regmap *regmap; 2498c2ecf20Sopenharmony_ci unsigned int thresh_val[4]; 2508c2ecf20Sopenharmony_ci u8 debug_reg_addr; 2518c2ecf20Sopenharmony_ci struct irq_work work; 2528c2ecf20Sopenharmony_ci wait_queue_head_t data_ready_queue; 2538c2ecf20Sopenharmony_ci}; 2548c2ecf20Sopenharmony_ci 2558c2ecf20Sopenharmony_cistatic const u8 gp2ap020a00f_reg_init_tab[] = { 2568c2ecf20Sopenharmony_ci [GP2AP020A00F_OP_REG] = GP2AP020A00F_OP3_SHUTDOWN, 2578c2ecf20Sopenharmony_ci [GP2AP020A00F_ALS_REG] = GP2AP020A00F_RES_A_25ms | 2588c2ecf20Sopenharmony_ci GP2AP020A00F_RANGE_A_x8, 2598c2ecf20Sopenharmony_ci [GP2AP020A00F_PS_REG] = GP2AP020A00F_ALC_ON | 2608c2ecf20Sopenharmony_ci GP2AP020A00F_RES_P_1_56ms_x2 | 2618c2ecf20Sopenharmony_ci GP2AP020A00F_RANGE_P_x4, 2628c2ecf20Sopenharmony_ci [GP2AP020A00F_LED_REG] = GP2AP020A00F_INTVAL_0 | 2638c2ecf20Sopenharmony_ci GP2AP020A00F_IS_110mA | 2648c2ecf20Sopenharmony_ci GP2AP020A00F_FREQ_327_5kHz, 2658c2ecf20Sopenharmony_ci [GP2AP020A00F_TL_L_REG] = 0, 2668c2ecf20Sopenharmony_ci [GP2AP020A00F_TL_H_REG] = 0, 2678c2ecf20Sopenharmony_ci [GP2AP020A00F_TH_L_REG] = 0, 2688c2ecf20Sopenharmony_ci [GP2AP020A00F_TH_H_REG] = 0, 2698c2ecf20Sopenharmony_ci [GP2AP020A00F_PL_L_REG] = 0, 2708c2ecf20Sopenharmony_ci [GP2AP020A00F_PL_H_REG] = 0, 2718c2ecf20Sopenharmony_ci [GP2AP020A00F_PH_L_REG] = 0, 2728c2ecf20Sopenharmony_ci [GP2AP020A00F_PH_H_REG] = 0, 2738c2ecf20Sopenharmony_ci}; 2748c2ecf20Sopenharmony_ci 2758c2ecf20Sopenharmony_cistatic bool gp2ap020a00f_is_volatile_reg(struct device *dev, unsigned int reg) 2768c2ecf20Sopenharmony_ci{ 2778c2ecf20Sopenharmony_ci switch (reg) { 2788c2ecf20Sopenharmony_ci case GP2AP020A00F_OP_REG: 2798c2ecf20Sopenharmony_ci case GP2AP020A00F_D0_L_REG: 2808c2ecf20Sopenharmony_ci case GP2AP020A00F_D0_H_REG: 2818c2ecf20Sopenharmony_ci case GP2AP020A00F_D1_L_REG: 2828c2ecf20Sopenharmony_ci case GP2AP020A00F_D1_H_REG: 2838c2ecf20Sopenharmony_ci case GP2AP020A00F_D2_L_REG: 2848c2ecf20Sopenharmony_ci case GP2AP020A00F_D2_H_REG: 2858c2ecf20Sopenharmony_ci return true; 2868c2ecf20Sopenharmony_ci default: 2878c2ecf20Sopenharmony_ci return false; 2888c2ecf20Sopenharmony_ci } 2898c2ecf20Sopenharmony_ci} 2908c2ecf20Sopenharmony_ci 2918c2ecf20Sopenharmony_cistatic const struct regmap_config gp2ap020a00f_regmap_config = { 2928c2ecf20Sopenharmony_ci .reg_bits = 8, 2938c2ecf20Sopenharmony_ci .val_bits = 8, 2948c2ecf20Sopenharmony_ci 2958c2ecf20Sopenharmony_ci .max_register = GP2AP020A00F_D2_H_REG, 2968c2ecf20Sopenharmony_ci .cache_type = REGCACHE_RBTREE, 2978c2ecf20Sopenharmony_ci 2988c2ecf20Sopenharmony_ci .volatile_reg = gp2ap020a00f_is_volatile_reg, 2998c2ecf20Sopenharmony_ci}; 3008c2ecf20Sopenharmony_ci 3018c2ecf20Sopenharmony_cistatic const struct gp2ap020a00f_mutable_config_regs { 3028c2ecf20Sopenharmony_ci u8 op_reg; 3038c2ecf20Sopenharmony_ci u8 als_reg; 3048c2ecf20Sopenharmony_ci u8 ps_reg; 3058c2ecf20Sopenharmony_ci u8 led_reg; 3068c2ecf20Sopenharmony_ci} opmode_regs_settings[GP2AP020A00F_NUM_OPMODES] = { 3078c2ecf20Sopenharmony_ci [GP2AP020A00F_OPMODE_READ_RAW_CLEAR] = { 3088c2ecf20Sopenharmony_ci GP2AP020A00F_OP_ALS | GP2AP020A00F_OP2_CONT_OPERATION 3098c2ecf20Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 3108c2ecf20Sopenharmony_ci | GP2AP020A00F_TYPE_AUTO_CALC, 3118c2ecf20Sopenharmony_ci GP2AP020A00F_PRST_ONCE, 3128c2ecf20Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 3138c2ecf20Sopenharmony_ci GP2AP020A00F_PIN_ALS 3148c2ecf20Sopenharmony_ci }, 3158c2ecf20Sopenharmony_ci [GP2AP020A00F_OPMODE_READ_RAW_IR] = { 3168c2ecf20Sopenharmony_ci GP2AP020A00F_OP_ALS | GP2AP020A00F_OP2_CONT_OPERATION 3178c2ecf20Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 3188c2ecf20Sopenharmony_ci | GP2AP020A00F_TYPE_MANUAL_CALC, 3198c2ecf20Sopenharmony_ci GP2AP020A00F_PRST_ONCE, 3208c2ecf20Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 3218c2ecf20Sopenharmony_ci GP2AP020A00F_PIN_ALS 3228c2ecf20Sopenharmony_ci }, 3238c2ecf20Sopenharmony_ci [GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY] = { 3248c2ecf20Sopenharmony_ci GP2AP020A00F_OP_PS | GP2AP020A00F_OP2_CONT_OPERATION 3258c2ecf20Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 3268c2ecf20Sopenharmony_ci | GP2AP020A00F_TYPE_MANUAL_CALC, 3278c2ecf20Sopenharmony_ci GP2AP020A00F_PRST_ONCE, 3288c2ecf20Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 3298c2ecf20Sopenharmony_ci GP2AP020A00F_PIN_PS 3308c2ecf20Sopenharmony_ci }, 3318c2ecf20Sopenharmony_ci [GP2AP020A00F_OPMODE_PROX_DETECT] = { 3328c2ecf20Sopenharmony_ci GP2AP020A00F_OP_PS | GP2AP020A00F_OP2_CONT_OPERATION 3338c2ecf20Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 3348c2ecf20Sopenharmony_ci | GP2AP020A00F_TYPE_MANUAL_CALC, 3358c2ecf20Sopenharmony_ci GP2AP020A00F_PRST_4_CYCLES, 3368c2ecf20Sopenharmony_ci GP2AP020A00F_INTTYPE_PULSE, 3378c2ecf20Sopenharmony_ci GP2AP020A00F_PIN_PS_DETECT 3388c2ecf20Sopenharmony_ci }, 3398c2ecf20Sopenharmony_ci [GP2AP020A00F_OPMODE_ALS] = { 3408c2ecf20Sopenharmony_ci GP2AP020A00F_OP_ALS | GP2AP020A00F_OP2_CONT_OPERATION 3418c2ecf20Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 3428c2ecf20Sopenharmony_ci | GP2AP020A00F_TYPE_AUTO_CALC, 3438c2ecf20Sopenharmony_ci GP2AP020A00F_PRST_ONCE, 3448c2ecf20Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 3458c2ecf20Sopenharmony_ci GP2AP020A00F_PIN_ALS 3468c2ecf20Sopenharmony_ci }, 3478c2ecf20Sopenharmony_ci [GP2AP020A00F_OPMODE_PS] = { 3488c2ecf20Sopenharmony_ci GP2AP020A00F_OP_PS | GP2AP020A00F_OP2_CONT_OPERATION 3498c2ecf20Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 3508c2ecf20Sopenharmony_ci | GP2AP020A00F_TYPE_MANUAL_CALC, 3518c2ecf20Sopenharmony_ci GP2AP020A00F_PRST_4_CYCLES, 3528c2ecf20Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 3538c2ecf20Sopenharmony_ci GP2AP020A00F_PIN_PS 3548c2ecf20Sopenharmony_ci }, 3558c2ecf20Sopenharmony_ci [GP2AP020A00F_OPMODE_ALS_AND_PS] = { 3568c2ecf20Sopenharmony_ci GP2AP020A00F_OP_ALS_AND_PS 3578c2ecf20Sopenharmony_ci | GP2AP020A00F_OP2_CONT_OPERATION 3588c2ecf20Sopenharmony_ci | GP2AP020A00F_OP3_OPERATION 3598c2ecf20Sopenharmony_ci | GP2AP020A00F_TYPE_AUTO_CALC, 3608c2ecf20Sopenharmony_ci GP2AP020A00F_PRST_4_CYCLES, 3618c2ecf20Sopenharmony_ci GP2AP020A00F_INTTYPE_LEVEL, 3628c2ecf20Sopenharmony_ci GP2AP020A00F_PIN_ALS_OR_PS 3638c2ecf20Sopenharmony_ci }, 3648c2ecf20Sopenharmony_ci [GP2AP020A00F_OPMODE_SHUTDOWN] = { GP2AP020A00F_OP3_SHUTDOWN, }, 3658c2ecf20Sopenharmony_ci}; 3668c2ecf20Sopenharmony_ci 3678c2ecf20Sopenharmony_cistatic int gp2ap020a00f_set_operation_mode(struct gp2ap020a00f_data *data, 3688c2ecf20Sopenharmony_ci enum gp2ap020a00f_opmode op) 3698c2ecf20Sopenharmony_ci{ 3708c2ecf20Sopenharmony_ci unsigned int op_reg_val; 3718c2ecf20Sopenharmony_ci int err; 3728c2ecf20Sopenharmony_ci 3738c2ecf20Sopenharmony_ci if (op != GP2AP020A00F_OPMODE_SHUTDOWN) { 3748c2ecf20Sopenharmony_ci err = regmap_read(data->regmap, GP2AP020A00F_OP_REG, 3758c2ecf20Sopenharmony_ci &op_reg_val); 3768c2ecf20Sopenharmony_ci if (err < 0) 3778c2ecf20Sopenharmony_ci return err; 3788c2ecf20Sopenharmony_ci /* 3798c2ecf20Sopenharmony_ci * Shutdown the device if the operation being executed entails 3808c2ecf20Sopenharmony_ci * mode transition. 3818c2ecf20Sopenharmony_ci */ 3828c2ecf20Sopenharmony_ci if ((opmode_regs_settings[op].op_reg & GP2AP020A00F_OP_MASK) != 3838c2ecf20Sopenharmony_ci (op_reg_val & GP2AP020A00F_OP_MASK)) { 3848c2ecf20Sopenharmony_ci /* set shutdown mode */ 3858c2ecf20Sopenharmony_ci err = regmap_update_bits(data->regmap, 3868c2ecf20Sopenharmony_ci GP2AP020A00F_OP_REG, GP2AP020A00F_OP3_MASK, 3878c2ecf20Sopenharmony_ci GP2AP020A00F_OP3_SHUTDOWN); 3888c2ecf20Sopenharmony_ci if (err < 0) 3898c2ecf20Sopenharmony_ci return err; 3908c2ecf20Sopenharmony_ci } 3918c2ecf20Sopenharmony_ci 3928c2ecf20Sopenharmony_ci err = regmap_update_bits(data->regmap, GP2AP020A00F_ALS_REG, 3938c2ecf20Sopenharmony_ci GP2AP020A00F_PRST_MASK, opmode_regs_settings[op] 3948c2ecf20Sopenharmony_ci .als_reg); 3958c2ecf20Sopenharmony_ci if (err < 0) 3968c2ecf20Sopenharmony_ci return err; 3978c2ecf20Sopenharmony_ci 3988c2ecf20Sopenharmony_ci err = regmap_update_bits(data->regmap, GP2AP020A00F_PS_REG, 3998c2ecf20Sopenharmony_ci GP2AP020A00F_INTTYPE_MASK, opmode_regs_settings[op] 4008c2ecf20Sopenharmony_ci .ps_reg); 4018c2ecf20Sopenharmony_ci if (err < 0) 4028c2ecf20Sopenharmony_ci return err; 4038c2ecf20Sopenharmony_ci 4048c2ecf20Sopenharmony_ci err = regmap_update_bits(data->regmap, GP2AP020A00F_LED_REG, 4058c2ecf20Sopenharmony_ci GP2AP020A00F_PIN_MASK, opmode_regs_settings[op] 4068c2ecf20Sopenharmony_ci .led_reg); 4078c2ecf20Sopenharmony_ci if (err < 0) 4088c2ecf20Sopenharmony_ci return err; 4098c2ecf20Sopenharmony_ci } 4108c2ecf20Sopenharmony_ci 4118c2ecf20Sopenharmony_ci /* Set OP_REG and apply operation mode (power on / off) */ 4128c2ecf20Sopenharmony_ci err = regmap_update_bits(data->regmap, 4138c2ecf20Sopenharmony_ci GP2AP020A00F_OP_REG, 4148c2ecf20Sopenharmony_ci GP2AP020A00F_OP_MASK | GP2AP020A00F_OP2_MASK | 4158c2ecf20Sopenharmony_ci GP2AP020A00F_OP3_MASK | GP2AP020A00F_TYPE_MASK, 4168c2ecf20Sopenharmony_ci opmode_regs_settings[op].op_reg); 4178c2ecf20Sopenharmony_ci if (err < 0) 4188c2ecf20Sopenharmony_ci return err; 4198c2ecf20Sopenharmony_ci 4208c2ecf20Sopenharmony_ci data->cur_opmode = op; 4218c2ecf20Sopenharmony_ci 4228c2ecf20Sopenharmony_ci return 0; 4238c2ecf20Sopenharmony_ci} 4248c2ecf20Sopenharmony_ci 4258c2ecf20Sopenharmony_cistatic bool gp2ap020a00f_als_enabled(struct gp2ap020a00f_data *data) 4268c2ecf20Sopenharmony_ci{ 4278c2ecf20Sopenharmony_ci return test_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &data->flags) || 4288c2ecf20Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &data->flags) || 4298c2ecf20Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags) || 4308c2ecf20Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags); 4318c2ecf20Sopenharmony_ci} 4328c2ecf20Sopenharmony_ci 4338c2ecf20Sopenharmony_cistatic bool gp2ap020a00f_prox_detect_enabled(struct gp2ap020a00f_data *data) 4348c2ecf20Sopenharmony_ci{ 4358c2ecf20Sopenharmony_ci return test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags) || 4368c2ecf20Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags); 4378c2ecf20Sopenharmony_ci} 4388c2ecf20Sopenharmony_ci 4398c2ecf20Sopenharmony_cistatic int gp2ap020a00f_write_event_threshold(struct gp2ap020a00f_data *data, 4408c2ecf20Sopenharmony_ci enum gp2ap020a00f_thresh_val_id th_val_id, 4418c2ecf20Sopenharmony_ci bool enable) 4428c2ecf20Sopenharmony_ci{ 4438c2ecf20Sopenharmony_ci __le16 thresh_buf = 0; 4448c2ecf20Sopenharmony_ci unsigned int thresh_reg_val; 4458c2ecf20Sopenharmony_ci 4468c2ecf20Sopenharmony_ci if (!enable) 4478c2ecf20Sopenharmony_ci thresh_reg_val = 0; 4488c2ecf20Sopenharmony_ci else if (test_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags) && 4498c2ecf20Sopenharmony_ci th_val_id != GP2AP020A00F_THRESH_PL && 4508c2ecf20Sopenharmony_ci th_val_id != GP2AP020A00F_THRESH_PH) 4518c2ecf20Sopenharmony_ci /* 4528c2ecf20Sopenharmony_ci * For the high lux mode ALS threshold has to be scaled down 4538c2ecf20Sopenharmony_ci * to allow for proper comparison with the output value. 4548c2ecf20Sopenharmony_ci */ 4558c2ecf20Sopenharmony_ci thresh_reg_val = data->thresh_val[th_val_id] / 16; 4568c2ecf20Sopenharmony_ci else 4578c2ecf20Sopenharmony_ci thresh_reg_val = data->thresh_val[th_val_id] > 16000 ? 4588c2ecf20Sopenharmony_ci 16000 : 4598c2ecf20Sopenharmony_ci data->thresh_val[th_val_id]; 4608c2ecf20Sopenharmony_ci 4618c2ecf20Sopenharmony_ci thresh_buf = cpu_to_le16(thresh_reg_val); 4628c2ecf20Sopenharmony_ci 4638c2ecf20Sopenharmony_ci return regmap_bulk_write(data->regmap, 4648c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_REG(th_val_id), 4658c2ecf20Sopenharmony_ci (u8 *)&thresh_buf, 2); 4668c2ecf20Sopenharmony_ci} 4678c2ecf20Sopenharmony_ci 4688c2ecf20Sopenharmony_cistatic int gp2ap020a00f_alter_opmode(struct gp2ap020a00f_data *data, 4698c2ecf20Sopenharmony_ci enum gp2ap020a00f_opmode diff_mode, int add_sub) 4708c2ecf20Sopenharmony_ci{ 4718c2ecf20Sopenharmony_ci enum gp2ap020a00f_opmode new_mode; 4728c2ecf20Sopenharmony_ci 4738c2ecf20Sopenharmony_ci if (diff_mode != GP2AP020A00F_OPMODE_ALS && 4748c2ecf20Sopenharmony_ci diff_mode != GP2AP020A00F_OPMODE_PS) 4758c2ecf20Sopenharmony_ci return -EINVAL; 4768c2ecf20Sopenharmony_ci 4778c2ecf20Sopenharmony_ci if (add_sub == GP2AP020A00F_ADD_MODE) { 4788c2ecf20Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_SHUTDOWN) 4798c2ecf20Sopenharmony_ci new_mode = diff_mode; 4808c2ecf20Sopenharmony_ci else 4818c2ecf20Sopenharmony_ci new_mode = GP2AP020A00F_OPMODE_ALS_AND_PS; 4828c2ecf20Sopenharmony_ci } else { 4838c2ecf20Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_ALS_AND_PS) 4848c2ecf20Sopenharmony_ci new_mode = (diff_mode == GP2AP020A00F_OPMODE_ALS) ? 4858c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_PS : 4868c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS; 4878c2ecf20Sopenharmony_ci else 4888c2ecf20Sopenharmony_ci new_mode = GP2AP020A00F_OPMODE_SHUTDOWN; 4898c2ecf20Sopenharmony_ci } 4908c2ecf20Sopenharmony_ci 4918c2ecf20Sopenharmony_ci return gp2ap020a00f_set_operation_mode(data, new_mode); 4928c2ecf20Sopenharmony_ci} 4938c2ecf20Sopenharmony_ci 4948c2ecf20Sopenharmony_cistatic int gp2ap020a00f_exec_cmd(struct gp2ap020a00f_data *data, 4958c2ecf20Sopenharmony_ci enum gp2ap020a00f_cmd cmd) 4968c2ecf20Sopenharmony_ci{ 4978c2ecf20Sopenharmony_ci int err = 0; 4988c2ecf20Sopenharmony_ci 4998c2ecf20Sopenharmony_ci switch (cmd) { 5008c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_READ_RAW_CLEAR: 5018c2ecf20Sopenharmony_ci if (data->cur_opmode != GP2AP020A00F_OPMODE_SHUTDOWN) 5028c2ecf20Sopenharmony_ci return -EBUSY; 5038c2ecf20Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 5048c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_CLEAR); 5058c2ecf20Sopenharmony_ci break; 5068c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_READ_RAW_IR: 5078c2ecf20Sopenharmony_ci if (data->cur_opmode != GP2AP020A00F_OPMODE_SHUTDOWN) 5088c2ecf20Sopenharmony_ci return -EBUSY; 5098c2ecf20Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 5108c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_IR); 5118c2ecf20Sopenharmony_ci break; 5128c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_READ_RAW_PROXIMITY: 5138c2ecf20Sopenharmony_ci if (data->cur_opmode != GP2AP020A00F_OPMODE_SHUTDOWN) 5148c2ecf20Sopenharmony_ci return -EBUSY; 5158c2ecf20Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 5168c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY); 5178c2ecf20Sopenharmony_ci break; 5188c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_CLEAR_EN: 5198c2ecf20Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 5208c2ecf20Sopenharmony_ci return -EBUSY; 5218c2ecf20Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) 5228c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 5238c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 5248c2ecf20Sopenharmony_ci GP2AP020A00F_ADD_MODE); 5258c2ecf20Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &data->flags); 5268c2ecf20Sopenharmony_ci break; 5278c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_CLEAR_DIS: 5288c2ecf20Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &data->flags); 5298c2ecf20Sopenharmony_ci if (gp2ap020a00f_als_enabled(data)) 5308c2ecf20Sopenharmony_ci break; 5318c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 5328c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 5338c2ecf20Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 5348c2ecf20Sopenharmony_ci break; 5358c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_IR_EN: 5368c2ecf20Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 5378c2ecf20Sopenharmony_ci return -EBUSY; 5388c2ecf20Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) 5398c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 5408c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 5418c2ecf20Sopenharmony_ci GP2AP020A00F_ADD_MODE); 5428c2ecf20Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &data->flags); 5438c2ecf20Sopenharmony_ci break; 5448c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_IR_DIS: 5458c2ecf20Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &data->flags); 5468c2ecf20Sopenharmony_ci if (gp2ap020a00f_als_enabled(data)) 5478c2ecf20Sopenharmony_ci break; 5488c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 5498c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 5508c2ecf20Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 5518c2ecf20Sopenharmony_ci break; 5528c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_PROX_EN: 5538c2ecf20Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 5548c2ecf20Sopenharmony_ci return -EBUSY; 5558c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 5568c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_PS, 5578c2ecf20Sopenharmony_ci GP2AP020A00F_ADD_MODE); 5588c2ecf20Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_PROX_TRIGGER, &data->flags); 5598c2ecf20Sopenharmony_ci break; 5608c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_TRIGGER_PROX_DIS: 5618c2ecf20Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_PROX_TRIGGER, &data->flags); 5628c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 5638c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_PS, 5648c2ecf20Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 5658c2ecf20Sopenharmony_ci break; 5668c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_ALS_HIGH_EV_EN: 5678c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags)) 5688c2ecf20Sopenharmony_ci return 0; 5698c2ecf20Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 5708c2ecf20Sopenharmony_ci return -EBUSY; 5718c2ecf20Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) { 5728c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 5738c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 5748c2ecf20Sopenharmony_ci GP2AP020A00F_ADD_MODE); 5758c2ecf20Sopenharmony_ci if (err < 0) 5768c2ecf20Sopenharmony_ci return err; 5778c2ecf20Sopenharmony_ci } 5788c2ecf20Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags); 5798c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 5808c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TH, true); 5818c2ecf20Sopenharmony_ci break; 5828c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_ALS_HIGH_EV_DIS: 5838c2ecf20Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags)) 5848c2ecf20Sopenharmony_ci return 0; 5858c2ecf20Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags); 5868c2ecf20Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) { 5878c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 5888c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 5898c2ecf20Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 5908c2ecf20Sopenharmony_ci if (err < 0) 5918c2ecf20Sopenharmony_ci return err; 5928c2ecf20Sopenharmony_ci } 5938c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 5948c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TH, false); 5958c2ecf20Sopenharmony_ci break; 5968c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_ALS_LOW_EV_EN: 5978c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags)) 5988c2ecf20Sopenharmony_ci return 0; 5998c2ecf20Sopenharmony_ci if (data->cur_opmode == GP2AP020A00F_OPMODE_PROX_DETECT) 6008c2ecf20Sopenharmony_ci return -EBUSY; 6018c2ecf20Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) { 6028c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 6038c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 6048c2ecf20Sopenharmony_ci GP2AP020A00F_ADD_MODE); 6058c2ecf20Sopenharmony_ci if (err < 0) 6068c2ecf20Sopenharmony_ci return err; 6078c2ecf20Sopenharmony_ci } 6088c2ecf20Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags); 6098c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 6108c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TL, true); 6118c2ecf20Sopenharmony_ci break; 6128c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_ALS_LOW_EV_DIS: 6138c2ecf20Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags)) 6148c2ecf20Sopenharmony_ci return 0; 6158c2ecf20Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags); 6168c2ecf20Sopenharmony_ci if (!gp2ap020a00f_als_enabled(data)) { 6178c2ecf20Sopenharmony_ci err = gp2ap020a00f_alter_opmode(data, 6188c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_ALS, 6198c2ecf20Sopenharmony_ci GP2AP020A00F_SUBTRACT_MODE); 6208c2ecf20Sopenharmony_ci if (err < 0) 6218c2ecf20Sopenharmony_ci return err; 6228c2ecf20Sopenharmony_ci } 6238c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 6248c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TL, false); 6258c2ecf20Sopenharmony_ci break; 6268c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_PROX_HIGH_EV_EN: 6278c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags)) 6288c2ecf20Sopenharmony_ci return 0; 6298c2ecf20Sopenharmony_ci if (gp2ap020a00f_als_enabled(data) || 6308c2ecf20Sopenharmony_ci data->cur_opmode == GP2AP020A00F_OPMODE_PS) 6318c2ecf20Sopenharmony_ci return -EBUSY; 6328c2ecf20Sopenharmony_ci if (!gp2ap020a00f_prox_detect_enabled(data)) { 6338c2ecf20Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 6348c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_PROX_DETECT); 6358c2ecf20Sopenharmony_ci if (err < 0) 6368c2ecf20Sopenharmony_ci return err; 6378c2ecf20Sopenharmony_ci } 6388c2ecf20Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags); 6398c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 6408c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_PH, true); 6418c2ecf20Sopenharmony_ci break; 6428c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_PROX_HIGH_EV_DIS: 6438c2ecf20Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags)) 6448c2ecf20Sopenharmony_ci return 0; 6458c2ecf20Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, &data->flags); 6468c2ecf20Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 6478c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN); 6488c2ecf20Sopenharmony_ci if (err < 0) 6498c2ecf20Sopenharmony_ci return err; 6508c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 6518c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_PH, false); 6528c2ecf20Sopenharmony_ci break; 6538c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_PROX_LOW_EV_EN: 6548c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags)) 6558c2ecf20Sopenharmony_ci return 0; 6568c2ecf20Sopenharmony_ci if (gp2ap020a00f_als_enabled(data) || 6578c2ecf20Sopenharmony_ci data->cur_opmode == GP2AP020A00F_OPMODE_PS) 6588c2ecf20Sopenharmony_ci return -EBUSY; 6598c2ecf20Sopenharmony_ci if (!gp2ap020a00f_prox_detect_enabled(data)) { 6608c2ecf20Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 6618c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_PROX_DETECT); 6628c2ecf20Sopenharmony_ci if (err < 0) 6638c2ecf20Sopenharmony_ci return err; 6648c2ecf20Sopenharmony_ci } 6658c2ecf20Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags); 6668c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 6678c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_PL, true); 6688c2ecf20Sopenharmony_ci break; 6698c2ecf20Sopenharmony_ci case GP2AP020A00F_CMD_PROX_LOW_EV_DIS: 6708c2ecf20Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags)) 6718c2ecf20Sopenharmony_ci return 0; 6728c2ecf20Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, &data->flags); 6738c2ecf20Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 6748c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN); 6758c2ecf20Sopenharmony_ci if (err < 0) 6768c2ecf20Sopenharmony_ci return err; 6778c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 6788c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_PL, false); 6798c2ecf20Sopenharmony_ci break; 6808c2ecf20Sopenharmony_ci } 6818c2ecf20Sopenharmony_ci 6828c2ecf20Sopenharmony_ci return err; 6838c2ecf20Sopenharmony_ci} 6848c2ecf20Sopenharmony_ci 6858c2ecf20Sopenharmony_cistatic int wait_conversion_complete_irq(struct gp2ap020a00f_data *data) 6868c2ecf20Sopenharmony_ci{ 6878c2ecf20Sopenharmony_ci int ret; 6888c2ecf20Sopenharmony_ci 6898c2ecf20Sopenharmony_ci ret = wait_event_timeout(data->data_ready_queue, 6908c2ecf20Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_DATA_READY, 6918c2ecf20Sopenharmony_ci &data->flags), 6928c2ecf20Sopenharmony_ci GP2AP020A00F_DATA_READY_TIMEOUT); 6938c2ecf20Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_DATA_READY, &data->flags); 6948c2ecf20Sopenharmony_ci 6958c2ecf20Sopenharmony_ci return ret > 0 ? 0 : -ETIME; 6968c2ecf20Sopenharmony_ci} 6978c2ecf20Sopenharmony_ci 6988c2ecf20Sopenharmony_cistatic int gp2ap020a00f_read_output(struct gp2ap020a00f_data *data, 6998c2ecf20Sopenharmony_ci unsigned int output_reg, int *val) 7008c2ecf20Sopenharmony_ci{ 7018c2ecf20Sopenharmony_ci u8 reg_buf[2]; 7028c2ecf20Sopenharmony_ci int err; 7038c2ecf20Sopenharmony_ci 7048c2ecf20Sopenharmony_ci err = wait_conversion_complete_irq(data); 7058c2ecf20Sopenharmony_ci if (err < 0) 7068c2ecf20Sopenharmony_ci dev_dbg(&data->client->dev, "data ready timeout\n"); 7078c2ecf20Sopenharmony_ci 7088c2ecf20Sopenharmony_ci err = regmap_bulk_read(data->regmap, output_reg, reg_buf, 2); 7098c2ecf20Sopenharmony_ci if (err < 0) 7108c2ecf20Sopenharmony_ci return err; 7118c2ecf20Sopenharmony_ci 7128c2ecf20Sopenharmony_ci *val = le16_to_cpup((__le16 *)reg_buf); 7138c2ecf20Sopenharmony_ci 7148c2ecf20Sopenharmony_ci return err; 7158c2ecf20Sopenharmony_ci} 7168c2ecf20Sopenharmony_ci 7178c2ecf20Sopenharmony_cistatic bool gp2ap020a00f_adjust_lux_mode(struct gp2ap020a00f_data *data, 7188c2ecf20Sopenharmony_ci int output_val) 7198c2ecf20Sopenharmony_ci{ 7208c2ecf20Sopenharmony_ci u8 new_range = 0xff; 7218c2ecf20Sopenharmony_ci int err; 7228c2ecf20Sopenharmony_ci 7238c2ecf20Sopenharmony_ci if (!test_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags)) { 7248c2ecf20Sopenharmony_ci if (output_val > 16000) { 7258c2ecf20Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags); 7268c2ecf20Sopenharmony_ci new_range = GP2AP020A00F_RANGE_A_x128; 7278c2ecf20Sopenharmony_ci } 7288c2ecf20Sopenharmony_ci } else { 7298c2ecf20Sopenharmony_ci if (output_val < 1000) { 7308c2ecf20Sopenharmony_ci clear_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags); 7318c2ecf20Sopenharmony_ci new_range = GP2AP020A00F_RANGE_A_x8; 7328c2ecf20Sopenharmony_ci } 7338c2ecf20Sopenharmony_ci } 7348c2ecf20Sopenharmony_ci 7358c2ecf20Sopenharmony_ci if (new_range != 0xff) { 7368c2ecf20Sopenharmony_ci /* Clear als threshold registers to avoid spurious 7378c2ecf20Sopenharmony_ci * events caused by lux mode transition. 7388c2ecf20Sopenharmony_ci */ 7398c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 7408c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TH, false); 7418c2ecf20Sopenharmony_ci if (err < 0) { 7428c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 7438c2ecf20Sopenharmony_ci "Clearing als threshold register failed.\n"); 7448c2ecf20Sopenharmony_ci return false; 7458c2ecf20Sopenharmony_ci } 7468c2ecf20Sopenharmony_ci 7478c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 7488c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TL, false); 7498c2ecf20Sopenharmony_ci if (err < 0) { 7508c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 7518c2ecf20Sopenharmony_ci "Clearing als threshold register failed.\n"); 7528c2ecf20Sopenharmony_ci return false; 7538c2ecf20Sopenharmony_ci } 7548c2ecf20Sopenharmony_ci 7558c2ecf20Sopenharmony_ci /* Change lux mode */ 7568c2ecf20Sopenharmony_ci err = regmap_update_bits(data->regmap, 7578c2ecf20Sopenharmony_ci GP2AP020A00F_OP_REG, 7588c2ecf20Sopenharmony_ci GP2AP020A00F_OP3_MASK, 7598c2ecf20Sopenharmony_ci GP2AP020A00F_OP3_SHUTDOWN); 7608c2ecf20Sopenharmony_ci 7618c2ecf20Sopenharmony_ci if (err < 0) { 7628c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 7638c2ecf20Sopenharmony_ci "Shutting down the device failed.\n"); 7648c2ecf20Sopenharmony_ci return false; 7658c2ecf20Sopenharmony_ci } 7668c2ecf20Sopenharmony_ci 7678c2ecf20Sopenharmony_ci err = regmap_update_bits(data->regmap, 7688c2ecf20Sopenharmony_ci GP2AP020A00F_ALS_REG, 7698c2ecf20Sopenharmony_ci GP2AP020A00F_RANGE_A_MASK, 7708c2ecf20Sopenharmony_ci new_range); 7718c2ecf20Sopenharmony_ci 7728c2ecf20Sopenharmony_ci if (err < 0) { 7738c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 7748c2ecf20Sopenharmony_ci "Adjusting device lux mode failed.\n"); 7758c2ecf20Sopenharmony_ci return false; 7768c2ecf20Sopenharmony_ci } 7778c2ecf20Sopenharmony_ci 7788c2ecf20Sopenharmony_ci err = regmap_update_bits(data->regmap, 7798c2ecf20Sopenharmony_ci GP2AP020A00F_OP_REG, 7808c2ecf20Sopenharmony_ci GP2AP020A00F_OP3_MASK, 7818c2ecf20Sopenharmony_ci GP2AP020A00F_OP3_OPERATION); 7828c2ecf20Sopenharmony_ci 7838c2ecf20Sopenharmony_ci if (err < 0) { 7848c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 7858c2ecf20Sopenharmony_ci "Powering up the device failed.\n"); 7868c2ecf20Sopenharmony_ci return false; 7878c2ecf20Sopenharmony_ci } 7888c2ecf20Sopenharmony_ci 7898c2ecf20Sopenharmony_ci /* Adjust als threshold register values to the new lux mode */ 7908c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &data->flags)) { 7918c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 7928c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TH, true); 7938c2ecf20Sopenharmony_ci if (err < 0) { 7948c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 7958c2ecf20Sopenharmony_ci "Adjusting als threshold value failed.\n"); 7968c2ecf20Sopenharmony_ci return false; 7978c2ecf20Sopenharmony_ci } 7988c2ecf20Sopenharmony_ci } 7998c2ecf20Sopenharmony_ci 8008c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &data->flags)) { 8018c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, 8028c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_TL, true); 8038c2ecf20Sopenharmony_ci if (err < 0) { 8048c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 8058c2ecf20Sopenharmony_ci "Adjusting als threshold value failed.\n"); 8068c2ecf20Sopenharmony_ci return false; 8078c2ecf20Sopenharmony_ci } 8088c2ecf20Sopenharmony_ci } 8098c2ecf20Sopenharmony_ci 8108c2ecf20Sopenharmony_ci return true; 8118c2ecf20Sopenharmony_ci } 8128c2ecf20Sopenharmony_ci 8138c2ecf20Sopenharmony_ci return false; 8148c2ecf20Sopenharmony_ci} 8158c2ecf20Sopenharmony_ci 8168c2ecf20Sopenharmony_cistatic void gp2ap020a00f_output_to_lux(struct gp2ap020a00f_data *data, 8178c2ecf20Sopenharmony_ci int *output_val) 8188c2ecf20Sopenharmony_ci{ 8198c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_LUX_MODE_HI, &data->flags)) 8208c2ecf20Sopenharmony_ci *output_val *= 16; 8218c2ecf20Sopenharmony_ci} 8228c2ecf20Sopenharmony_ci 8238c2ecf20Sopenharmony_cistatic void gp2ap020a00f_iio_trigger_work(struct irq_work *work) 8248c2ecf20Sopenharmony_ci{ 8258c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = 8268c2ecf20Sopenharmony_ci container_of(work, struct gp2ap020a00f_data, work); 8278c2ecf20Sopenharmony_ci 8288c2ecf20Sopenharmony_ci iio_trigger_poll(data->trig); 8298c2ecf20Sopenharmony_ci} 8308c2ecf20Sopenharmony_ci 8318c2ecf20Sopenharmony_cistatic irqreturn_t gp2ap020a00f_prox_sensing_handler(int irq, void *data) 8328c2ecf20Sopenharmony_ci{ 8338c2ecf20Sopenharmony_ci struct iio_dev *indio_dev = data; 8348c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *priv = iio_priv(indio_dev); 8358c2ecf20Sopenharmony_ci unsigned int op_reg_val; 8368c2ecf20Sopenharmony_ci int ret; 8378c2ecf20Sopenharmony_ci 8388c2ecf20Sopenharmony_ci /* Read interrupt flags */ 8398c2ecf20Sopenharmony_ci ret = regmap_read(priv->regmap, GP2AP020A00F_OP_REG, &op_reg_val); 8408c2ecf20Sopenharmony_ci if (ret < 0) 8418c2ecf20Sopenharmony_ci return IRQ_HANDLED; 8428c2ecf20Sopenharmony_ci 8438c2ecf20Sopenharmony_ci if (gp2ap020a00f_prox_detect_enabled(priv)) { 8448c2ecf20Sopenharmony_ci if (op_reg_val & GP2AP020A00F_PROX_DETECT) { 8458c2ecf20Sopenharmony_ci iio_push_event(indio_dev, 8468c2ecf20Sopenharmony_ci IIO_UNMOD_EVENT_CODE( 8478c2ecf20Sopenharmony_ci IIO_PROXIMITY, 8488c2ecf20Sopenharmony_ci GP2AP020A00F_SCAN_MODE_PROXIMITY, 8498c2ecf20Sopenharmony_ci IIO_EV_TYPE_ROC, 8508c2ecf20Sopenharmony_ci IIO_EV_DIR_RISING), 8518c2ecf20Sopenharmony_ci iio_get_time_ns(indio_dev)); 8528c2ecf20Sopenharmony_ci } else { 8538c2ecf20Sopenharmony_ci iio_push_event(indio_dev, 8548c2ecf20Sopenharmony_ci IIO_UNMOD_EVENT_CODE( 8558c2ecf20Sopenharmony_ci IIO_PROXIMITY, 8568c2ecf20Sopenharmony_ci GP2AP020A00F_SCAN_MODE_PROXIMITY, 8578c2ecf20Sopenharmony_ci IIO_EV_TYPE_ROC, 8588c2ecf20Sopenharmony_ci IIO_EV_DIR_FALLING), 8598c2ecf20Sopenharmony_ci iio_get_time_ns(indio_dev)); 8608c2ecf20Sopenharmony_ci } 8618c2ecf20Sopenharmony_ci } 8628c2ecf20Sopenharmony_ci 8638c2ecf20Sopenharmony_ci return IRQ_HANDLED; 8648c2ecf20Sopenharmony_ci} 8658c2ecf20Sopenharmony_ci 8668c2ecf20Sopenharmony_cistatic irqreturn_t gp2ap020a00f_thresh_event_handler(int irq, void *data) 8678c2ecf20Sopenharmony_ci{ 8688c2ecf20Sopenharmony_ci struct iio_dev *indio_dev = data; 8698c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *priv = iio_priv(indio_dev); 8708c2ecf20Sopenharmony_ci u8 op_reg_flags, d0_reg_buf[2]; 8718c2ecf20Sopenharmony_ci unsigned int output_val, op_reg_val; 8728c2ecf20Sopenharmony_ci int thresh_val_id, ret; 8738c2ecf20Sopenharmony_ci 8748c2ecf20Sopenharmony_ci /* Read interrupt flags */ 8758c2ecf20Sopenharmony_ci ret = regmap_read(priv->regmap, GP2AP020A00F_OP_REG, 8768c2ecf20Sopenharmony_ci &op_reg_val); 8778c2ecf20Sopenharmony_ci if (ret < 0) 8788c2ecf20Sopenharmony_ci goto done; 8798c2ecf20Sopenharmony_ci 8808c2ecf20Sopenharmony_ci op_reg_flags = op_reg_val & (GP2AP020A00F_FLAG_A | GP2AP020A00F_FLAG_P 8818c2ecf20Sopenharmony_ci | GP2AP020A00F_PROX_DETECT); 8828c2ecf20Sopenharmony_ci 8838c2ecf20Sopenharmony_ci op_reg_val &= (~GP2AP020A00F_FLAG_A & ~GP2AP020A00F_FLAG_P 8848c2ecf20Sopenharmony_ci & ~GP2AP020A00F_PROX_DETECT); 8858c2ecf20Sopenharmony_ci 8868c2ecf20Sopenharmony_ci /* Clear interrupt flags (if not in INTTYPE_PULSE mode) */ 8878c2ecf20Sopenharmony_ci if (priv->cur_opmode != GP2AP020A00F_OPMODE_PROX_DETECT) { 8888c2ecf20Sopenharmony_ci ret = regmap_write(priv->regmap, GP2AP020A00F_OP_REG, 8898c2ecf20Sopenharmony_ci op_reg_val); 8908c2ecf20Sopenharmony_ci if (ret < 0) 8918c2ecf20Sopenharmony_ci goto done; 8928c2ecf20Sopenharmony_ci } 8938c2ecf20Sopenharmony_ci 8948c2ecf20Sopenharmony_ci if (op_reg_flags & GP2AP020A00F_FLAG_A) { 8958c2ecf20Sopenharmony_ci /* Check D0 register to assess if the lux mode 8968c2ecf20Sopenharmony_ci * transition is required. 8978c2ecf20Sopenharmony_ci */ 8988c2ecf20Sopenharmony_ci ret = regmap_bulk_read(priv->regmap, GP2AP020A00F_D0_L_REG, 8998c2ecf20Sopenharmony_ci d0_reg_buf, 2); 9008c2ecf20Sopenharmony_ci if (ret < 0) 9018c2ecf20Sopenharmony_ci goto done; 9028c2ecf20Sopenharmony_ci 9038c2ecf20Sopenharmony_ci output_val = le16_to_cpup((__le16 *)d0_reg_buf); 9048c2ecf20Sopenharmony_ci 9058c2ecf20Sopenharmony_ci if (gp2ap020a00f_adjust_lux_mode(priv, output_val)) 9068c2ecf20Sopenharmony_ci goto done; 9078c2ecf20Sopenharmony_ci 9088c2ecf20Sopenharmony_ci gp2ap020a00f_output_to_lux(priv, &output_val); 9098c2ecf20Sopenharmony_ci 9108c2ecf20Sopenharmony_ci /* 9118c2ecf20Sopenharmony_ci * We need to check output value to distinguish 9128c2ecf20Sopenharmony_ci * between high and low ambient light threshold event. 9138c2ecf20Sopenharmony_ci */ 9148c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, &priv->flags)) { 9158c2ecf20Sopenharmony_ci thresh_val_id = 9168c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_VAL_ID(GP2AP020A00F_TH_L_REG); 9178c2ecf20Sopenharmony_ci if (output_val > priv->thresh_val[thresh_val_id]) 9188c2ecf20Sopenharmony_ci iio_push_event(indio_dev, 9198c2ecf20Sopenharmony_ci IIO_MOD_EVENT_CODE( 9208c2ecf20Sopenharmony_ci IIO_LIGHT, 9218c2ecf20Sopenharmony_ci GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR, 9228c2ecf20Sopenharmony_ci IIO_MOD_LIGHT_CLEAR, 9238c2ecf20Sopenharmony_ci IIO_EV_TYPE_THRESH, 9248c2ecf20Sopenharmony_ci IIO_EV_DIR_RISING), 9258c2ecf20Sopenharmony_ci iio_get_time_ns(indio_dev)); 9268c2ecf20Sopenharmony_ci } 9278c2ecf20Sopenharmony_ci 9288c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, &priv->flags)) { 9298c2ecf20Sopenharmony_ci thresh_val_id = 9308c2ecf20Sopenharmony_ci GP2AP020A00F_THRESH_VAL_ID(GP2AP020A00F_TL_L_REG); 9318c2ecf20Sopenharmony_ci if (output_val < priv->thresh_val[thresh_val_id]) 9328c2ecf20Sopenharmony_ci iio_push_event(indio_dev, 9338c2ecf20Sopenharmony_ci IIO_MOD_EVENT_CODE( 9348c2ecf20Sopenharmony_ci IIO_LIGHT, 9358c2ecf20Sopenharmony_ci GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR, 9368c2ecf20Sopenharmony_ci IIO_MOD_LIGHT_CLEAR, 9378c2ecf20Sopenharmony_ci IIO_EV_TYPE_THRESH, 9388c2ecf20Sopenharmony_ci IIO_EV_DIR_FALLING), 9398c2ecf20Sopenharmony_ci iio_get_time_ns(indio_dev)); 9408c2ecf20Sopenharmony_ci } 9418c2ecf20Sopenharmony_ci } 9428c2ecf20Sopenharmony_ci 9438c2ecf20Sopenharmony_ci if (priv->cur_opmode == GP2AP020A00F_OPMODE_READ_RAW_CLEAR || 9448c2ecf20Sopenharmony_ci priv->cur_opmode == GP2AP020A00F_OPMODE_READ_RAW_IR || 9458c2ecf20Sopenharmony_ci priv->cur_opmode == GP2AP020A00F_OPMODE_READ_RAW_PROXIMITY) { 9468c2ecf20Sopenharmony_ci set_bit(GP2AP020A00F_FLAG_DATA_READY, &priv->flags); 9478c2ecf20Sopenharmony_ci wake_up(&priv->data_ready_queue); 9488c2ecf20Sopenharmony_ci goto done; 9498c2ecf20Sopenharmony_ci } 9508c2ecf20Sopenharmony_ci 9518c2ecf20Sopenharmony_ci if (test_bit(GP2AP020A00F_FLAG_ALS_CLEAR_TRIGGER, &priv->flags) || 9528c2ecf20Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_ALS_IR_TRIGGER, &priv->flags) || 9538c2ecf20Sopenharmony_ci test_bit(GP2AP020A00F_FLAG_PROX_TRIGGER, &priv->flags)) 9548c2ecf20Sopenharmony_ci /* This fires off the trigger. */ 9558c2ecf20Sopenharmony_ci irq_work_queue(&priv->work); 9568c2ecf20Sopenharmony_ci 9578c2ecf20Sopenharmony_cidone: 9588c2ecf20Sopenharmony_ci return IRQ_HANDLED; 9598c2ecf20Sopenharmony_ci} 9608c2ecf20Sopenharmony_ci 9618c2ecf20Sopenharmony_cistatic irqreturn_t gp2ap020a00f_trigger_handler(int irq, void *data) 9628c2ecf20Sopenharmony_ci{ 9638c2ecf20Sopenharmony_ci struct iio_poll_func *pf = data; 9648c2ecf20Sopenharmony_ci struct iio_dev *indio_dev = pf->indio_dev; 9658c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *priv = iio_priv(indio_dev); 9668c2ecf20Sopenharmony_ci size_t d_size = 0; 9678c2ecf20Sopenharmony_ci int i, out_val, ret; 9688c2ecf20Sopenharmony_ci 9698c2ecf20Sopenharmony_ci for_each_set_bit(i, indio_dev->active_scan_mask, 9708c2ecf20Sopenharmony_ci indio_dev->masklength) { 9718c2ecf20Sopenharmony_ci ret = regmap_bulk_read(priv->regmap, 9728c2ecf20Sopenharmony_ci GP2AP020A00F_DATA_REG(i), 9738c2ecf20Sopenharmony_ci &priv->buffer[d_size], 2); 9748c2ecf20Sopenharmony_ci if (ret < 0) 9758c2ecf20Sopenharmony_ci goto done; 9768c2ecf20Sopenharmony_ci 9778c2ecf20Sopenharmony_ci if (i == GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR || 9788c2ecf20Sopenharmony_ci i == GP2AP020A00F_SCAN_MODE_LIGHT_IR) { 9798c2ecf20Sopenharmony_ci out_val = le16_to_cpup((__le16 *)&priv->buffer[d_size]); 9808c2ecf20Sopenharmony_ci gp2ap020a00f_output_to_lux(priv, &out_val); 9818c2ecf20Sopenharmony_ci 9828c2ecf20Sopenharmony_ci put_unaligned_le32(out_val, &priv->buffer[d_size]); 9838c2ecf20Sopenharmony_ci d_size += 4; 9848c2ecf20Sopenharmony_ci } else { 9858c2ecf20Sopenharmony_ci d_size += 2; 9868c2ecf20Sopenharmony_ci } 9878c2ecf20Sopenharmony_ci } 9888c2ecf20Sopenharmony_ci 9898c2ecf20Sopenharmony_ci iio_push_to_buffers_with_timestamp(indio_dev, priv->buffer, 9908c2ecf20Sopenharmony_ci pf->timestamp); 9918c2ecf20Sopenharmony_cidone: 9928c2ecf20Sopenharmony_ci iio_trigger_notify_done(indio_dev->trig); 9938c2ecf20Sopenharmony_ci 9948c2ecf20Sopenharmony_ci return IRQ_HANDLED; 9958c2ecf20Sopenharmony_ci} 9968c2ecf20Sopenharmony_ci 9978c2ecf20Sopenharmony_cistatic u8 gp2ap020a00f_get_thresh_reg(const struct iio_chan_spec *chan, 9988c2ecf20Sopenharmony_ci enum iio_event_direction event_dir) 9998c2ecf20Sopenharmony_ci{ 10008c2ecf20Sopenharmony_ci switch (chan->type) { 10018c2ecf20Sopenharmony_ci case IIO_PROXIMITY: 10028c2ecf20Sopenharmony_ci if (event_dir == IIO_EV_DIR_RISING) 10038c2ecf20Sopenharmony_ci return GP2AP020A00F_PH_L_REG; 10048c2ecf20Sopenharmony_ci else 10058c2ecf20Sopenharmony_ci return GP2AP020A00F_PL_L_REG; 10068c2ecf20Sopenharmony_ci case IIO_LIGHT: 10078c2ecf20Sopenharmony_ci if (event_dir == IIO_EV_DIR_RISING) 10088c2ecf20Sopenharmony_ci return GP2AP020A00F_TH_L_REG; 10098c2ecf20Sopenharmony_ci else 10108c2ecf20Sopenharmony_ci return GP2AP020A00F_TL_L_REG; 10118c2ecf20Sopenharmony_ci default: 10128c2ecf20Sopenharmony_ci break; 10138c2ecf20Sopenharmony_ci } 10148c2ecf20Sopenharmony_ci 10158c2ecf20Sopenharmony_ci return -EINVAL; 10168c2ecf20Sopenharmony_ci} 10178c2ecf20Sopenharmony_ci 10188c2ecf20Sopenharmony_cistatic int gp2ap020a00f_write_event_val(struct iio_dev *indio_dev, 10198c2ecf20Sopenharmony_ci const struct iio_chan_spec *chan, 10208c2ecf20Sopenharmony_ci enum iio_event_type type, 10218c2ecf20Sopenharmony_ci enum iio_event_direction dir, 10228c2ecf20Sopenharmony_ci enum iio_event_info info, 10238c2ecf20Sopenharmony_ci int val, int val2) 10248c2ecf20Sopenharmony_ci{ 10258c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 10268c2ecf20Sopenharmony_ci bool event_en = false; 10278c2ecf20Sopenharmony_ci u8 thresh_val_id; 10288c2ecf20Sopenharmony_ci u8 thresh_reg_l; 10298c2ecf20Sopenharmony_ci int err = 0; 10308c2ecf20Sopenharmony_ci 10318c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 10328c2ecf20Sopenharmony_ci 10338c2ecf20Sopenharmony_ci thresh_reg_l = gp2ap020a00f_get_thresh_reg(chan, dir); 10348c2ecf20Sopenharmony_ci thresh_val_id = GP2AP020A00F_THRESH_VAL_ID(thresh_reg_l); 10358c2ecf20Sopenharmony_ci 10368c2ecf20Sopenharmony_ci if (thresh_val_id > GP2AP020A00F_THRESH_PH) { 10378c2ecf20Sopenharmony_ci err = -EINVAL; 10388c2ecf20Sopenharmony_ci goto error_unlock; 10398c2ecf20Sopenharmony_ci } 10408c2ecf20Sopenharmony_ci 10418c2ecf20Sopenharmony_ci switch (thresh_reg_l) { 10428c2ecf20Sopenharmony_ci case GP2AP020A00F_TH_L_REG: 10438c2ecf20Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, 10448c2ecf20Sopenharmony_ci &data->flags); 10458c2ecf20Sopenharmony_ci break; 10468c2ecf20Sopenharmony_ci case GP2AP020A00F_TL_L_REG: 10478c2ecf20Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, 10488c2ecf20Sopenharmony_ci &data->flags); 10498c2ecf20Sopenharmony_ci break; 10508c2ecf20Sopenharmony_ci case GP2AP020A00F_PH_L_REG: 10518c2ecf20Sopenharmony_ci if (val == 0) { 10528c2ecf20Sopenharmony_ci err = -EINVAL; 10538c2ecf20Sopenharmony_ci goto error_unlock; 10548c2ecf20Sopenharmony_ci } 10558c2ecf20Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, 10568c2ecf20Sopenharmony_ci &data->flags); 10578c2ecf20Sopenharmony_ci break; 10588c2ecf20Sopenharmony_ci case GP2AP020A00F_PL_L_REG: 10598c2ecf20Sopenharmony_ci if (val == 0) { 10608c2ecf20Sopenharmony_ci err = -EINVAL; 10618c2ecf20Sopenharmony_ci goto error_unlock; 10628c2ecf20Sopenharmony_ci } 10638c2ecf20Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, 10648c2ecf20Sopenharmony_ci &data->flags); 10658c2ecf20Sopenharmony_ci break; 10668c2ecf20Sopenharmony_ci } 10678c2ecf20Sopenharmony_ci 10688c2ecf20Sopenharmony_ci data->thresh_val[thresh_val_id] = val; 10698c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_event_threshold(data, thresh_val_id, 10708c2ecf20Sopenharmony_ci event_en); 10718c2ecf20Sopenharmony_cierror_unlock: 10728c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 10738c2ecf20Sopenharmony_ci 10748c2ecf20Sopenharmony_ci return err; 10758c2ecf20Sopenharmony_ci} 10768c2ecf20Sopenharmony_ci 10778c2ecf20Sopenharmony_cistatic int gp2ap020a00f_read_event_val(struct iio_dev *indio_dev, 10788c2ecf20Sopenharmony_ci const struct iio_chan_spec *chan, 10798c2ecf20Sopenharmony_ci enum iio_event_type type, 10808c2ecf20Sopenharmony_ci enum iio_event_direction dir, 10818c2ecf20Sopenharmony_ci enum iio_event_info info, 10828c2ecf20Sopenharmony_ci int *val, int *val2) 10838c2ecf20Sopenharmony_ci{ 10848c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 10858c2ecf20Sopenharmony_ci u8 thresh_reg_l; 10868c2ecf20Sopenharmony_ci int err = IIO_VAL_INT; 10878c2ecf20Sopenharmony_ci 10888c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 10898c2ecf20Sopenharmony_ci 10908c2ecf20Sopenharmony_ci thresh_reg_l = gp2ap020a00f_get_thresh_reg(chan, dir); 10918c2ecf20Sopenharmony_ci 10928c2ecf20Sopenharmony_ci if (thresh_reg_l > GP2AP020A00F_PH_L_REG) { 10938c2ecf20Sopenharmony_ci err = -EINVAL; 10948c2ecf20Sopenharmony_ci goto error_unlock; 10958c2ecf20Sopenharmony_ci } 10968c2ecf20Sopenharmony_ci 10978c2ecf20Sopenharmony_ci *val = data->thresh_val[GP2AP020A00F_THRESH_VAL_ID(thresh_reg_l)]; 10988c2ecf20Sopenharmony_ci 10998c2ecf20Sopenharmony_cierror_unlock: 11008c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 11018c2ecf20Sopenharmony_ci 11028c2ecf20Sopenharmony_ci return err; 11038c2ecf20Sopenharmony_ci} 11048c2ecf20Sopenharmony_ci 11058c2ecf20Sopenharmony_cistatic int gp2ap020a00f_write_prox_event_config(struct iio_dev *indio_dev, 11068c2ecf20Sopenharmony_ci int state) 11078c2ecf20Sopenharmony_ci{ 11088c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 11098c2ecf20Sopenharmony_ci enum gp2ap020a00f_cmd cmd_high_ev, cmd_low_ev; 11108c2ecf20Sopenharmony_ci int err; 11118c2ecf20Sopenharmony_ci 11128c2ecf20Sopenharmony_ci cmd_high_ev = state ? GP2AP020A00F_CMD_PROX_HIGH_EV_EN : 11138c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_PROX_HIGH_EV_DIS; 11148c2ecf20Sopenharmony_ci cmd_low_ev = state ? GP2AP020A00F_CMD_PROX_LOW_EV_EN : 11158c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_PROX_LOW_EV_DIS; 11168c2ecf20Sopenharmony_ci 11178c2ecf20Sopenharmony_ci /* 11188c2ecf20Sopenharmony_ci * In order to enable proximity detection feature in the device 11198c2ecf20Sopenharmony_ci * both high and low threshold registers have to be written 11208c2ecf20Sopenharmony_ci * with different values, greater than zero. 11218c2ecf20Sopenharmony_ci */ 11228c2ecf20Sopenharmony_ci if (state) { 11238c2ecf20Sopenharmony_ci if (data->thresh_val[GP2AP020A00F_THRESH_PL] == 0) 11248c2ecf20Sopenharmony_ci return -EINVAL; 11258c2ecf20Sopenharmony_ci 11268c2ecf20Sopenharmony_ci if (data->thresh_val[GP2AP020A00F_THRESH_PH] == 0) 11278c2ecf20Sopenharmony_ci return -EINVAL; 11288c2ecf20Sopenharmony_ci } 11298c2ecf20Sopenharmony_ci 11308c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd_high_ev); 11318c2ecf20Sopenharmony_ci if (err < 0) 11328c2ecf20Sopenharmony_ci return err; 11338c2ecf20Sopenharmony_ci 11348c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd_low_ev); 11358c2ecf20Sopenharmony_ci if (err < 0) 11368c2ecf20Sopenharmony_ci return err; 11378c2ecf20Sopenharmony_ci 11388c2ecf20Sopenharmony_ci free_irq(data->client->irq, indio_dev); 11398c2ecf20Sopenharmony_ci 11408c2ecf20Sopenharmony_ci if (state) 11418c2ecf20Sopenharmony_ci err = request_threaded_irq(data->client->irq, NULL, 11428c2ecf20Sopenharmony_ci &gp2ap020a00f_prox_sensing_handler, 11438c2ecf20Sopenharmony_ci IRQF_TRIGGER_RISING | 11448c2ecf20Sopenharmony_ci IRQF_TRIGGER_FALLING | 11458c2ecf20Sopenharmony_ci IRQF_ONESHOT, 11468c2ecf20Sopenharmony_ci "gp2ap020a00f_prox_sensing", 11478c2ecf20Sopenharmony_ci indio_dev); 11488c2ecf20Sopenharmony_ci else { 11498c2ecf20Sopenharmony_ci err = request_threaded_irq(data->client->irq, NULL, 11508c2ecf20Sopenharmony_ci &gp2ap020a00f_thresh_event_handler, 11518c2ecf20Sopenharmony_ci IRQF_TRIGGER_FALLING | 11528c2ecf20Sopenharmony_ci IRQF_ONESHOT, 11538c2ecf20Sopenharmony_ci "gp2ap020a00f_thresh_event", 11548c2ecf20Sopenharmony_ci indio_dev); 11558c2ecf20Sopenharmony_ci } 11568c2ecf20Sopenharmony_ci 11578c2ecf20Sopenharmony_ci return err; 11588c2ecf20Sopenharmony_ci} 11598c2ecf20Sopenharmony_ci 11608c2ecf20Sopenharmony_cistatic int gp2ap020a00f_write_event_config(struct iio_dev *indio_dev, 11618c2ecf20Sopenharmony_ci const struct iio_chan_spec *chan, 11628c2ecf20Sopenharmony_ci enum iio_event_type type, 11638c2ecf20Sopenharmony_ci enum iio_event_direction dir, 11648c2ecf20Sopenharmony_ci int state) 11658c2ecf20Sopenharmony_ci{ 11668c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 11678c2ecf20Sopenharmony_ci enum gp2ap020a00f_cmd cmd; 11688c2ecf20Sopenharmony_ci int err; 11698c2ecf20Sopenharmony_ci 11708c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 11718c2ecf20Sopenharmony_ci 11728c2ecf20Sopenharmony_ci switch (chan->type) { 11738c2ecf20Sopenharmony_ci case IIO_PROXIMITY: 11748c2ecf20Sopenharmony_ci err = gp2ap020a00f_write_prox_event_config(indio_dev, state); 11758c2ecf20Sopenharmony_ci break; 11768c2ecf20Sopenharmony_ci case IIO_LIGHT: 11778c2ecf20Sopenharmony_ci if (dir == IIO_EV_DIR_RISING) { 11788c2ecf20Sopenharmony_ci cmd = state ? GP2AP020A00F_CMD_ALS_HIGH_EV_EN : 11798c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_ALS_HIGH_EV_DIS; 11808c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd); 11818c2ecf20Sopenharmony_ci } else { 11828c2ecf20Sopenharmony_ci cmd = state ? GP2AP020A00F_CMD_ALS_LOW_EV_EN : 11838c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_ALS_LOW_EV_DIS; 11848c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd); 11858c2ecf20Sopenharmony_ci } 11868c2ecf20Sopenharmony_ci break; 11878c2ecf20Sopenharmony_ci default: 11888c2ecf20Sopenharmony_ci err = -EINVAL; 11898c2ecf20Sopenharmony_ci } 11908c2ecf20Sopenharmony_ci 11918c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 11928c2ecf20Sopenharmony_ci 11938c2ecf20Sopenharmony_ci return err; 11948c2ecf20Sopenharmony_ci} 11958c2ecf20Sopenharmony_ci 11968c2ecf20Sopenharmony_cistatic int gp2ap020a00f_read_event_config(struct iio_dev *indio_dev, 11978c2ecf20Sopenharmony_ci const struct iio_chan_spec *chan, 11988c2ecf20Sopenharmony_ci enum iio_event_type type, 11998c2ecf20Sopenharmony_ci enum iio_event_direction dir) 12008c2ecf20Sopenharmony_ci{ 12018c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 12028c2ecf20Sopenharmony_ci int event_en = 0; 12038c2ecf20Sopenharmony_ci 12048c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 12058c2ecf20Sopenharmony_ci 12068c2ecf20Sopenharmony_ci switch (chan->type) { 12078c2ecf20Sopenharmony_ci case IIO_PROXIMITY: 12088c2ecf20Sopenharmony_ci if (dir == IIO_EV_DIR_RISING) 12098c2ecf20Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_PROX_RISING_EV, 12108c2ecf20Sopenharmony_ci &data->flags); 12118c2ecf20Sopenharmony_ci else 12128c2ecf20Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_PROX_FALLING_EV, 12138c2ecf20Sopenharmony_ci &data->flags); 12148c2ecf20Sopenharmony_ci break; 12158c2ecf20Sopenharmony_ci case IIO_LIGHT: 12168c2ecf20Sopenharmony_ci if (dir == IIO_EV_DIR_RISING) 12178c2ecf20Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_ALS_RISING_EV, 12188c2ecf20Sopenharmony_ci &data->flags); 12198c2ecf20Sopenharmony_ci else 12208c2ecf20Sopenharmony_ci event_en = test_bit(GP2AP020A00F_FLAG_ALS_FALLING_EV, 12218c2ecf20Sopenharmony_ci &data->flags); 12228c2ecf20Sopenharmony_ci break; 12238c2ecf20Sopenharmony_ci default: 12248c2ecf20Sopenharmony_ci event_en = -EINVAL; 12258c2ecf20Sopenharmony_ci break; 12268c2ecf20Sopenharmony_ci } 12278c2ecf20Sopenharmony_ci 12288c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 12298c2ecf20Sopenharmony_ci 12308c2ecf20Sopenharmony_ci return event_en; 12318c2ecf20Sopenharmony_ci} 12328c2ecf20Sopenharmony_ci 12338c2ecf20Sopenharmony_cistatic int gp2ap020a00f_read_channel(struct gp2ap020a00f_data *data, 12348c2ecf20Sopenharmony_ci struct iio_chan_spec const *chan, int *val) 12358c2ecf20Sopenharmony_ci{ 12368c2ecf20Sopenharmony_ci enum gp2ap020a00f_cmd cmd; 12378c2ecf20Sopenharmony_ci int err; 12388c2ecf20Sopenharmony_ci 12398c2ecf20Sopenharmony_ci switch (chan->scan_index) { 12408c2ecf20Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR: 12418c2ecf20Sopenharmony_ci cmd = GP2AP020A00F_CMD_READ_RAW_CLEAR; 12428c2ecf20Sopenharmony_ci break; 12438c2ecf20Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_IR: 12448c2ecf20Sopenharmony_ci cmd = GP2AP020A00F_CMD_READ_RAW_IR; 12458c2ecf20Sopenharmony_ci break; 12468c2ecf20Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_PROXIMITY: 12478c2ecf20Sopenharmony_ci cmd = GP2AP020A00F_CMD_READ_RAW_PROXIMITY; 12488c2ecf20Sopenharmony_ci break; 12498c2ecf20Sopenharmony_ci default: 12508c2ecf20Sopenharmony_ci return -EINVAL; 12518c2ecf20Sopenharmony_ci } 12528c2ecf20Sopenharmony_ci 12538c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, cmd); 12548c2ecf20Sopenharmony_ci if (err < 0) { 12558c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 12568c2ecf20Sopenharmony_ci "gp2ap020a00f_exec_cmd failed\n"); 12578c2ecf20Sopenharmony_ci goto error_ret; 12588c2ecf20Sopenharmony_ci } 12598c2ecf20Sopenharmony_ci 12608c2ecf20Sopenharmony_ci err = gp2ap020a00f_read_output(data, chan->address, val); 12618c2ecf20Sopenharmony_ci if (err < 0) 12628c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 12638c2ecf20Sopenharmony_ci "gp2ap020a00f_read_output failed\n"); 12648c2ecf20Sopenharmony_ci 12658c2ecf20Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 12668c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN); 12678c2ecf20Sopenharmony_ci if (err < 0) 12688c2ecf20Sopenharmony_ci dev_err(&data->client->dev, 12698c2ecf20Sopenharmony_ci "Failed to shut down the device.\n"); 12708c2ecf20Sopenharmony_ci 12718c2ecf20Sopenharmony_ci if (cmd == GP2AP020A00F_CMD_READ_RAW_CLEAR || 12728c2ecf20Sopenharmony_ci cmd == GP2AP020A00F_CMD_READ_RAW_IR) 12738c2ecf20Sopenharmony_ci gp2ap020a00f_output_to_lux(data, val); 12748c2ecf20Sopenharmony_ci 12758c2ecf20Sopenharmony_cierror_ret: 12768c2ecf20Sopenharmony_ci return err; 12778c2ecf20Sopenharmony_ci} 12788c2ecf20Sopenharmony_ci 12798c2ecf20Sopenharmony_cistatic int gp2ap020a00f_read_raw(struct iio_dev *indio_dev, 12808c2ecf20Sopenharmony_ci struct iio_chan_spec const *chan, 12818c2ecf20Sopenharmony_ci int *val, int *val2, 12828c2ecf20Sopenharmony_ci long mask) 12838c2ecf20Sopenharmony_ci{ 12848c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 12858c2ecf20Sopenharmony_ci int err = -EINVAL; 12868c2ecf20Sopenharmony_ci 12878c2ecf20Sopenharmony_ci if (mask == IIO_CHAN_INFO_RAW) { 12888c2ecf20Sopenharmony_ci err = iio_device_claim_direct_mode(indio_dev); 12898c2ecf20Sopenharmony_ci if (err) 12908c2ecf20Sopenharmony_ci return err; 12918c2ecf20Sopenharmony_ci 12928c2ecf20Sopenharmony_ci err = gp2ap020a00f_read_channel(data, chan, val); 12938c2ecf20Sopenharmony_ci iio_device_release_direct_mode(indio_dev); 12948c2ecf20Sopenharmony_ci } 12958c2ecf20Sopenharmony_ci return err < 0 ? err : IIO_VAL_INT; 12968c2ecf20Sopenharmony_ci} 12978c2ecf20Sopenharmony_ci 12988c2ecf20Sopenharmony_cistatic const struct iio_event_spec gp2ap020a00f_event_spec_light[] = { 12998c2ecf20Sopenharmony_ci { 13008c2ecf20Sopenharmony_ci .type = IIO_EV_TYPE_THRESH, 13018c2ecf20Sopenharmony_ci .dir = IIO_EV_DIR_RISING, 13028c2ecf20Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_VALUE) | 13038c2ecf20Sopenharmony_ci BIT(IIO_EV_INFO_ENABLE), 13048c2ecf20Sopenharmony_ci }, { 13058c2ecf20Sopenharmony_ci .type = IIO_EV_TYPE_THRESH, 13068c2ecf20Sopenharmony_ci .dir = IIO_EV_DIR_FALLING, 13078c2ecf20Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_VALUE) | 13088c2ecf20Sopenharmony_ci BIT(IIO_EV_INFO_ENABLE), 13098c2ecf20Sopenharmony_ci }, 13108c2ecf20Sopenharmony_ci}; 13118c2ecf20Sopenharmony_ci 13128c2ecf20Sopenharmony_cistatic const struct iio_event_spec gp2ap020a00f_event_spec_prox[] = { 13138c2ecf20Sopenharmony_ci { 13148c2ecf20Sopenharmony_ci .type = IIO_EV_TYPE_ROC, 13158c2ecf20Sopenharmony_ci .dir = IIO_EV_DIR_RISING, 13168c2ecf20Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_VALUE) | 13178c2ecf20Sopenharmony_ci BIT(IIO_EV_INFO_ENABLE), 13188c2ecf20Sopenharmony_ci }, { 13198c2ecf20Sopenharmony_ci .type = IIO_EV_TYPE_ROC, 13208c2ecf20Sopenharmony_ci .dir = IIO_EV_DIR_FALLING, 13218c2ecf20Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_VALUE) | 13228c2ecf20Sopenharmony_ci BIT(IIO_EV_INFO_ENABLE), 13238c2ecf20Sopenharmony_ci }, 13248c2ecf20Sopenharmony_ci}; 13258c2ecf20Sopenharmony_ci 13268c2ecf20Sopenharmony_cistatic const struct iio_chan_spec gp2ap020a00f_channels[] = { 13278c2ecf20Sopenharmony_ci { 13288c2ecf20Sopenharmony_ci .type = IIO_LIGHT, 13298c2ecf20Sopenharmony_ci .channel2 = IIO_MOD_LIGHT_CLEAR, 13308c2ecf20Sopenharmony_ci .modified = 1, 13318c2ecf20Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 13328c2ecf20Sopenharmony_ci .scan_type = { 13338c2ecf20Sopenharmony_ci .sign = 'u', 13348c2ecf20Sopenharmony_ci .realbits = 24, 13358c2ecf20Sopenharmony_ci .shift = 0, 13368c2ecf20Sopenharmony_ci .storagebits = 32, 13378c2ecf20Sopenharmony_ci .endianness = IIO_LE, 13388c2ecf20Sopenharmony_ci }, 13398c2ecf20Sopenharmony_ci .scan_index = GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR, 13408c2ecf20Sopenharmony_ci .address = GP2AP020A00F_D0_L_REG, 13418c2ecf20Sopenharmony_ci .event_spec = gp2ap020a00f_event_spec_light, 13428c2ecf20Sopenharmony_ci .num_event_specs = ARRAY_SIZE(gp2ap020a00f_event_spec_light), 13438c2ecf20Sopenharmony_ci }, 13448c2ecf20Sopenharmony_ci { 13458c2ecf20Sopenharmony_ci .type = IIO_LIGHT, 13468c2ecf20Sopenharmony_ci .channel2 = IIO_MOD_LIGHT_IR, 13478c2ecf20Sopenharmony_ci .modified = 1, 13488c2ecf20Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 13498c2ecf20Sopenharmony_ci .scan_type = { 13508c2ecf20Sopenharmony_ci .sign = 'u', 13518c2ecf20Sopenharmony_ci .realbits = 24, 13528c2ecf20Sopenharmony_ci .shift = 0, 13538c2ecf20Sopenharmony_ci .storagebits = 32, 13548c2ecf20Sopenharmony_ci .endianness = IIO_LE, 13558c2ecf20Sopenharmony_ci }, 13568c2ecf20Sopenharmony_ci .scan_index = GP2AP020A00F_SCAN_MODE_LIGHT_IR, 13578c2ecf20Sopenharmony_ci .address = GP2AP020A00F_D1_L_REG, 13588c2ecf20Sopenharmony_ci }, 13598c2ecf20Sopenharmony_ci { 13608c2ecf20Sopenharmony_ci .type = IIO_PROXIMITY, 13618c2ecf20Sopenharmony_ci .modified = 0, 13628c2ecf20Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 13638c2ecf20Sopenharmony_ci .scan_type = { 13648c2ecf20Sopenharmony_ci .sign = 'u', 13658c2ecf20Sopenharmony_ci .realbits = 16, 13668c2ecf20Sopenharmony_ci .shift = 0, 13678c2ecf20Sopenharmony_ci .storagebits = 16, 13688c2ecf20Sopenharmony_ci .endianness = IIO_LE, 13698c2ecf20Sopenharmony_ci }, 13708c2ecf20Sopenharmony_ci .scan_index = GP2AP020A00F_SCAN_MODE_PROXIMITY, 13718c2ecf20Sopenharmony_ci .address = GP2AP020A00F_D2_L_REG, 13728c2ecf20Sopenharmony_ci .event_spec = gp2ap020a00f_event_spec_prox, 13738c2ecf20Sopenharmony_ci .num_event_specs = ARRAY_SIZE(gp2ap020a00f_event_spec_prox), 13748c2ecf20Sopenharmony_ci }, 13758c2ecf20Sopenharmony_ci IIO_CHAN_SOFT_TIMESTAMP(GP2AP020A00F_CHAN_TIMESTAMP), 13768c2ecf20Sopenharmony_ci}; 13778c2ecf20Sopenharmony_ci 13788c2ecf20Sopenharmony_cistatic const struct iio_info gp2ap020a00f_info = { 13798c2ecf20Sopenharmony_ci .read_raw = &gp2ap020a00f_read_raw, 13808c2ecf20Sopenharmony_ci .read_event_value = &gp2ap020a00f_read_event_val, 13818c2ecf20Sopenharmony_ci .read_event_config = &gp2ap020a00f_read_event_config, 13828c2ecf20Sopenharmony_ci .write_event_value = &gp2ap020a00f_write_event_val, 13838c2ecf20Sopenharmony_ci .write_event_config = &gp2ap020a00f_write_event_config, 13848c2ecf20Sopenharmony_ci}; 13858c2ecf20Sopenharmony_ci 13868c2ecf20Sopenharmony_cistatic int gp2ap020a00f_buffer_postenable(struct iio_dev *indio_dev) 13878c2ecf20Sopenharmony_ci{ 13888c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 13898c2ecf20Sopenharmony_ci int i, err = 0; 13908c2ecf20Sopenharmony_ci 13918c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 13928c2ecf20Sopenharmony_ci 13938c2ecf20Sopenharmony_ci /* 13948c2ecf20Sopenharmony_ci * Enable triggers according to the scan_mask. Enabling either 13958c2ecf20Sopenharmony_ci * LIGHT_CLEAR or LIGHT_IR scan mode results in enabling ALS 13968c2ecf20Sopenharmony_ci * module in the device, which generates samples in both D0 (clear) 13978c2ecf20Sopenharmony_ci * and D1 (ir) registers. As the two registers are bound to the 13988c2ecf20Sopenharmony_ci * two separate IIO channels they are treated in the driver logic 13998c2ecf20Sopenharmony_ci * as if they were controlled independently. 14008c2ecf20Sopenharmony_ci */ 14018c2ecf20Sopenharmony_ci for_each_set_bit(i, indio_dev->active_scan_mask, 14028c2ecf20Sopenharmony_ci indio_dev->masklength) { 14038c2ecf20Sopenharmony_ci switch (i) { 14048c2ecf20Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR: 14058c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 14068c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_CLEAR_EN); 14078c2ecf20Sopenharmony_ci break; 14088c2ecf20Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_IR: 14098c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 14108c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_IR_EN); 14118c2ecf20Sopenharmony_ci break; 14128c2ecf20Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_PROXIMITY: 14138c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 14148c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_PROX_EN); 14158c2ecf20Sopenharmony_ci break; 14168c2ecf20Sopenharmony_ci } 14178c2ecf20Sopenharmony_ci } 14188c2ecf20Sopenharmony_ci 14198c2ecf20Sopenharmony_ci if (err < 0) 14208c2ecf20Sopenharmony_ci goto error_unlock; 14218c2ecf20Sopenharmony_ci 14228c2ecf20Sopenharmony_ci data->buffer = kmalloc(indio_dev->scan_bytes, GFP_KERNEL); 14238c2ecf20Sopenharmony_ci if (!data->buffer) 14248c2ecf20Sopenharmony_ci err = -ENOMEM; 14258c2ecf20Sopenharmony_ci 14268c2ecf20Sopenharmony_cierror_unlock: 14278c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 14288c2ecf20Sopenharmony_ci 14298c2ecf20Sopenharmony_ci return err; 14308c2ecf20Sopenharmony_ci} 14318c2ecf20Sopenharmony_ci 14328c2ecf20Sopenharmony_cistatic int gp2ap020a00f_buffer_predisable(struct iio_dev *indio_dev) 14338c2ecf20Sopenharmony_ci{ 14348c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 14358c2ecf20Sopenharmony_ci int i, err = 0; 14368c2ecf20Sopenharmony_ci 14378c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 14388c2ecf20Sopenharmony_ci 14398c2ecf20Sopenharmony_ci for_each_set_bit(i, indio_dev->active_scan_mask, 14408c2ecf20Sopenharmony_ci indio_dev->masklength) { 14418c2ecf20Sopenharmony_ci switch (i) { 14428c2ecf20Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_CLEAR: 14438c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 14448c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_CLEAR_DIS); 14458c2ecf20Sopenharmony_ci break; 14468c2ecf20Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_LIGHT_IR: 14478c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 14488c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_IR_DIS); 14498c2ecf20Sopenharmony_ci break; 14508c2ecf20Sopenharmony_ci case GP2AP020A00F_SCAN_MODE_PROXIMITY: 14518c2ecf20Sopenharmony_ci err = gp2ap020a00f_exec_cmd(data, 14528c2ecf20Sopenharmony_ci GP2AP020A00F_CMD_TRIGGER_PROX_DIS); 14538c2ecf20Sopenharmony_ci break; 14548c2ecf20Sopenharmony_ci } 14558c2ecf20Sopenharmony_ci } 14568c2ecf20Sopenharmony_ci 14578c2ecf20Sopenharmony_ci if (err == 0) 14588c2ecf20Sopenharmony_ci kfree(data->buffer); 14598c2ecf20Sopenharmony_ci 14608c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 14618c2ecf20Sopenharmony_ci 14628c2ecf20Sopenharmony_ci return err; 14638c2ecf20Sopenharmony_ci} 14648c2ecf20Sopenharmony_ci 14658c2ecf20Sopenharmony_cistatic const struct iio_buffer_setup_ops gp2ap020a00f_buffer_setup_ops = { 14668c2ecf20Sopenharmony_ci .postenable = &gp2ap020a00f_buffer_postenable, 14678c2ecf20Sopenharmony_ci .predisable = &gp2ap020a00f_buffer_predisable, 14688c2ecf20Sopenharmony_ci}; 14698c2ecf20Sopenharmony_ci 14708c2ecf20Sopenharmony_cistatic const struct iio_trigger_ops gp2ap020a00f_trigger_ops = { 14718c2ecf20Sopenharmony_ci}; 14728c2ecf20Sopenharmony_ci 14738c2ecf20Sopenharmony_cistatic int gp2ap020a00f_probe(struct i2c_client *client, 14748c2ecf20Sopenharmony_ci const struct i2c_device_id *id) 14758c2ecf20Sopenharmony_ci{ 14768c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data; 14778c2ecf20Sopenharmony_ci struct iio_dev *indio_dev; 14788c2ecf20Sopenharmony_ci struct regmap *regmap; 14798c2ecf20Sopenharmony_ci int err; 14808c2ecf20Sopenharmony_ci 14818c2ecf20Sopenharmony_ci indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 14828c2ecf20Sopenharmony_ci if (!indio_dev) 14838c2ecf20Sopenharmony_ci return -ENOMEM; 14848c2ecf20Sopenharmony_ci 14858c2ecf20Sopenharmony_ci data = iio_priv(indio_dev); 14868c2ecf20Sopenharmony_ci 14878c2ecf20Sopenharmony_ci data->vled_reg = devm_regulator_get(&client->dev, "vled"); 14888c2ecf20Sopenharmony_ci if (IS_ERR(data->vled_reg)) 14898c2ecf20Sopenharmony_ci return PTR_ERR(data->vled_reg); 14908c2ecf20Sopenharmony_ci 14918c2ecf20Sopenharmony_ci err = regulator_enable(data->vled_reg); 14928c2ecf20Sopenharmony_ci if (err) 14938c2ecf20Sopenharmony_ci return err; 14948c2ecf20Sopenharmony_ci 14958c2ecf20Sopenharmony_ci regmap = devm_regmap_init_i2c(client, &gp2ap020a00f_regmap_config); 14968c2ecf20Sopenharmony_ci if (IS_ERR(regmap)) { 14978c2ecf20Sopenharmony_ci dev_err(&client->dev, "Regmap initialization failed.\n"); 14988c2ecf20Sopenharmony_ci err = PTR_ERR(regmap); 14998c2ecf20Sopenharmony_ci goto error_regulator_disable; 15008c2ecf20Sopenharmony_ci } 15018c2ecf20Sopenharmony_ci 15028c2ecf20Sopenharmony_ci /* Initialize device registers */ 15038c2ecf20Sopenharmony_ci err = regmap_bulk_write(regmap, GP2AP020A00F_OP_REG, 15048c2ecf20Sopenharmony_ci gp2ap020a00f_reg_init_tab, 15058c2ecf20Sopenharmony_ci ARRAY_SIZE(gp2ap020a00f_reg_init_tab)); 15068c2ecf20Sopenharmony_ci 15078c2ecf20Sopenharmony_ci if (err < 0) { 15088c2ecf20Sopenharmony_ci dev_err(&client->dev, "Device initialization failed.\n"); 15098c2ecf20Sopenharmony_ci goto error_regulator_disable; 15108c2ecf20Sopenharmony_ci } 15118c2ecf20Sopenharmony_ci 15128c2ecf20Sopenharmony_ci i2c_set_clientdata(client, indio_dev); 15138c2ecf20Sopenharmony_ci 15148c2ecf20Sopenharmony_ci data->client = client; 15158c2ecf20Sopenharmony_ci data->cur_opmode = GP2AP020A00F_OPMODE_SHUTDOWN; 15168c2ecf20Sopenharmony_ci data->regmap = regmap; 15178c2ecf20Sopenharmony_ci init_waitqueue_head(&data->data_ready_queue); 15188c2ecf20Sopenharmony_ci 15198c2ecf20Sopenharmony_ci mutex_init(&data->lock); 15208c2ecf20Sopenharmony_ci indio_dev->channels = gp2ap020a00f_channels; 15218c2ecf20Sopenharmony_ci indio_dev->num_channels = ARRAY_SIZE(gp2ap020a00f_channels); 15228c2ecf20Sopenharmony_ci indio_dev->info = &gp2ap020a00f_info; 15238c2ecf20Sopenharmony_ci indio_dev->name = id->name; 15248c2ecf20Sopenharmony_ci indio_dev->modes = INDIO_DIRECT_MODE; 15258c2ecf20Sopenharmony_ci 15268c2ecf20Sopenharmony_ci /* Allocate buffer */ 15278c2ecf20Sopenharmony_ci err = iio_triggered_buffer_setup(indio_dev, &iio_pollfunc_store_time, 15288c2ecf20Sopenharmony_ci &gp2ap020a00f_trigger_handler, &gp2ap020a00f_buffer_setup_ops); 15298c2ecf20Sopenharmony_ci if (err < 0) 15308c2ecf20Sopenharmony_ci goto error_regulator_disable; 15318c2ecf20Sopenharmony_ci 15328c2ecf20Sopenharmony_ci /* Allocate trigger */ 15338c2ecf20Sopenharmony_ci data->trig = devm_iio_trigger_alloc(&client->dev, "%s-trigger", 15348c2ecf20Sopenharmony_ci indio_dev->name); 15358c2ecf20Sopenharmony_ci if (data->trig == NULL) { 15368c2ecf20Sopenharmony_ci err = -ENOMEM; 15378c2ecf20Sopenharmony_ci dev_err(&indio_dev->dev, "Failed to allocate iio trigger.\n"); 15388c2ecf20Sopenharmony_ci goto error_uninit_buffer; 15398c2ecf20Sopenharmony_ci } 15408c2ecf20Sopenharmony_ci 15418c2ecf20Sopenharmony_ci /* This needs to be requested here for read_raw calls to work. */ 15428c2ecf20Sopenharmony_ci err = request_threaded_irq(client->irq, NULL, 15438c2ecf20Sopenharmony_ci &gp2ap020a00f_thresh_event_handler, 15448c2ecf20Sopenharmony_ci IRQF_TRIGGER_FALLING | 15458c2ecf20Sopenharmony_ci IRQF_ONESHOT, 15468c2ecf20Sopenharmony_ci "gp2ap020a00f_als_event", 15478c2ecf20Sopenharmony_ci indio_dev); 15488c2ecf20Sopenharmony_ci if (err < 0) { 15498c2ecf20Sopenharmony_ci dev_err(&client->dev, "Irq request failed.\n"); 15508c2ecf20Sopenharmony_ci goto error_uninit_buffer; 15518c2ecf20Sopenharmony_ci } 15528c2ecf20Sopenharmony_ci 15538c2ecf20Sopenharmony_ci data->trig->ops = &gp2ap020a00f_trigger_ops; 15548c2ecf20Sopenharmony_ci data->trig->dev.parent = &data->client->dev; 15558c2ecf20Sopenharmony_ci 15568c2ecf20Sopenharmony_ci init_irq_work(&data->work, gp2ap020a00f_iio_trigger_work); 15578c2ecf20Sopenharmony_ci 15588c2ecf20Sopenharmony_ci err = iio_trigger_register(data->trig); 15598c2ecf20Sopenharmony_ci if (err < 0) { 15608c2ecf20Sopenharmony_ci dev_err(&client->dev, "Failed to register iio trigger.\n"); 15618c2ecf20Sopenharmony_ci goto error_free_irq; 15628c2ecf20Sopenharmony_ci } 15638c2ecf20Sopenharmony_ci 15648c2ecf20Sopenharmony_ci err = iio_device_register(indio_dev); 15658c2ecf20Sopenharmony_ci if (err < 0) 15668c2ecf20Sopenharmony_ci goto error_trigger_unregister; 15678c2ecf20Sopenharmony_ci 15688c2ecf20Sopenharmony_ci return 0; 15698c2ecf20Sopenharmony_ci 15708c2ecf20Sopenharmony_cierror_trigger_unregister: 15718c2ecf20Sopenharmony_ci iio_trigger_unregister(data->trig); 15728c2ecf20Sopenharmony_cierror_free_irq: 15738c2ecf20Sopenharmony_ci free_irq(client->irq, indio_dev); 15748c2ecf20Sopenharmony_cierror_uninit_buffer: 15758c2ecf20Sopenharmony_ci iio_triggered_buffer_cleanup(indio_dev); 15768c2ecf20Sopenharmony_cierror_regulator_disable: 15778c2ecf20Sopenharmony_ci regulator_disable(data->vled_reg); 15788c2ecf20Sopenharmony_ci 15798c2ecf20Sopenharmony_ci return err; 15808c2ecf20Sopenharmony_ci} 15818c2ecf20Sopenharmony_ci 15828c2ecf20Sopenharmony_cistatic int gp2ap020a00f_remove(struct i2c_client *client) 15838c2ecf20Sopenharmony_ci{ 15848c2ecf20Sopenharmony_ci struct iio_dev *indio_dev = i2c_get_clientdata(client); 15858c2ecf20Sopenharmony_ci struct gp2ap020a00f_data *data = iio_priv(indio_dev); 15868c2ecf20Sopenharmony_ci int err; 15878c2ecf20Sopenharmony_ci 15888c2ecf20Sopenharmony_ci err = gp2ap020a00f_set_operation_mode(data, 15898c2ecf20Sopenharmony_ci GP2AP020A00F_OPMODE_SHUTDOWN); 15908c2ecf20Sopenharmony_ci if (err < 0) 15918c2ecf20Sopenharmony_ci dev_err(&indio_dev->dev, "Failed to power off the device.\n"); 15928c2ecf20Sopenharmony_ci 15938c2ecf20Sopenharmony_ci iio_device_unregister(indio_dev); 15948c2ecf20Sopenharmony_ci iio_trigger_unregister(data->trig); 15958c2ecf20Sopenharmony_ci free_irq(client->irq, indio_dev); 15968c2ecf20Sopenharmony_ci iio_triggered_buffer_cleanup(indio_dev); 15978c2ecf20Sopenharmony_ci regulator_disable(data->vled_reg); 15988c2ecf20Sopenharmony_ci 15998c2ecf20Sopenharmony_ci return 0; 16008c2ecf20Sopenharmony_ci} 16018c2ecf20Sopenharmony_ci 16028c2ecf20Sopenharmony_cistatic const struct i2c_device_id gp2ap020a00f_id[] = { 16038c2ecf20Sopenharmony_ci { GP2A_I2C_NAME, 0 }, 16048c2ecf20Sopenharmony_ci { } 16058c2ecf20Sopenharmony_ci}; 16068c2ecf20Sopenharmony_ci 16078c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, gp2ap020a00f_id); 16088c2ecf20Sopenharmony_ci 16098c2ecf20Sopenharmony_cistatic const struct of_device_id gp2ap020a00f_of_match[] = { 16108c2ecf20Sopenharmony_ci { .compatible = "sharp,gp2ap020a00f" }, 16118c2ecf20Sopenharmony_ci { } 16128c2ecf20Sopenharmony_ci}; 16138c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(of, gp2ap020a00f_of_match); 16148c2ecf20Sopenharmony_ci 16158c2ecf20Sopenharmony_cistatic struct i2c_driver gp2ap020a00f_driver = { 16168c2ecf20Sopenharmony_ci .driver = { 16178c2ecf20Sopenharmony_ci .name = GP2A_I2C_NAME, 16188c2ecf20Sopenharmony_ci .of_match_table = gp2ap020a00f_of_match, 16198c2ecf20Sopenharmony_ci }, 16208c2ecf20Sopenharmony_ci .probe = gp2ap020a00f_probe, 16218c2ecf20Sopenharmony_ci .remove = gp2ap020a00f_remove, 16228c2ecf20Sopenharmony_ci .id_table = gp2ap020a00f_id, 16238c2ecf20Sopenharmony_ci}; 16248c2ecf20Sopenharmony_ci 16258c2ecf20Sopenharmony_cimodule_i2c_driver(gp2ap020a00f_driver); 16268c2ecf20Sopenharmony_ci 16278c2ecf20Sopenharmony_ciMODULE_AUTHOR("Jacek Anaszewski <j.anaszewski@samsung.com>"); 16288c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Sharp GP2AP020A00F Proximity/ALS sensor driver"); 16298c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL v2"); 1630