On Sun, Jul 19, 2015 at 3:45 AM, Jonathan Cameron <jic23@xxxxxxxxxx> wrote:
> On 13/07/15 03:20, Matt Ranostay wrote:
>> APDS9960 is a combination of ALS, proximity, and gesture sensors.
>>
>> This patch adds support for these functions along with gain control,
>> integration time, and event thresholds.
>>
>> Signed-off-by: Matt Ranostay <mranostay@xxxxxxxxx>
> Mostly looking good. You don't need to repeat standard docs and there
> are a few bits and pieces inline.
>
> Jonathan
>> ---
>> .../ABI/testing/sysfs-bus-iio-light-apds9960 | 128 +++
>> drivers/iio/light/Kconfig | 12 +
>> drivers/iio/light/Makefile | 1 +
>> drivers/iio/light/apds9960.c | 1208 ++++++++++++++++++++
>> 4 files changed, 1349 insertions(+)
>> create mode 100644 Documentation/ABI/testing/sysfs-bus-iio-light-apds9960
>> create mode 100644 drivers/iio/light/apds9960.c
>>
>> diff --git a/Documentation/ABI/testing/sysfs-bus-iio-light-apds9960 b/Documentation/ABI/testing/sysfs-bus-iio-light-apds9960
>> new file mode 100644
>> index 0000000..010b8c8
>> --- /dev/null
>> +++ b/Documentation/ABI/testing/sysfs-bus-iio-light-apds9960
>> @@ -0,0 +1,128 @@
> As a general rule, don't document any attributes covered by more generic
> docs. Just leads to more ways to have out of date documentation!
>> +What: /sys/bus/iio/devices/triggerX/name = "apds9960-gestureX"
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + The APDS9960 kernel module provides a trigger which enables
>> + the gesture engine that pushes motion data to the buffer when
>> + it becomes available.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_proximity0_raw
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Get the non-gesture proximity sensor value.
> Looks like the generic docs need a wild card indexed version of these added
> (curriously the 0 index channel is there which makes no sense without allowing
> for higher indexes).
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_proximity1_raw
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Get the UP gesture photodiode proximity value.
>> + Access is disabled to prevent the side effect of
>> + userspace clearing the hardware FIFO.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_proximity2_raw
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Get the DOWN gesture photodiode proximity value.
>> + Access is disabled to prevent the side effect of
>> + userspace clearing the hardware FIFO.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_proximity3_raw
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Get the LEFT gesture photodiode proximity value.
>> + Access is disabled to prevent the side effect of
>> + userspace clearing the hardware FIFO.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_proximity4_raw
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Get the RIGHT gesture photodiode proximity value.
>> + Access is disabled to prevent the side effect of
>> + userspace clearing the hardware FIFO.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_intensity_clear_raw
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Get the current unprocessed illuminance for the clear/ALS
>> + photodiode.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_intensity_red_raw
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Get the current unprocessed illuminance value for the
>> + red light wavelength photodiode.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_intensity_green_raw
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Get the current unprocessed illuminance value for the
>> + green light wavelength photodiode.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_intensity_blue_raw
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Get the current unprocessed illuminance value for the
>> + blue light wavelength photodiode.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/integration_time_available
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Provide allowed integration time values in fractions of a second
>> + for the ALS + RGB sensor engines.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_intensity_integration_time
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Set integration time in fractions of a second for the ALS + RGB
>> + sensor engines.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/proximity_scale_available
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Provide the allowed gain values for the proximity + gesture
>> + engines.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_proximity_scale
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Set the gain value for the proximity + gesture engines.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/intensity_scale_available
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Provide the allowed gain values for the ALS + RGB sensor
>> + engines.
>> +
>> +What /sys/bus/iio/devices/iio:deviceX/in_intensity_scale
>> +Date: July 2015
>> +KernelVersion: 4.2
>> +Contact: Matt Ranostay <mranostay@xxxxxxxxx>
>> +Description:
>> + Set the gain value for the ALS + RGB sensor engines.
> Nothing at all in here is non standard, so as things currently stand
> you don't need the additional ABI document.
Ok will drop in v4
>>
> diff --git a/drivers/iio/light/Kconfig b/drivers/iio/light/Kconfig
>> index e6198b7..6a4a47c7 100644
>> --- a/drivers/iio/light/Kconfig
>> +++ b/drivers/iio/light/Kconfig
>> @@ -50,6 +50,18 @@ config APDS9300
>> To compile this driver as a module, choose M here: the
>> module will be called apds9300.
>>
>> +config APDS9960
>> + tristate "Avago APDS9960 gesture/RGB/ALS/proximity sensor"
>> + select IIO_BUFFER
> missing regmap_i2c dependency.
Noted
>> + select IIO_TRIGGERED_BUFFER
>> + depends on I2C
>> + help
>> + Say Y here to build I2C interface support for the Avago
>> + APDS9960 gesture/RGB/ALS/proximity sensor.
>> +
>> + To compile this driver as a module, choose M here: the
>> + module will be called apds9960
>> +
>> config BH1750
>> tristate "ROHM BH1750 ambient light sensor"
>> depends on I2C
>> diff --git a/drivers/iio/light/Makefile b/drivers/iio/light/Makefile
>> index e2d50fd..0189ac7 100644
>> --- a/drivers/iio/light/Makefile
>> +++ b/drivers/iio/light/Makefile
>> @@ -7,6 +7,7 @@ obj-$(CONFIG_ACPI_ALS) += acpi-als.o
>> obj-$(CONFIG_ADJD_S311) += adjd_s311.o
>> obj-$(CONFIG_AL3320A) += al3320a.o
>> obj-$(CONFIG_APDS9300) += apds9300.o
>> +obj-$(CONFIG_APDS9960) += apds9960.o
>> obj-$(CONFIG_BH1750) += bh1750.o
>> obj-$(CONFIG_CM32181) += cm32181.o
>> obj-$(CONFIG_CM3232) += cm3232.o
>> diff --git a/drivers/iio/light/apds9960.c b/drivers/iio/light/apds9960.c
>> new file mode 100644
>> index 0000000..39de418
>> --- /dev/null
>> +++ b/drivers/iio/light/apds9960.c
>> @@ -0,0 +1,1208 @@
>> +/*
>> + * apds9960.c - Support for Avago APDS9960 gesture/RGB/ALS/proximity sensor
>> + *
>> + * Copyright (C) 2015 Matt Ranostay <mranostay@xxxxxxxxx>
>> + *
>> + * This program is free software; you can redistribute it and/or modify
>> + * it under the terms of the GNU General Public License as published by
>> + * the Free Software Foundation; either version 2 of the License, or
>> + * (at your option) any later version.
>> + *
>> + * This program is distributed in the hope that it will be useful,
>> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
>> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
>> + * GNU General Public License for more details.
>> + *
>> + * TODO: gesture + proximity calib offsets
>> + */
>> +
>> +#include <linux/module.h>
>> +#include <linux/init.h>
>> +#include <linux/interrupt.h>
>> +#include <linux/delay.h>
>> +#include <linux/mutex.h>
>> +#include <linux/err.h>
>> +#include <linux/irq.h>
>> +#include <linux/gpio.h>
>> +#include <linux/i2c.h>
>> +#include <linux/pm_runtime.h>
>> +#include <linux/regmap.h>
>> +#include <linux/iio/iio.h>
>> +#include <linux/iio/buffer.h>
>> +#include <linux/iio/events.h>
>> +#include <linux/iio/sysfs.h>
>> +#include <linux/iio/trigger.h>
>> +#include <linux/iio/trigger_consumer.h>
>> +#include <linux/iio/triggered_buffer.h>
>> +#include <linux/of_gpio.h>
>> +
>> +#define APDS9960_REGMAP_NAME "apds9960_regmap"
>> +#define APDS9960_DRV_NAME "apds9960"
>> +
>> +#define APDS9960_REG_RAM_START 0x00
>> +#define APDS9960_REG_RAM_END 0x7f
>> +
>> +#define APDS9960_REG_ENABLE 0x80
>> +#define APDS9960_REG_ENABLE_PON BIT(0)
>> +
>> +#define APDS9960_REG_ATIME 0x81
>> +#define APDS9960_REG_WTIME 0x83
>> +
>> +#define APDS9960_REG_AILTL 0x84
>> +#define APDS9960_REG_AILTH 0x85
>> +#define APDS9960_REG_AIHTL 0x86
>> +#define APDS9960_REG_AIHTH 0x87
>> +
>> +#define APDS9960_REG_PILT 0x89
>> +#define APDS9960_REG_PIHT 0x8b
>> +#define APDS9960_REG_PERS 0x8c
>> +
>> +#define APDS9960_REG_CONFIG_1 0x8d
>> +#define APDS9960_REG_PPULSE 0x8e
>> +
>> +#define APDS9960_REG_CONTROL 0x8f
>> +#define APDS9960_REG_CONTROL_AGAIN_MASK 0x03
>> +#define APDS9960_REG_CONTROL_PGAIN_MASK 0x0c
>> +#define APDS9960_REG_CONTROL_AGAIN_MASK_SHIFT 0
>> +#define APDS9960_REG_CONTROL_PGAIN_MASK_SHIFT 2
>> +
>> +#define APDS9960_REG_CONFIG_2 0x90
>> +#define APDS9960_REG_CONFIG_2_GGAIN_MASK 0x60
>> +#define APDS9960_REG_CONFIG_2_GGAIN_MASK_SHIFT 5
>> +
>> +#define APDS9960_REG_ID 0x92
>> +
>> +#define APDS9960_REG_STATUS 0x93
>> +#define APDS9960_REG_STATUS_PS_INT BIT(5)
>> +#define APDS9960_REG_STATUS_ALS_INT BIT(4)
>> +#define APDS9960_REG_STATUS_GINT BIT(2)
>> +
>> +#define APDS9960_REG_PDATA 0x9c
>> +#define APDS9960_REG_POFFSET_UR 0x9d
>> +#define APDS9960_REG_POFFSET_DL 0x9e
>> +#define APDS9960_REG_CONFIG_3 0x9f
>> +
>> +#define APDS9960_REG_GPENTH 0xa0
>> +#define APDS9960_REG_GEXTH 0xa1
>> +
>> +#define APDS9960_REG_GCONF_1 0xa2
>> +#define APDS9960_REG_GCONF_1_GFIFO_THRES_MASK 0xc0
>> +#define APDS9960_REG_GCONF_1_GFIFO_THRES_MASK_SHIFT 6
>> +
>> +#define APDS9960_REG_GCONF_2 0xa3
>> +#define APDS9960_REG_GOFFSET_U 0xa4
>> +#define APDS9960_REG_GOFFSET_D 0xa5
>> +#define APDS9960_REG_GPULSE 0xa6
>> +#define APDS9960_REG_GOFFSET_L 0xa7
>> +#define APDS9960_REG_GOFFSET_R 0xa9
>> +#define APDS9960_REG_GCONF_3 0xaa
>> +
>> +#define APDS9960_REG_GCONF_4 0xab
>> +#define APDS9960_REG_GFLVL 0xae
>> +#define APDS9960_REG_GSTATUS 0xaf
>> +
>> +#define APDS9960_REG_IFORCE 0xe4
>> +#define APDS9960_REG_PICLEAR 0xe5
>> +#define APDS9960_REG_CICLEAR 0xe6
>> +#define APDS9960_REG_AICLEAR 0xe7
>> +
>> +#define APDS9960_DEFAULT_PERS 0x33
>> +#define APDS9960_DEFAULT_GPENTH 0x50
>> +#define APDS9960_DEFAULT_GEXTH 0x40
>> +
>> +#define APDS9960_MAX_INT_TIME_IN_US 1000000
>> +
>> +enum apds9960_als_channel_idx {
>> + IDX_ALS_CLEAR, IDX_ALS_RED, IDX_ALS_GREEN, IDX_ALS_BLUE,
>> +};
>> +
>> +#define APDS9960_REG_ALS_BASE 0x94
>> +#define APDS9960_REG_ALS_CHANNEL(_colour) \
>> + (APDS9960_REG_ALS_BASE + (IDX_ALS_##_colour * 2))
>> +
>> +enum apds9960_gesture_channel_idx {
>> + IDX_DIR_UP, IDX_DIR_DOWN, IDX_DIR_LEFT, IDX_DIR_RIGHT,
>> +};
>> +
>> +#define APDS9960_REG_GFIFO_BASE 0xfc
>> +#define APDS9960_REG_GFIFO_DIR(_dir) \
>> + (APDS9960_REG_GFIFO_BASE + IDX_DIR_##_dir)
>> +
>> +struct apds9960_data {
>> + struct i2c_client *client;
>> + struct iio_trigger *trig;
>> + struct iio_dev *indio_dev;
>> + struct mutex lock;
>> +
>> + /* regmap fields */
>> + struct regmap *regmap;
>> + struct regmap_field *reg_int_als;
>> + struct regmap_field *reg_int_ges;
>> + struct regmap_field *reg_int_pxs;
>> +
>> + struct regmap_field *reg_enable_als;
>> + struct regmap_field *reg_enable_ges;
>> + struct regmap_field *reg_enable_pxs;
>> +
>> + /* state */
>> + int als_int;
>> + int pxs_int;
>> + int gesture_mode_running;
>> +
>> + /* gain values */
>> + int als_gain;
>> + int pxs_gain;
>> +
>> + /* integration time value in us */
>> + int als_adc_int_us;
>> +
>> + /* gesture buffer */
>> + u8 buffer[16]; /* 4 8-bit channels + 64-bit timestamp */
>> +};
>> +
>> +static const struct reg_default apds9960_reg_defaults[] = {
>> + { APDS9960_REG_ATIME, 0xff },
> Could you add some explantion of these.
Ok will do in v4
>> + { APDS9960_REG_WTIME, 0xff },
>> + { APDS9960_REG_CONFIG_1, 0x40 },
> Where it can be defined in terms of other various elements, please break
> them down. Particuarly true, when as with the above, the bit being set
> looks to be marked reserved but so are other bits in that register...
This is the POR defaults per the datasheet.
>
>> + { APDS9960_REG_CONFIG_2, 0x01 },
>> + { APDS9960_REG_PPULSE, 0x40 },
>> + { APDS9960_REG_GPULSE, 0x40 },
>> +};
>> +
>> +static const struct regmap_range apds9960_volatile_ranges[] = {
>> + regmap_reg_range(APDS9960_REG_STATUS,
>> + APDS9960_REG_PDATA),
>> + regmap_reg_range(APDS9960_REG_GFLVL,
>> + APDS9960_REG_GSTATUS),
>> + regmap_reg_range(APDS9960_REG_GFIFO_DIR(UP),
>> + APDS9960_REG_GFIFO_DIR(RIGHT)),
>> + regmap_reg_range(APDS9960_REG_IFORCE,
>> + APDS9960_REG_AICLEAR),
>> +};
>> +
>> +static const struct regmap_access_table apds9960_volatile_table = {
>> + .yes_ranges = apds9960_volatile_ranges,
>> + .n_yes_ranges = ARRAY_SIZE(apds9960_volatile_ranges),
>> +};
>> +
>> +static const struct regmap_range apds9960_precious_ranges[] = {
>> + regmap_reg_range(APDS9960_REG_RAM_START, APDS9960_REG_RAM_END),
>> +};
>> +
>> +static const struct regmap_access_table apds9960_precious_table = {
>> + .yes_ranges = apds9960_precious_ranges,
>> + .n_yes_ranges = ARRAY_SIZE(apds9960_precious_ranges),
>> +};
>> +
>> +static const struct regmap_range apds9960_readable_ranges[] = {
>> + regmap_reg_range(APDS9960_REG_ENABLE,
>> + APDS9960_REG_GSTATUS),
>> + regmap_reg_range(APDS9960_REG_GFIFO_DIR(UP),
>> + APDS9960_REG_GFIFO_DIR(RIGHT)),
>> +};
>> +
>> +static const struct regmap_access_table apds9960_readable_table = {
>> + .yes_ranges = apds9960_readable_ranges,
>> + .n_yes_ranges = ARRAY_SIZE(apds9960_readable_ranges),
>> +};
>> +
>> +static const struct regmap_range apds9960_writeable_ranges[] = {
>> + regmap_reg_range(APDS9960_REG_ENABLE, APDS9960_REG_CONFIG_2),
>> + regmap_reg_range(APDS9960_REG_POFFSET_UR, APDS9960_REG_GCONF_4),
>> + regmap_reg_range(APDS9960_REG_IFORCE, APDS9960_REG_AICLEAR),
>> +};
>> +
>> +static const struct regmap_access_table apds9960_writeable_table = {
>> + .yes_ranges = apds9960_writeable_ranges,
>> + .n_yes_ranges = ARRAY_SIZE(apds9960_writeable_ranges),
>> +};
>> +
>> +static const struct regmap_config apds9960_regmap_config = {
>> + .name = APDS9960_REGMAP_NAME,
>> + .reg_bits = 8,
>> + .val_bits = 8,
>> + .use_single_rw = 1,
>> +
>> + .volatile_table = &apds9960_volatile_table,
>> + .precious_table = &apds9960_precious_table,
>> + .rd_table = &apds9960_readable_table,
>> + .wr_table = &apds9960_writeable_table,
>> +
>> + .reg_defaults = apds9960_reg_defaults,
>> + .num_reg_defaults = ARRAY_SIZE(apds9960_reg_defaults),
>> + .max_register = APDS9960_REG_GFIFO_DIR(RIGHT),
>> + .cache_type = REGCACHE_RBTREE,
>> +};
>> +
>> +static const struct iio_event_spec apds9960_pxs_event_spec[] = {
>> + {
>> + .type = IIO_EV_TYPE_THRESH,
>> + .dir = IIO_EV_DIR_RISING,
>> + .mask_separate = BIT(IIO_EV_INFO_VALUE) |
>> + BIT(IIO_EV_INFO_ENABLE),
>> + },
>> + {
>> + .type = IIO_EV_TYPE_THRESH,
>> + .dir = IIO_EV_DIR_FALLING,
>> + .mask_separate = BIT(IIO_EV_INFO_VALUE) |
>> + BIT(IIO_EV_INFO_ENABLE),
>> + },
>> +};
>> +
>> +static const struct iio_event_spec apds9960_als_event_spec[] = {
>> + {
>> + .type = IIO_EV_TYPE_THRESH,
>> + .dir = IIO_EV_DIR_RISING,
>> + .mask_separate = BIT(IIO_EV_INFO_VALUE) |
>> + BIT(IIO_EV_INFO_ENABLE),
>> + },
>> + {
>> + .type = IIO_EV_TYPE_THRESH,
>> + .dir = IIO_EV_DIR_FALLING,
>> + .mask_separate = BIT(IIO_EV_INFO_VALUE) |
>> + BIT(IIO_EV_INFO_ENABLE),
>> + },
>> +};
>> +
>> +#define APDS9960_GESTURE_CHANNEL(_dir, _si) { \
>> + .type = IIO_PROXIMITY, \
>> + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
>> + .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \
>> + .address = APDS9960_REG_GFIFO_DIR(_dir), \
>> + .channel = _si + 1, \
>> + .scan_index = _si, \
>> + .indexed = 1, \
>> + .scan_type = { \
>> + .sign = 'u', \
>> + .realbits = 8, \
>> + .storagebits = 8, \
>> + }, \
>> +}
>> +
>> +#define APDS9960_INTENSITY_CHANNEL(_colour) { \
>> + .type = IIO_INTENSITY, \
>> + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
>> + .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
>> + BIT(IIO_CHAN_INFO_INT_TIME), \
>> + .channel2 = IIO_MOD_LIGHT_##_colour, \
>> + .address = APDS9960_REG_ALS_CHANNEL(_colour), \
>> + .modified = 1, \
>> + .scan_index = -1, \
>> +}
>> +
>> +static const struct iio_chan_spec apds9960_channels[] = {
> Interesting approach. Guess it doesn't make sense to push the normal
> proximity / als through the buffer..
Also when in gesture mode the ALS + pxs sensor is disabled till it exits
>> + {
>> + .type = IIO_PROXIMITY,
>> + .address = APDS9960_REG_PDATA,
>> + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
>> + .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE),
>> + .channel = 0,
>> + .indexed = 1,
>> + .scan_index = -1,
>> +
>> + .event_spec = apds9960_pxs_event_spec,
>> + .num_event_specs = ARRAY_SIZE(apds9960_pxs_event_spec),
>> + },
>> + /* Gesture Sensor */
>> + APDS9960_GESTURE_CHANNEL(UP, 0),
>> + APDS9960_GESTURE_CHANNEL(DOWN, 1),
>> + APDS9960_GESTURE_CHANNEL(LEFT, 2),
>> + APDS9960_GESTURE_CHANNEL(RIGHT, 3),
>> + IIO_CHAN_SOFT_TIMESTAMP(4),
>> + /* ALS */
>> + {
>> + .type = IIO_INTENSITY,
>> + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
>> + .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) |
>> + BIT(IIO_CHAN_INFO_INT_TIME),
>> + .channel2 = IIO_MOD_LIGHT_CLEAR,
>> + .address = APDS9960_REG_ALS_CHANNEL(CLEAR),
>> + .modified = 1,
>> + .scan_index = -1,
>> +
>> + .event_spec = apds9960_als_event_spec,
>> + .num_event_specs = ARRAY_SIZE(apds9960_als_event_spec),
>> + },
>> + /* RGB Sensor */
>> + APDS9960_INTENSITY_CHANNEL(RED),
>> + APDS9960_INTENSITY_CHANNEL(GREEN),
>> + APDS9960_INTENSITY_CHANNEL(BLUE),
>> +};
>> +
>> +/* integration time in us */
>> +static const int apds9960_int_time[][2] =
>> + { {28000, 246}, {100000, 219}, {200000, 182}, {700000, 0} };
>> +
>> +/* gain mapping */
>> +static const int apds9960_pxs_gain_map[] = {1, 2, 4, 8};
>> +static const int apds9960_als_gain_map[] = {1, 4, 16, 64};
>> +
>> +static IIO_CONST_ATTR(proximity_scale_available, "1 2 4 8");
>> +static IIO_CONST_ATTR(intensity_scale_available, "1 4 16 64");
>> +static IIO_CONST_ATTR_INT_TIME_AVAIL("0.028 0.1 0.2 0.7");
>> +
>> +static struct attribute *apds9960_attributes[] = {
>> + &iio_const_attr_proximity_scale_available.dev_attr.attr,
>> + &iio_const_attr_intensity_scale_available.dev_attr.attr,
>> + &iio_const_attr_integration_time_available.dev_attr.attr,
>> + NULL,
>> +};
>> +
>> +static struct attribute_group apds9960_attribute_group = {
>> + .attrs = apds9960_attributes,
>> +};
>> +
>> +
>> +static const struct reg_field reg_field_int_als =
>> + REG_FIELD(APDS9960_REG_ENABLE, 4, 4);
>> +
>> +static const struct reg_field reg_field_int_ges =
>> + REG_FIELD(APDS9960_REG_GCONF_4, 1, 1);
>> +
>> +static const struct reg_field reg_field_int_pxs =
>> + REG_FIELD(APDS9960_REG_ENABLE, 5, 5);
>> +
>> +static const struct reg_field reg_field_enable_als =
>> + REG_FIELD(APDS9960_REG_ENABLE, 1, 1);
>> +
>> +static const struct reg_field reg_field_enable_ges =
>> + REG_FIELD(APDS9960_REG_ENABLE, 6, 6);
>> +
> Ideally all of these would have an apds9960 prefix.
>> +static const struct reg_field reg_field_enable_pxs =
>> + REG_FIELD(APDS9960_REG_ENABLE, 2, 2);
>> +
>> +static int apds9960_set_it_time(struct apds9960_data *data, int val2)
>> +{
>> + int ret = -EINVAL;
>> + int idx;
>> +
>> + for (idx = 0; idx < ARRAY_SIZE(apds9960_int_time); idx++) {
>> + if (apds9960_int_time[idx][0] == val2) {
>> + mutex_lock(&data->lock);
>> + ret = regmap_write(data->regmap, APDS9960_REG_ATIME,
>> + apds9960_int_time[idx][1]);
>> + if (!ret)
>> + data->als_adc_int_us = val2;
>> + mutex_unlock(&data->lock);
>> + break;
>> + }
>> + }
>> +
>> + return ret;
>> +}
>> +
>> +static int apds9960_set_pxs_gain(struct apds9960_data *data, int val)
>> +{
>> + int ret = -EINVAL;
>> + int idx;
>> +
>> + for (idx = 0; idx < ARRAY_SIZE(apds9960_pxs_gain_map); idx++) {
>> + if (apds9960_pxs_gain_map[idx] == val) {
>> + /* pxs + gesture gains are mirrored */
>> + mutex_lock(&data->lock);
>> + ret = regmap_update_bits(data->regmap,
>> + APDS9960_REG_CONTROL,
>> + APDS9960_REG_CONTROL_PGAIN_MASK,
>> + idx << APDS9960_REG_CONTROL_PGAIN_MASK_SHIFT);
>> + if (ret) {
>> + mutex_unlock(&data->lock);
>> + break;
>> + }
>> +
>> + ret = regmap_update_bits(data->regmap,
>> + APDS9960_REG_CONFIG_2,
>> + APDS9960_REG_CONFIG_2_GGAIN_MASK,
>> + idx << APDS9960_REG_CONFIG_2_GGAIN_MASK_SHIFT);
>> + if (!ret)
>> + data->pxs_gain = idx;
>> + mutex_unlock(&data->lock);
>> + break;
>> + }
>> + }
>> +
>> + return ret;
>> +}
>> +
>> +static int apds9960_set_als_gain(struct apds9960_data *data, int val)
>> +{
>> + int ret = -EINVAL;
>> + int idx;
>> +
>> + for (idx = 0; idx < ARRAY_SIZE(apds9960_als_gain_map); idx++) {
>> + if (apds9960_als_gain_map[idx] == val) {
>> + mutex_lock(&data->lock);
>> + ret = regmap_update_bits(data->regmap,
>> + APDS9960_REG_CONTROL,
>> + APDS9960_REG_CONTROL_AGAIN_MASK, idx);
>> + if (!ret)
>> + data->als_gain = idx;
>> + mutex_unlock(&data->lock);
>> + break;
>> + }
>> + }
>> +
>> + return ret;
>> +}
>> +
>> +#ifdef CONFIG_PM
>> +static int apds9960_set_power_state(struct apds9960_data *data, bool on)
>> +{
>> + struct device *dev = &data->client->dev;
>> + int ret = 0;
>> +
>> + mutex_lock(&data->lock);
>> +
>> + if (on) {
>> + int suspended;
>> +
>> + suspended = pm_runtime_suspended(dev);
>> + ret = pm_runtime_get_sync(dev);
>> +
>> + /* Allow one integration cycle before allowing a reading */
>> + if (suspended)
>> + usleep_range(data->als_adc_int_us,
>> + APDS9960_MAX_INT_TIME_IN_US);
>> + } else {
>> + ret = pm_runtime_put_autosuspend(dev);
>> + }
>> +
>> + mutex_unlock(&data->lock);
>> +
>> + return ret;
>> +}
>> +#else
>> +static int apds9960_set_power_state(struct apds9960_data *data, bool on)
>> +{
>> + return 0;
>> +}
>> +#endif
>> +
>> +static int apds9960_read_raw(struct iio_dev *indio_dev,
>> + struct iio_chan_spec const *chan,
>> + int *val, int *val2, long mask)
>> +{
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> + u16 buf;
>> + int ret = -EINVAL;
>> +
>> + if (data->gesture_mode_running)
>> + return -EBUSY;
>> +
>> + switch (mask) {
>> + case IIO_CHAN_INFO_RAW:
>> + apds9960_set_power_state(data, true);
>> + switch (chan->type) {
>> + case IIO_PROXIMITY:
>> + if (chan->scan_index == -1) {
>> + ret = regmap_read(data->regmap,
>> + chan->address, val);
>> + if (!ret)
>> + ret = IIO_VAL_INT;
>> + } else {
> If the channels don't have explicity channel mask entries for a polled
> read then there will be no way of reading them anyway except through the
> buffered interface.
>> + /*
>> + * Cannot poll the GESTURE channels which are
>> + * just usable with triggered buffers.
>> + */
>> + ret = -EBUSY;
>> + }
>> + break;
>> + case IIO_INTENSITY:
>> + ret = regmap_bulk_read(data->regmap, chan->address,
>> + &buf, 2);
>> + if (!ret)
>> + ret = IIO_VAL_INT;
>> + *val = le16_to_cpu(buf);
>> + break;
>> + default:
>> + ret = -EINVAL;
>> + }
>> + apds9960_set_power_state(data, false);
>> + break;
>> + case IIO_CHAN_INFO_INT_TIME:
>> + /* RGB + ALS sensors only have int time */
>> + mutex_lock(&data->lock);
>> + switch (chan->type) {
>> + case IIO_INTENSITY:
>> + *val = 0;
>> + *val2 = data->als_adc_int_us;
>> + ret = IIO_VAL_INT_PLUS_MICRO;
>> + break;
>> + default:
>> + ret = -EINVAL;
>> + }
>> + mutex_unlock(&data->lock);
>> + break;
>> + case IIO_CHAN_INFO_SCALE:
>> + mutex_lock(&data->lock);
>> + switch (chan->type) {
>> + case IIO_PROXIMITY:
>> + *val = apds9960_pxs_gain_map[data->pxs_gain];
>> + ret = IIO_VAL_INT;
>> + break;
>> + case IIO_INTENSITY:
>> + *val = apds9960_als_gain_map[data->als_gain];
>> + ret = IIO_VAL_INT;
>> + break;
>> + default:
>> + ret = -EINVAL;
>> + }
>> + mutex_unlock(&data->lock);
>> + break;
>> + }
>> +
>> + return ret;
>> +};
>> +
>> +static int apds9960_write_raw(struct iio_dev *indio_dev,
>> + struct iio_chan_spec const *chan,
>> + int val, int val2, long mask)
>> +{
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> +
>> + switch (mask) {
>> + case IIO_CHAN_INFO_INT_TIME:
>> + /* RGB + ALS sensors only have int time */
>> + switch (chan->type) {
>> + case IIO_INTENSITY:
>> + if (val != 0)
>> + return -EINVAL;
>> + return apds9960_set_it_time(data, val2);
>> + default:
>> + return -EINVAL;
>> + }
>> + case IIO_CHAN_INFO_SCALE:
>> + if (val2 != 0)
>> + return -EINVAL;
>> + switch (chan->type) {
>> + case IIO_PROXIMITY:
>> + return apds9960_set_pxs_gain(data, val);
>> + case IIO_INTENSITY:
>> + return apds9960_set_als_gain(data, val);
>> + default:
>> + return -EINVAL;
>> + }
>> + default:
>> + return -EINVAL;
>> + };
>> +
>> + return 0;
>> +}
>> +
>> +static inline int apds9960_get_thres_reg(const struct iio_chan_spec *chan,
>> + enum iio_event_direction dir,
>> + u8 *reg)
>> +{
>> + switch (dir) {
>> + case IIO_EV_DIR_RISING:
>> + switch (chan->type) {
>> + case IIO_PROXIMITY:
>> + *reg = APDS9960_REG_PIHT;
>> + break;
>> + case IIO_INTENSITY:
>> + *reg = APDS9960_REG_AIHTL;
>> + break;
>> + default:
>> + return -EINVAL;
>> + }
>> + break;
>> + case IIO_EV_DIR_FALLING:
>> + switch (chan->type) {
>> + case IIO_PROXIMITY:
>> + *reg = APDS9960_REG_PILT;
>> + break;
>> + case IIO_INTENSITY:
>> + *reg = APDS9960_REG_AILTL;
>> + break;
>> + default:
>> + return -EINVAL;
>> + }
>> + break;
>> + default:
>> + return -EINVAL;
>> + }
>> +
>> + return 0;
>> +}
>> +
>> +static int apds9960_read_event(struct iio_dev *indio_dev,
>> + const struct iio_chan_spec *chan,
>> + enum iio_event_type type,
>> + enum iio_event_direction dir,
>> + enum iio_event_info info,
>> + int *val, int *val2)
>> +{
>> + u8 reg;
>> + u16 buf;
>> + int ret = 0;
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> +
>> + if (info != IIO_EV_INFO_VALUE)
>> + return -EINVAL;
>> +
>> + ret = apds9960_get_thres_reg(chan, dir, ®);
>> + if (ret < 0)
>> + return ret;
>> +
>> + if (chan->type == IIO_PROXIMITY) {
>> + ret = regmap_read(data->regmap, reg, val);
>> + if (ret < 0)
>> + return ret;
>> + } else if (chan->type == IIO_INTENSITY) {
>> + ret = regmap_bulk_read(data->regmap, reg, &buf, 2);
>> + if (ret < 0)
>> + return ret;
>> + *val = le16_to_cpu(buf);
>> + } else
>> + return -EINVAL;
>> +
>> + *val2 = 0;
> blank line.
>> + return IIO_VAL_INT;
>> +}
>> +
>> +static int apds9960_write_event(struct iio_dev *indio_dev,
>> + const struct iio_chan_spec *chan,
>> + enum iio_event_type type,
>> + enum iio_event_direction dir,
>> + enum iio_event_info info,
>> + int val, int val2)
>> +{
>> + u8 reg;
>> + u16 buf;
>> + int ret = 0;
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> +
>> + if (info != IIO_EV_INFO_VALUE)
>> + return -EINVAL;
>> +
>> + ret = apds9960_get_thres_reg(chan, dir, ®);
>> + if (ret < 0)
>> + return ret;
>> +
>> + if (chan->type == IIO_PROXIMITY) {
> Might be sensible to use #defines for the max limits in here.
>> + if (val > 255)
>> + return -EINVAL;
>> + ret = regmap_write(data->regmap, reg, val);
>> + if (ret < 0)
>> + return ret;
>> + } else if (chan->type == IIO_INTENSITY) {
>> + if (val > 0xFFFF)
>> + return -EINVAL;
>> + buf = cpu_to_le16(val);
>> + ret = regmap_bulk_write(data->regmap, reg, &buf, 2);
>> + if (ret < 0)
>> + return ret;
>> + } else
>> + return -EINVAL;
>> +
>> + return 0;
>> +}
>> +
>> +static int apds9960_read_event_config(struct iio_dev *indio_dev,
>> + const struct iio_chan_spec *chan,
>> + enum iio_event_type type,
>> + enum iio_event_direction dir)
>> +{
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> +
>> + switch (chan->type) {
>> + case IIO_PROXIMITY:
>> + return data->pxs_int;
>> + case IIO_INTENSITY:
>> + return data->als_int;
>> + default:
>> + return -EINVAL;
>> + }
>> +
>> + return 0;
>> +}
>> +
>> +static int apds9960_write_event_config(struct iio_dev *indio_dev,
>> + const struct iio_chan_spec *chan,
>> + enum iio_event_type type,
>> + enum iio_event_direction dir,
>> + int state)
>> +{
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> + int ret;
>> +
>> + state = !!state;
>> +
>> + switch (chan->type) {
>> + case IIO_PROXIMITY:
>> + if (data->pxs_int == state)
>> + return -EINVAL;
>> +
>> + ret = regmap_field_write(data->reg_int_pxs, state);
>> + if (ret)
>> + return ret;
>> + data->pxs_int = state;
>> + apds9960_set_power_state(data, state);
>> + break;
>> + case IIO_INTENSITY:
>> + if (data->als_int == state)
>> + return -EINVAL;
>> +
>> + ret = regmap_field_write(data->reg_int_als, state);
>> + if (ret)
>> + return ret;
>> + data->als_int = state;
>> + apds9960_set_power_state(data, state);
>> + break;
>> + default:
>> + return -EINVAL;
>> + }
>> +
>> + return 0;
>> +}
>> +
>> +static const struct iio_info apds9960_info = {
>> + .driver_module = THIS_MODULE,
>> + .attrs = &apds9960_attribute_group,
>> + .read_raw = apds9960_read_raw,
>> + .write_raw = apds9960_write_raw,
>> + .read_event_value = apds9960_read_event,
>> + .write_event_value = apds9960_write_event,
>> + .read_event_config = apds9960_read_event_config,
>> + .write_event_config = apds9960_write_event_config,
>> +
>> +};
>> +
>> +static irqreturn_t apds9960_interrupt_handler(int irq, void *private)
>> +{
>> + struct iio_dev *indio_dev = private;
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> + int ret, status;
>> +
>> + ret = regmap_read(data->regmap, APDS9960_REG_STATUS, &status);
>> + if (ret < 0) {
>> + dev_err(&data->client->dev, "irq status reg read failed\n");
>> + return IRQ_HANDLED;
>> + }
>> +
>> + if ((status & APDS9960_REG_STATUS_ALS_INT) && data->als_int) {
>> + iio_push_event(indio_dev,
>> + IIO_UNMOD_EVENT_CODE(IIO_INTENSITY, 0,
>> + IIO_EV_TYPE_THRESH,
>> + IIO_EV_DIR_EITHER),
>> + iio_get_time_ns());
>> + }
>> +
>> + if ((status & APDS9960_REG_STATUS_PS_INT) && data->pxs_int) {
>> + iio_push_event(indio_dev,
>> + IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY, 0,
>> + IIO_EV_TYPE_THRESH,
>> + IIO_EV_DIR_EITHER),
>> + iio_get_time_ns());
>> + }
>> +
>> + if (status & APDS9960_REG_STATUS_GINT)
>> + iio_trigger_poll_chained(data->trig);
>
> Using the chained form restricts (more or less) using this trigger to
> driver any other sensors. Perhaps fine for now, but we may want to
> do the more complex approach to fire on a real interrupt later.
Issue with a real interrupt is the FIFO reads take too long to
complete (32 * 4 buffer with 32 i2c reads).. have to offload to
threads for now.
>
>> +
>> + regmap_write(data->regmap, APDS9960_REG_AICLEAR, 1);
> Might be ideal to clear the als and prox interrupts separately as in theory
> you have a race condition here where you are clearing an interrupt you
> haven't necessarily seen (between the status read and the clear).
Noted.
>> +
>> + return IRQ_HANDLED;
>> +}
>> +
>> +static inline int apds9660_fifo_is_empty(struct apds9960_data *data)
>> +{
>> + int cnt;
>> + int ret;
>> +
>> + ret = regmap_read(data->regmap, APDS9960_REG_GFLVL, &cnt);
>> + if (ret)
>> + return ret;
> blank line here.
>> + return cnt;
>> +}
>> +
>> +static irqreturn_t apds9960_trigger_handler(int irq, void *private)
>> +{
>> + struct iio_poll_func *pf = private;
>> + struct iio_dev *indio_dev = pf->indio_dev;
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> + u8 buffer[4];
>> + int ret;
>> +
>> + mutex_lock(&data->lock);
>> + data->gesture_mode_running = 1;
>> +
>> + while (apds9660_fifo_is_empty(data) > 0) {
>> + int i, j = 0;
>> +
>> + memset(&data->buffer, 0, sizeof(data->buffer));
> Why bother zeroing out? You are going to fill it anyway below. (or is there
> a risk of leaking info if the below fails? Don't think so.
>> +
>> + ret = regmap_bulk_read(data->regmap,
>> + APDS9960_REG_GFIFO_BASE, &buffer, 4);
>> + if (ret)
>> + goto err_read;
>> +
>> + /*
>> + * Even if we don't care about scan_index channels we need to
>> + * read them to clear the FIFO.
>> + */
>> + for_each_set_bit(i, indio_dev->active_scan_mask,
>> + indio_dev->masklength) {
>> + data->buffer[j++] = buffer[i];
>> + }
>
> Don't need brackets around the above. Also, why not read directly into the
> data->buffer and drop the copy? If you have to read them anyway use
> the scan_masks_available to specify all channels are enabled together then
> let the in core demux logic handle dropping unwanted channels.
> Never any need to do this in driver any more.
>
> Or for that mater just use the lcoal buffer and don't bother with the one
> in data.
>
>> + iio_push_to_buffers_with_timestamp(indio_dev, data->buffer,
>> + iio_get_time_ns());
>> + }
>> +
>> +err_read:
>> + data->gesture_mode_running = 0;
>> + mutex_unlock(&data->lock);
>> + iio_trigger_notify_done(indio_dev->trig);
>> +
>> + return IRQ_HANDLED;
>> +}
>> +
>> +static const struct iio_trigger_ops iio_interrupt_trigger_ops = {
>> + .owner = THIS_MODULE,
>> +};
>> +
>> +static int apds9960_set_powermode(struct apds9960_data *data, bool state)
>> +{
>> + int ret;
>> +
>> + ret = regmap_update_bits(data->regmap, APDS9960_REG_ENABLE,
>> + APDS9960_REG_ENABLE_PON, state);
>> + if (ret)
>> + return ret;
> return directly. Given only false value is 0 it'll be the same and 6 lines
> shorter.
Got it.
>> +
>> + return 0;
>> +}
>> +
>> +static int apds9960_buffer_preenable(struct iio_dev *indio_dev)
>> +{
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> + int ret;
>> +
>> + ret = regmap_field_write(data->reg_int_ges, 1);
>> + if (ret)
>> + return ret;
>> +
>> + ret = regmap_field_write(data->reg_enable_ges, 1);
>> + if (ret)
>> + return ret;
>> +
>> + pm_runtime_get_sync(&data->client->dev);
>> +
>> + return 0;
>> +}
>> +
>> +static int apds9960_buffer_postdisable(struct iio_dev *indio_dev)
>> +{
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> + int ret;
>> +
>> + ret = regmap_field_write(data->reg_enable_ges, 0);
>> + if (ret)
>> + return ret;
>> +
>> + ret = regmap_field_write(data->reg_int_ges, 0);
>> + if (ret)
>> + return ret;
>> +
>> + pm_runtime_put_autosuspend(&data->client->dev);
>> +
>> + return 0;
>> +}
>> +
>> +static const struct iio_buffer_setup_ops apds9960_buffer_setup_ops = {
>> + .preenable = apds9960_buffer_preenable,
>> + .postenable = iio_triggered_buffer_postenable,
>> + .predisable = iio_triggered_buffer_predisable,
>> + .postdisable = apds9960_buffer_postdisable,
>> +};
>> +
>> +static int apds9960_regfield_init(struct apds9960_data *data)
>> +{
>> + struct device *dev = &data->client->dev;
>> + struct regmap *regmap = data->regmap;
>> +
> This feels like a rather long function for what it is doing.
> Worth trying to do these with an enum indexed array? Might not
> be worthwhile.
I agree this is a bit long, but any better way to alloc all the regmap
bitfields?
>> + data->reg_int_als =
>> + devm_regmap_field_alloc(dev, regmap, reg_field_int_als);
>> + if (IS_ERR(data->reg_int_als)) {
>> + dev_err(dev, "INT ALS reg field init failed\n");
>> + return PTR_ERR(data->reg_int_als);
>> + }
>> +
>> + data->reg_int_ges =
>> + devm_regmap_field_alloc(dev, regmap, reg_field_int_ges);
>> + if (IS_ERR(data->reg_int_ges)) {
>> + dev_err(dev, "INT gesture reg field init failed\n");
>> + return PTR_ERR(data->reg_int_ges);
>> + }
>> +
>> + data->reg_int_pxs =
>> + devm_regmap_field_alloc(dev, regmap, reg_field_int_pxs);
>> + if (IS_ERR(data->reg_int_pxs)) {
>> + dev_err(dev, "INT pxs reg field init failed\n");
>> + return PTR_ERR(data->reg_int_pxs);
>> + }
>> +
>> + data->reg_enable_als =
>> + devm_regmap_field_alloc(dev, regmap, reg_field_enable_als);
>> + if (IS_ERR(data->reg_enable_als)) {
>> + dev_err(dev, "Enable ALS reg field init failed\n");
>> + return PTR_ERR(data->reg_enable_als);
>> + }
>> +
>> + data->reg_enable_ges =
>> + devm_regmap_field_alloc(dev, regmap, reg_field_enable_ges);
>> + if (IS_ERR(data->reg_enable_ges)) {
>> + dev_err(dev, "Enable gesture reg field init failed\n");
>> + return PTR_ERR(data->reg_enable_ges);
>> + }
>> +
>> + data->reg_enable_pxs =
>> + devm_regmap_field_alloc(dev, regmap, reg_field_enable_pxs);
>> + if (IS_ERR(data->reg_enable_pxs)) {
>> + dev_err(dev, "Enable PXS reg field init failed\n");
>> + return PTR_ERR(data->reg_enable_pxs);
>> + }
>> +
>> + return 0;
>> +}
>> +
>> +static int apds9960_chip_init(struct apds9960_data *data)
>> +{
>> + int ret;
>> +
>> + /* Default IT for ALS of 28 ms */
>> + ret = apds9960_set_it_time(data, 28000);
>> + if (ret)
>> + return ret;
>> +
>> + /* Ensure gesture interrupt is OFF */
>> + ret = regmap_field_write(data->reg_int_ges, 0);
>> + if (ret)
>> + return ret;
>> +
>> + /* Disable gesture sensor, since polling is useless from user-space */
>> + ret = regmap_field_write(data->reg_enable_ges, 0);
>> + if (ret)
>> + return ret;
>> +
>> + /* Ensure proximity interrupt is OFF */
>> + ret = regmap_field_write(data->reg_int_pxs, 0);
>> + if (ret)
>> + return ret;
>> +
>> + /* Enable proximity sensor for polling */
>> + ret = regmap_field_write(data->reg_enable_pxs, 1);
>> + if (ret)
>> + return ret;
>> +
>> + /* Ensure ALS interrupt is OFF */
>> + ret = regmap_field_write(data->reg_int_als, 0);
>> + if (ret)
>> + return ret;
>> +
>> + /* Enable ALS sensor for polling */
>> + ret = regmap_field_write(data->reg_enable_als, 1);
>> + if (ret)
>> + return ret;
>> + /*
>> + * When enabled trigger and interrupt after 3 readings
>> + * outside threshold for ALS + PXS
>> + */
>> + ret = regmap_write(data->regmap, APDS9960_REG_PERS,
>> + APDS9960_DEFAULT_PERS);
>> + if (ret)
>> + return ret;
>> +
>> + /*
>> + * Wait for 4 event outside gesture threshold to prevent interrupt
>> + * flooding.
> Strikes me that this will want to be configurable in the long run.
Yes for sure but however this requires to disable the function and
re-enable it. But like wtime this is something to plan for the future.
>> + */
>> + ret = regmap_update_bits(data->regmap, APDS9960_REG_GCONF_1,
>> + APDS9960_REG_GCONF_1_GFIFO_THRES_MASK,
>> + BIT(0) << APDS9960_REG_GCONF_1_GFIFO_THRES_MASK_SHIFT);
>> + if (ret)
>> + return ret;
>> +
>> + /*
>> + * Default ENTER and EXIT thresholds for the GESTURE engine.
>> + */
>> + ret = regmap_write(data->regmap, APDS9960_REG_GPENTH,
>> + APDS9960_DEFAULT_GPENTH);
>> + if (ret)
>> + return ret;
>> +
>> + ret = regmap_write(data->regmap, APDS9960_REG_GEXTH,
>> + APDS9960_DEFAULT_GEXTH);
>> + if (ret)
>> + return ret;
>> +
>> + ret = apds9960_set_powermode(data, 1);
>> + if (ret)
>> + return ret;
>> +
>> + return 0;
>> +}
>> +
>> +static int apds9960_probe(struct i2c_client *client,
>> + const struct i2c_device_id *id)
>> +{
>> + struct apds9960_data *data;
>> + struct iio_dev *indio_dev;
>> + struct iio_trigger *trig;
>> + int ret;
>> +
>> + indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
>> + if (!indio_dev)
>> + return -ENOMEM;
>> +
>> + indio_dev->info = &apds9960_info;
>> + indio_dev->name = APDS9960_DRV_NAME;
>> + indio_dev->channels = apds9960_channels;
>> + indio_dev->num_channels = ARRAY_SIZE(apds9960_channels);
>> + indio_dev->modes = INDIO_DIRECT_MODE;
>> +
>> + trig = devm_iio_trigger_alloc(&client->dev, "%s-gesture%d",
>> + indio_dev->name, indio_dev->id);
>> + if (!trig)
>> + return -ENOMEM;
>> +
>> + data = iio_priv(indio_dev);
>> + i2c_set_clientdata(client, indio_dev);
>> +
>> + data->regmap = devm_regmap_init_i2c(client, &apds9960_regmap_config);
>> + if (IS_ERR(data->regmap)) {
>> + dev_err(&client->dev, "regmap initialization failed.\n");
>> + return PTR_ERR(data->regmap);
>> + }
>> +
>> + data->client = client;
>> + data->trig = trig;
>> + data->indio_dev = indio_dev;
>> + trig->dev.parent = indio_dev->dev.parent;
>> + trig->ops = &iio_interrupt_trigger_ops;
>> +
>> + mutex_init(&data->lock);
>> + iio_trigger_set_drvdata(trig, indio_dev);
>> +
>> + ret = pm_runtime_set_active(&client->dev);
>> + if (ret)
>> + return ret;
>> +
>> + pm_runtime_enable(&client->dev);
>> + pm_runtime_set_autosuspend_delay(&client->dev, 5000);
>> + pm_runtime_use_autosuspend(&client->dev);
>> +
>> + apds9960_set_power_state(data, true);
>> +
>> + ret = iio_trigger_register(trig);
>> + if (ret) {
>> + dev_err(&client->dev, "failed to register trigger\n");
>> + return ret;
>> + }
>> +
>> + ret = iio_triggered_buffer_setup(indio_dev, NULL,
>> + apds9960_trigger_handler,
>> + &apds9960_buffer_setup_ops);
>> + if (ret)
>> + goto error_unreg_trigger;
>> +
>> + ret = iio_device_register(indio_dev);
>> + if (ret)
>> + goto error_unreg_buffer;
> Normally the iio_device_register is the last thing done. This is
> because it is responsible for exposing userspace interfaces. Is there
> any reason it is done so early in this driver? Also you don't
> unwind it if you get errors on the next few functions.
>
>> +
>> + ret = apds9960_regfield_init(data);
>> + if (ret)
>> + goto error_unreg_buffer;
>> +
>> + ret = apds9960_chip_init(data);
>> + if (ret)
>> + goto error_unreg_buffer;
>> +
>> + if (client->irq > 0) {
>> + ret = devm_request_threaded_irq(&client->dev, client->irq,
>> + NULL, apds9960_interrupt_handler,
>> + IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
>> + "apds9960_event",
>> + indio_dev);
>> + if (ret) {
>> + dev_err(&client->dev, "request irq (%d) failed\n",
>> + client->irq);
>> + goto error_unreg_buffer;
>> + }
>> + } else {
> I'd flip the logic here and handle the failure case first. Kind of the
> conventional way of doing it and reduces indentation on the 'normal' path.
> (i.e. if (client->irq <= 0) { this bit } then carry on with the knowledge
> that your irq number is good).
>
>> + dev_err(&client->dev, "no valid irq defined\n");
>> + ret = -EINVAL;
>> + goto error_unreg_buffer;
>> + }
>> +
>> + apds9960_set_power_state(data, false);
> nit pick. Blank line here please.
>> + return 0;
>> +
>> +error_unreg_buffer:
>> + iio_triggered_buffer_cleanup(indio_dev);
>> +
>> +error_unreg_trigger:
>> + iio_trigger_unregister(data->trig);
>> + apds9960_set_power_state(data, false);
>> +
>> + return ret;
>> +}
>> +
>> +static int apds9960_remove(struct i2c_client *client)
>> +{
>> + struct iio_dev *indio_dev = i2c_get_clientdata(client);
>> + struct apds9960_data *data = iio_priv(indio_dev);
>> +
>> + iio_device_unregister(indio_dev);
>> + iio_triggered_buffer_cleanup(indio_dev);
>> + iio_trigger_unregister(data->trig);
>> +
>> + pm_runtime_disable(&client->dev);
>> + pm_runtime_set_suspended(&client->dev);
>> + apds9960_set_powermode(data, 0);
>> +
>> + return 0;
>> +}
>> +
>> +#ifdef CONFIG_PM
>> +static int apds9960_runtime_suspend(struct device *dev)
>> +{
>> + struct apds9960_data *data =
>> + iio_priv(i2c_get_clientdata(to_i2c_client(dev)));
>> +
>> + return apds9960_set_powermode(data, 0);
>> +}
>> +
>> +static int apds9960_runtime_resume(struct device *dev)
>> +{
>> + struct apds9960_data *data =
>> + iio_priv(i2c_get_clientdata(to_i2c_client(dev)));
>> +
>> + return apds9960_set_powermode(data, 1);
>> +}
>> +#endif
>> +
>> +static const struct dev_pm_ops apds9960_pm_ops = {
>> + SET_RUNTIME_PM_OPS(apds9960_runtime_suspend,
>> + apds9960_runtime_resume, NULL)
>> +};
>> +
>> +static const struct i2c_device_id apds9960_id[] = {
>> + { "apds9960", 0 },
>> + {}
>> +};
>> +MODULE_DEVICE_TABLE(i2c, apds9960_id);
>> +
>> +static struct i2c_driver apds9960_driver = {
>> + .driver = {
>> + .name = APDS9960_DRV_NAME,
>> + .pm = &apds9960_pm_ops,
>> + .owner = THIS_MODULE,
>> + },
>> + .probe = apds9960_probe,
>> + .remove = apds9960_remove,
>> + .id_table = apds9960_id,
>> +};
>> +module_i2c_driver(apds9960_driver);
>> +
>> +MODULE_AUTHOR("Matt Ranostay <mranostay@xxxxxxxxx>");
>> +MODULE_DESCRIPTION("ADPS9960 Gesture/RGB/ALS/Proximity sensor");
>> +MODULE_LICENSE("GPL");
>>
>
--
To unsubscribe from this list: send the line "unsubscribe devicetree" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
