mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
987 lines
22 KiB
987 lines
22 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
/* |
|
* Copyright (c) 2015 Intel Corporation |
|
* |
|
* Driver for UPISEMI us5182d Proximity and Ambient Light Sensor. |
|
* |
|
* To do: Interrupt support. |
|
*/ |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/module.h> |
|
#include <linux/acpi.h> |
|
#include <linux/delay.h> |
|
#include <linux/i2c.h> |
|
#include <linux/iio/events.h> |
|
#include <linux/iio/iio.h> |
|
#include <linux/interrupt.h> |
|
#include <linux/irq.h> |
|
#include <linux/iio/sysfs.h> |
|
#include <linux/mutex.h> |
|
#include <linux/pm.h> |
|
#include <linux/pm_runtime.h> |
|
|
|
#define US5182D_REG_CFG0 0x00 |
|
#define US5182D_CFG0_ONESHOT_EN BIT(6) |
|
#define US5182D_CFG0_SHUTDOWN_EN BIT(7) |
|
#define US5182D_CFG0_WORD_ENABLE BIT(0) |
|
#define US5182D_CFG0_PROX BIT(3) |
|
#define US5182D_CFG0_PX_IRQ BIT(2) |
|
|
|
#define US5182D_REG_CFG1 0x01 |
|
#define US5182D_CFG1_ALS_RES16 BIT(4) |
|
#define US5182D_CFG1_AGAIN_DEFAULT 0x00 |
|
|
|
#define US5182D_REG_CFG2 0x02 |
|
#define US5182D_CFG2_PX_RES16 BIT(4) |
|
#define US5182D_CFG2_PXGAIN_DEFAULT BIT(2) |
|
|
|
#define US5182D_REG_CFG3 0x03 |
|
#define US5182D_CFG3_LED_CURRENT100 (BIT(4) | BIT(5)) |
|
#define US5182D_CFG3_INT_SOURCE_PX BIT(3) |
|
|
|
#define US5182D_REG_CFG4 0x10 |
|
|
|
/* |
|
* Registers for tuning the auto dark current cancelling feature. |
|
* DARK_TH(reg 0x27,0x28) - threshold (counts) for auto dark cancelling. |
|
* when ALS > DARK_TH --> ALS_Code = ALS - Upper(0x2A) * Dark |
|
* when ALS < DARK_TH --> ALS_Code = ALS - Lower(0x29) * Dark |
|
*/ |
|
#define US5182D_REG_UDARK_TH 0x27 |
|
#define US5182D_REG_DARK_AUTO_EN 0x2b |
|
#define US5182D_REG_AUTO_LDARK_GAIN 0x29 |
|
#define US5182D_REG_AUTO_HDARK_GAIN 0x2a |
|
|
|
/* Thresholds for events: px low (0x08-l, 0x09-h), px high (0x0a-l 0x0b-h) */ |
|
#define US5182D_REG_PXL_TH 0x08 |
|
#define US5182D_REG_PXH_TH 0x0a |
|
|
|
#define US5182D_REG_PXL_TH_DEFAULT 1000 |
|
#define US5182D_REG_PXH_TH_DEFAULT 30000 |
|
|
|
#define US5182D_OPMODE_ALS 0x01 |
|
#define US5182D_OPMODE_PX 0x02 |
|
#define US5182D_OPMODE_SHIFT 4 |
|
|
|
#define US5182D_REG_DARK_AUTO_EN_DEFAULT 0x80 |
|
#define US5182D_REG_AUTO_LDARK_GAIN_DEFAULT 0x16 |
|
#define US5182D_REG_AUTO_HDARK_GAIN_DEFAULT 0x00 |
|
|
|
#define US5182D_REG_ADL 0x0c |
|
#define US5182D_REG_PDL 0x0e |
|
|
|
#define US5182D_REG_MODE_STORE 0x21 |
|
#define US5182D_STORE_MODE 0x01 |
|
|
|
#define US5182D_REG_CHIPID 0xb2 |
|
|
|
#define US5182D_OPMODE_MASK GENMASK(5, 4) |
|
#define US5182D_AGAIN_MASK 0x07 |
|
#define US5182D_RESET_CHIP 0x01 |
|
|
|
#define US5182D_CHIPID 0x26 |
|
#define US5182D_DRV_NAME "us5182d" |
|
|
|
#define US5182D_GA_RESOLUTION 1000 |
|
|
|
#define US5182D_READ_BYTE 1 |
|
#define US5182D_READ_WORD 2 |
|
#define US5182D_OPSTORE_SLEEP_TIME 20 /* ms */ |
|
#define US5182D_SLEEP_MS 3000 /* ms */ |
|
#define US5182D_PXH_TH_DISABLE 0xffff |
|
#define US5182D_PXL_TH_DISABLE 0x0000 |
|
|
|
/* Available ranges: [12354, 7065, 3998, 2202, 1285, 498, 256, 138] lux */ |
|
static const int us5182d_scales[] = {188500, 107800, 61000, 33600, 19600, 7600, |
|
3900, 2100}; |
|
|
|
/* |
|
* Experimental thresholds that work with US5182D sensor on evaluation board |
|
* roughly between 12-32 lux |
|
*/ |
|
static u16 us5182d_dark_ths_vals[] = {170, 200, 512, 512, 800, 2000, 4000, |
|
8000}; |
|
|
|
enum mode { |
|
US5182D_ALS_PX, |
|
US5182D_ALS_ONLY, |
|
US5182D_PX_ONLY |
|
}; |
|
|
|
enum pmode { |
|
US5182D_CONTINUOUS, |
|
US5182D_ONESHOT |
|
}; |
|
|
|
struct us5182d_data { |
|
struct i2c_client *client; |
|
struct mutex lock; |
|
|
|
/* Glass attenuation factor */ |
|
u32 ga; |
|
|
|
/* Dark gain tuning */ |
|
u8 lower_dark_gain; |
|
u8 upper_dark_gain; |
|
u16 *us5182d_dark_ths; |
|
|
|
u16 px_low_th; |
|
u16 px_high_th; |
|
|
|
int rising_en; |
|
int falling_en; |
|
|
|
u8 opmode; |
|
u8 power_mode; |
|
|
|
bool als_enabled; |
|
bool px_enabled; |
|
|
|
bool default_continuous; |
|
}; |
|
|
|
static IIO_CONST_ATTR(in_illuminance_scale_available, |
|
"0.0021 0.0039 0.0076 0.0196 0.0336 0.061 0.1078 0.1885"); |
|
|
|
static struct attribute *us5182d_attrs[] = { |
|
&iio_const_attr_in_illuminance_scale_available.dev_attr.attr, |
|
NULL |
|
}; |
|
|
|
static const struct attribute_group us5182d_attr_group = { |
|
.attrs = us5182d_attrs, |
|
}; |
|
|
|
static const struct { |
|
u8 reg; |
|
u8 val; |
|
} us5182d_regvals[] = { |
|
{US5182D_REG_CFG0, US5182D_CFG0_WORD_ENABLE}, |
|
{US5182D_REG_CFG1, US5182D_CFG1_ALS_RES16}, |
|
{US5182D_REG_CFG2, (US5182D_CFG2_PX_RES16 | |
|
US5182D_CFG2_PXGAIN_DEFAULT)}, |
|
{US5182D_REG_CFG3, US5182D_CFG3_LED_CURRENT100 | |
|
US5182D_CFG3_INT_SOURCE_PX}, |
|
{US5182D_REG_CFG4, 0x00}, |
|
}; |
|
|
|
static const struct iio_event_spec us5182d_events[] = { |
|
{ |
|
.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_chan_spec us5182d_channels[] = { |
|
{ |
|
.type = IIO_LIGHT, |
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | |
|
BIT(IIO_CHAN_INFO_SCALE), |
|
}, |
|
{ |
|
.type = IIO_PROXIMITY, |
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW), |
|
.event_spec = us5182d_events, |
|
.num_event_specs = ARRAY_SIZE(us5182d_events), |
|
} |
|
}; |
|
|
|
static int us5182d_oneshot_en(struct us5182d_data *data) |
|
{ |
|
int ret; |
|
|
|
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG0); |
|
if (ret < 0) |
|
return ret; |
|
|
|
/* |
|
* In oneshot mode the chip will power itself down after taking the |
|
* required measurement. |
|
*/ |
|
ret = ret | US5182D_CFG0_ONESHOT_EN; |
|
|
|
return i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG0, ret); |
|
} |
|
|
|
static int us5182d_set_opmode(struct us5182d_data *data, u8 mode) |
|
{ |
|
int ret; |
|
|
|
if (mode == data->opmode) |
|
return 0; |
|
|
|
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG0); |
|
if (ret < 0) |
|
return ret; |
|
|
|
/* update mode */ |
|
ret = ret & ~US5182D_OPMODE_MASK; |
|
ret = ret | (mode << US5182D_OPMODE_SHIFT); |
|
|
|
/* |
|
* After updating the operating mode, the chip requires that |
|
* the operation is stored, by writing 1 in the STORE_MODE |
|
* register (auto-clearing). |
|
*/ |
|
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG0, ret); |
|
if (ret < 0) |
|
return ret; |
|
|
|
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_MODE_STORE, |
|
US5182D_STORE_MODE); |
|
if (ret < 0) |
|
return ret; |
|
|
|
data->opmode = mode; |
|
msleep(US5182D_OPSTORE_SLEEP_TIME); |
|
|
|
return 0; |
|
} |
|
|
|
static int us5182d_als_enable(struct us5182d_data *data) |
|
{ |
|
int ret; |
|
u8 mode; |
|
|
|
if (data->power_mode == US5182D_ONESHOT) { |
|
ret = us5182d_set_opmode(data, US5182D_ALS_ONLY); |
|
if (ret < 0) |
|
return ret; |
|
data->px_enabled = false; |
|
} |
|
|
|
if (data->als_enabled) |
|
return 0; |
|
|
|
mode = data->px_enabled ? US5182D_ALS_PX : US5182D_ALS_ONLY; |
|
|
|
ret = us5182d_set_opmode(data, mode); |
|
if (ret < 0) |
|
return ret; |
|
|
|
data->als_enabled = true; |
|
|
|
return 0; |
|
} |
|
|
|
static int us5182d_px_enable(struct us5182d_data *data) |
|
{ |
|
int ret; |
|
u8 mode; |
|
|
|
if (data->power_mode == US5182D_ONESHOT) { |
|
ret = us5182d_set_opmode(data, US5182D_PX_ONLY); |
|
if (ret < 0) |
|
return ret; |
|
data->als_enabled = false; |
|
} |
|
|
|
if (data->px_enabled) |
|
return 0; |
|
|
|
mode = data->als_enabled ? US5182D_ALS_PX : US5182D_PX_ONLY; |
|
|
|
ret = us5182d_set_opmode(data, mode); |
|
if (ret < 0) |
|
return ret; |
|
|
|
data->px_enabled = true; |
|
|
|
return 0; |
|
} |
|
|
|
static int us5182d_get_als(struct us5182d_data *data) |
|
{ |
|
int ret; |
|
unsigned long result; |
|
|
|
ret = us5182d_als_enable(data); |
|
if (ret < 0) |
|
return ret; |
|
|
|
ret = i2c_smbus_read_word_data(data->client, |
|
US5182D_REG_ADL); |
|
if (ret < 0) |
|
return ret; |
|
|
|
result = ret * data->ga / US5182D_GA_RESOLUTION; |
|
if (result > 0xffff) |
|
result = 0xffff; |
|
|
|
return result; |
|
} |
|
|
|
static int us5182d_get_px(struct us5182d_data *data) |
|
{ |
|
int ret; |
|
|
|
ret = us5182d_px_enable(data); |
|
if (ret < 0) |
|
return ret; |
|
|
|
return i2c_smbus_read_word_data(data->client, |
|
US5182D_REG_PDL); |
|
} |
|
|
|
static int us5182d_shutdown_en(struct us5182d_data *data, u8 state) |
|
{ |
|
int ret; |
|
|
|
if (data->power_mode == US5182D_ONESHOT) |
|
return 0; |
|
|
|
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG0); |
|
if (ret < 0) |
|
return ret; |
|
|
|
ret = ret & ~US5182D_CFG0_SHUTDOWN_EN; |
|
ret = ret | state; |
|
|
|
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG0, ret); |
|
if (ret < 0) |
|
return ret; |
|
|
|
if (state & US5182D_CFG0_SHUTDOWN_EN) { |
|
data->als_enabled = false; |
|
data->px_enabled = false; |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
|
|
static int us5182d_set_power_state(struct us5182d_data *data, bool on) |
|
{ |
|
int ret; |
|
|
|
if (data->power_mode == US5182D_ONESHOT) |
|
return 0; |
|
|
|
if (on) { |
|
ret = pm_runtime_get_sync(&data->client->dev); |
|
if (ret < 0) |
|
pm_runtime_put_noidle(&data->client->dev); |
|
} else { |
|
pm_runtime_mark_last_busy(&data->client->dev); |
|
ret = pm_runtime_put_autosuspend(&data->client->dev); |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static int us5182d_read_value(struct us5182d_data *data, |
|
struct iio_chan_spec const *chan) |
|
{ |
|
int ret, value; |
|
|
|
mutex_lock(&data->lock); |
|
|
|
if (data->power_mode == US5182D_ONESHOT) { |
|
ret = us5182d_oneshot_en(data); |
|
if (ret < 0) |
|
goto out_err; |
|
} |
|
|
|
ret = us5182d_set_power_state(data, true); |
|
if (ret < 0) |
|
goto out_err; |
|
|
|
if (chan->type == IIO_LIGHT) |
|
ret = us5182d_get_als(data); |
|
else |
|
ret = us5182d_get_px(data); |
|
if (ret < 0) |
|
goto out_poweroff; |
|
|
|
value = ret; |
|
|
|
ret = us5182d_set_power_state(data, false); |
|
if (ret < 0) |
|
goto out_err; |
|
|
|
mutex_unlock(&data->lock); |
|
return value; |
|
|
|
out_poweroff: |
|
us5182d_set_power_state(data, false); |
|
out_err: |
|
mutex_unlock(&data->lock); |
|
return ret; |
|
} |
|
|
|
static int us5182d_read_raw(struct iio_dev *indio_dev, |
|
struct iio_chan_spec const *chan, int *val, |
|
int *val2, long mask) |
|
{ |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
int ret; |
|
|
|
switch (mask) { |
|
case IIO_CHAN_INFO_RAW: |
|
ret = us5182d_read_value(data, chan); |
|
if (ret < 0) |
|
return ret; |
|
*val = ret; |
|
return IIO_VAL_INT; |
|
case IIO_CHAN_INFO_SCALE: |
|
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG1); |
|
if (ret < 0) |
|
return ret; |
|
*val = 0; |
|
*val2 = us5182d_scales[ret & US5182D_AGAIN_MASK]; |
|
return IIO_VAL_INT_PLUS_MICRO; |
|
default: |
|
return -EINVAL; |
|
} |
|
} |
|
|
|
/** |
|
* us5182d_update_dark_th - update Darh_Th registers |
|
* @data: us5182d_data structure |
|
* @index: index in us5182d_dark_ths array to use for the updated value |
|
* |
|
* Function needs to be called with a lock held because it needs two i2c write |
|
* byte operations as these registers (0x27 0x28) don't work in word mode |
|
* accessing. |
|
*/ |
|
static int us5182d_update_dark_th(struct us5182d_data *data, int index) |
|
{ |
|
__be16 dark_th = cpu_to_be16(data->us5182d_dark_ths[index]); |
|
int ret; |
|
|
|
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_UDARK_TH, |
|
((u8 *)&dark_th)[0]); |
|
if (ret < 0) |
|
return ret; |
|
|
|
return i2c_smbus_write_byte_data(data->client, US5182D_REG_UDARK_TH + 1, |
|
((u8 *)&dark_th)[1]); |
|
} |
|
|
|
/** |
|
* us5182d_apply_scale - update the ALS scale |
|
* @data: us5182d_data structure |
|
* @index: index in us5182d_scales array to use for the updated value |
|
* |
|
* Function needs to be called with a lock held as we're having more than one |
|
* i2c operation. |
|
*/ |
|
static int us5182d_apply_scale(struct us5182d_data *data, int index) |
|
{ |
|
int ret; |
|
|
|
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG1); |
|
if (ret < 0) |
|
return ret; |
|
|
|
ret = ret & (~US5182D_AGAIN_MASK); |
|
ret |= index; |
|
|
|
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG1, ret); |
|
if (ret < 0) |
|
return ret; |
|
|
|
return us5182d_update_dark_th(data, index); |
|
} |
|
|
|
static int us5182d_write_raw(struct iio_dev *indio_dev, |
|
struct iio_chan_spec const *chan, int val, |
|
int val2, long mask) |
|
{ |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
int ret, i; |
|
|
|
switch (mask) { |
|
case IIO_CHAN_INFO_SCALE: |
|
if (val != 0) |
|
return -EINVAL; |
|
for (i = 0; i < ARRAY_SIZE(us5182d_scales); i++) |
|
if (val2 == us5182d_scales[i]) { |
|
mutex_lock(&data->lock); |
|
ret = us5182d_apply_scale(data, i); |
|
mutex_unlock(&data->lock); |
|
return ret; |
|
} |
|
break; |
|
default: |
|
return -EINVAL; |
|
} |
|
|
|
return -EINVAL; |
|
} |
|
|
|
static int us5182d_setup_prox(struct iio_dev *indio_dev, |
|
enum iio_event_direction dir, u16 val) |
|
{ |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
|
|
if (dir == IIO_EV_DIR_FALLING) |
|
return i2c_smbus_write_word_data(data->client, |
|
US5182D_REG_PXL_TH, val); |
|
else if (dir == IIO_EV_DIR_RISING) |
|
return i2c_smbus_write_word_data(data->client, |
|
US5182D_REG_PXH_TH, val); |
|
|
|
return 0; |
|
} |
|
|
|
static int us5182d_read_thresh(struct iio_dev *indio_dev, |
|
const struct iio_chan_spec *chan, enum iio_event_type type, |
|
enum iio_event_direction dir, enum iio_event_info info, int *val, |
|
int *val2) |
|
{ |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
|
|
switch (dir) { |
|
case IIO_EV_DIR_RISING: |
|
mutex_lock(&data->lock); |
|
*val = data->px_high_th; |
|
mutex_unlock(&data->lock); |
|
break; |
|
case IIO_EV_DIR_FALLING: |
|
mutex_lock(&data->lock); |
|
*val = data->px_low_th; |
|
mutex_unlock(&data->lock); |
|
break; |
|
default: |
|
return -EINVAL; |
|
} |
|
|
|
return IIO_VAL_INT; |
|
} |
|
|
|
static int us5182d_write_thresh(struct iio_dev *indio_dev, |
|
const struct iio_chan_spec *chan, enum iio_event_type type, |
|
enum iio_event_direction dir, enum iio_event_info info, int val, |
|
int val2) |
|
{ |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
int ret; |
|
|
|
if (val < 0 || val > USHRT_MAX || val2 != 0) |
|
return -EINVAL; |
|
|
|
switch (dir) { |
|
case IIO_EV_DIR_RISING: |
|
mutex_lock(&data->lock); |
|
if (data->rising_en) { |
|
ret = us5182d_setup_prox(indio_dev, dir, val); |
|
if (ret < 0) |
|
goto err; |
|
} |
|
data->px_high_th = val; |
|
mutex_unlock(&data->lock); |
|
break; |
|
case IIO_EV_DIR_FALLING: |
|
mutex_lock(&data->lock); |
|
if (data->falling_en) { |
|
ret = us5182d_setup_prox(indio_dev, dir, val); |
|
if (ret < 0) |
|
goto err; |
|
} |
|
data->px_low_th = val; |
|
mutex_unlock(&data->lock); |
|
break; |
|
default: |
|
return -EINVAL; |
|
} |
|
|
|
return 0; |
|
err: |
|
mutex_unlock(&data->lock); |
|
return ret; |
|
} |
|
|
|
static int us5182d_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 us5182d_data *data = iio_priv(indio_dev); |
|
int ret; |
|
|
|
switch (dir) { |
|
case IIO_EV_DIR_RISING: |
|
mutex_lock(&data->lock); |
|
ret = data->rising_en; |
|
mutex_unlock(&data->lock); |
|
break; |
|
case IIO_EV_DIR_FALLING: |
|
mutex_lock(&data->lock); |
|
ret = data->falling_en; |
|
mutex_unlock(&data->lock); |
|
break; |
|
default: |
|
ret = -EINVAL; |
|
break; |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static int us5182d_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 us5182d_data *data = iio_priv(indio_dev); |
|
int ret; |
|
u16 new_th; |
|
|
|
mutex_lock(&data->lock); |
|
|
|
switch (dir) { |
|
case IIO_EV_DIR_RISING: |
|
if (data->rising_en == state) { |
|
mutex_unlock(&data->lock); |
|
return 0; |
|
} |
|
new_th = US5182D_PXH_TH_DISABLE; |
|
if (state) { |
|
data->power_mode = US5182D_CONTINUOUS; |
|
ret = us5182d_set_power_state(data, true); |
|
if (ret < 0) |
|
goto err; |
|
ret = us5182d_px_enable(data); |
|
if (ret < 0) |
|
goto err_poweroff; |
|
new_th = data->px_high_th; |
|
} |
|
ret = us5182d_setup_prox(indio_dev, dir, new_th); |
|
if (ret < 0) |
|
goto err_poweroff; |
|
data->rising_en = state; |
|
break; |
|
case IIO_EV_DIR_FALLING: |
|
if (data->falling_en == state) { |
|
mutex_unlock(&data->lock); |
|
return 0; |
|
} |
|
new_th = US5182D_PXL_TH_DISABLE; |
|
if (state) { |
|
data->power_mode = US5182D_CONTINUOUS; |
|
ret = us5182d_set_power_state(data, true); |
|
if (ret < 0) |
|
goto err; |
|
ret = us5182d_px_enable(data); |
|
if (ret < 0) |
|
goto err_poweroff; |
|
new_th = data->px_low_th; |
|
} |
|
ret = us5182d_setup_prox(indio_dev, dir, new_th); |
|
if (ret < 0) |
|
goto err_poweroff; |
|
data->falling_en = state; |
|
break; |
|
default: |
|
ret = -EINVAL; |
|
goto err; |
|
} |
|
|
|
if (!state) { |
|
ret = us5182d_set_power_state(data, false); |
|
if (ret < 0) |
|
goto err; |
|
} |
|
|
|
if (!data->falling_en && !data->rising_en && !data->default_continuous) |
|
data->power_mode = US5182D_ONESHOT; |
|
|
|
mutex_unlock(&data->lock); |
|
return 0; |
|
|
|
err_poweroff: |
|
if (state) |
|
us5182d_set_power_state(data, false); |
|
err: |
|
mutex_unlock(&data->lock); |
|
return ret; |
|
} |
|
|
|
static const struct iio_info us5182d_info = { |
|
.read_raw = us5182d_read_raw, |
|
.write_raw = us5182d_write_raw, |
|
.attrs = &us5182d_attr_group, |
|
.read_event_value = &us5182d_read_thresh, |
|
.write_event_value = &us5182d_write_thresh, |
|
.read_event_config = &us5182d_read_event_config, |
|
.write_event_config = &us5182d_write_event_config, |
|
}; |
|
|
|
static int us5182d_reset(struct iio_dev *indio_dev) |
|
{ |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
|
|
return i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG3, |
|
US5182D_RESET_CHIP); |
|
} |
|
|
|
static int us5182d_init(struct iio_dev *indio_dev) |
|
{ |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
int i, ret; |
|
|
|
ret = us5182d_reset(indio_dev); |
|
if (ret < 0) |
|
return ret; |
|
|
|
data->opmode = 0; |
|
data->power_mode = US5182D_CONTINUOUS; |
|
data->px_low_th = US5182D_REG_PXL_TH_DEFAULT; |
|
data->px_high_th = US5182D_REG_PXH_TH_DEFAULT; |
|
|
|
for (i = 0; i < ARRAY_SIZE(us5182d_regvals); i++) { |
|
ret = i2c_smbus_write_byte_data(data->client, |
|
us5182d_regvals[i].reg, |
|
us5182d_regvals[i].val); |
|
if (ret < 0) |
|
return ret; |
|
} |
|
|
|
data->als_enabled = true; |
|
data->px_enabled = true; |
|
|
|
if (!data->default_continuous) { |
|
ret = us5182d_shutdown_en(data, US5182D_CFG0_SHUTDOWN_EN); |
|
if (ret < 0) |
|
return ret; |
|
data->power_mode = US5182D_ONESHOT; |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static void us5182d_get_platform_data(struct iio_dev *indio_dev) |
|
{ |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
|
|
if (device_property_read_u32(&data->client->dev, "upisemi,glass-coef", |
|
&data->ga)) |
|
data->ga = US5182D_GA_RESOLUTION; |
|
if (device_property_read_u16_array(&data->client->dev, |
|
"upisemi,dark-ths", |
|
data->us5182d_dark_ths, |
|
ARRAY_SIZE(us5182d_dark_ths_vals))) |
|
data->us5182d_dark_ths = us5182d_dark_ths_vals; |
|
if (device_property_read_u8(&data->client->dev, |
|
"upisemi,upper-dark-gain", |
|
&data->upper_dark_gain)) |
|
data->upper_dark_gain = US5182D_REG_AUTO_HDARK_GAIN_DEFAULT; |
|
if (device_property_read_u8(&data->client->dev, |
|
"upisemi,lower-dark-gain", |
|
&data->lower_dark_gain)) |
|
data->lower_dark_gain = US5182D_REG_AUTO_LDARK_GAIN_DEFAULT; |
|
data->default_continuous = device_property_read_bool(&data->client->dev, |
|
"upisemi,continuous"); |
|
} |
|
|
|
static int us5182d_dark_gain_config(struct iio_dev *indio_dev) |
|
{ |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
int ret; |
|
|
|
ret = us5182d_update_dark_th(data, US5182D_CFG1_AGAIN_DEFAULT); |
|
if (ret < 0) |
|
return ret; |
|
|
|
ret = i2c_smbus_write_byte_data(data->client, |
|
US5182D_REG_AUTO_LDARK_GAIN, |
|
data->lower_dark_gain); |
|
if (ret < 0) |
|
return ret; |
|
|
|
ret = i2c_smbus_write_byte_data(data->client, |
|
US5182D_REG_AUTO_HDARK_GAIN, |
|
data->upper_dark_gain); |
|
if (ret < 0) |
|
return ret; |
|
|
|
return i2c_smbus_write_byte_data(data->client, US5182D_REG_DARK_AUTO_EN, |
|
US5182D_REG_DARK_AUTO_EN_DEFAULT); |
|
} |
|
|
|
static irqreturn_t us5182d_irq_thread_handler(int irq, void *private) |
|
{ |
|
struct iio_dev *indio_dev = private; |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
enum iio_event_direction dir; |
|
int ret; |
|
u64 ev; |
|
|
|
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG0); |
|
if (ret < 0) { |
|
dev_err(&data->client->dev, "i2c transfer error in irq\n"); |
|
return IRQ_HANDLED; |
|
} |
|
|
|
dir = ret & US5182D_CFG0_PROX ? IIO_EV_DIR_RISING : IIO_EV_DIR_FALLING; |
|
ev = IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY, 1, IIO_EV_TYPE_THRESH, dir); |
|
|
|
iio_push_event(indio_dev, ev, iio_get_time_ns(indio_dev)); |
|
|
|
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG0, |
|
ret & ~US5182D_CFG0_PX_IRQ); |
|
if (ret < 0) |
|
dev_err(&data->client->dev, "i2c transfer error in irq\n"); |
|
|
|
return IRQ_HANDLED; |
|
} |
|
|
|
static int us5182d_probe(struct i2c_client *client, |
|
const struct i2c_device_id *id) |
|
{ |
|
struct us5182d_data *data; |
|
struct iio_dev *indio_dev; |
|
int ret; |
|
|
|
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); |
|
if (!indio_dev) |
|
return -ENOMEM; |
|
|
|
data = iio_priv(indio_dev); |
|
i2c_set_clientdata(client, indio_dev); |
|
data->client = client; |
|
|
|
mutex_init(&data->lock); |
|
|
|
indio_dev->info = &us5182d_info; |
|
indio_dev->name = US5182D_DRV_NAME; |
|
indio_dev->channels = us5182d_channels; |
|
indio_dev->num_channels = ARRAY_SIZE(us5182d_channels); |
|
indio_dev->modes = INDIO_DIRECT_MODE; |
|
|
|
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CHIPID); |
|
if (ret != US5182D_CHIPID) { |
|
dev_err(&data->client->dev, |
|
"Failed to detect US5182 light chip\n"); |
|
return (ret < 0) ? ret : -ENODEV; |
|
} |
|
|
|
if (client->irq > 0) { |
|
ret = devm_request_threaded_irq(&client->dev, client->irq, NULL, |
|
us5182d_irq_thread_handler, |
|
IRQF_TRIGGER_LOW | IRQF_ONESHOT, |
|
"us5182d-irq", indio_dev); |
|
if (ret < 0) |
|
return ret; |
|
} else |
|
dev_warn(&client->dev, "no valid irq found\n"); |
|
|
|
us5182d_get_platform_data(indio_dev); |
|
ret = us5182d_init(indio_dev); |
|
if (ret < 0) |
|
return ret; |
|
|
|
ret = us5182d_dark_gain_config(indio_dev); |
|
if (ret < 0) |
|
goto out_err; |
|
|
|
if (data->default_continuous) { |
|
ret = pm_runtime_set_active(&client->dev); |
|
if (ret < 0) |
|
goto out_err; |
|
} |
|
|
|
pm_runtime_enable(&client->dev); |
|
pm_runtime_set_autosuspend_delay(&client->dev, |
|
US5182D_SLEEP_MS); |
|
pm_runtime_use_autosuspend(&client->dev); |
|
|
|
ret = iio_device_register(indio_dev); |
|
if (ret < 0) |
|
goto out_err; |
|
|
|
return 0; |
|
|
|
out_err: |
|
us5182d_shutdown_en(data, US5182D_CFG0_SHUTDOWN_EN); |
|
return ret; |
|
|
|
} |
|
|
|
static int us5182d_remove(struct i2c_client *client) |
|
{ |
|
struct us5182d_data *data = iio_priv(i2c_get_clientdata(client)); |
|
|
|
iio_device_unregister(i2c_get_clientdata(client)); |
|
|
|
pm_runtime_disable(&client->dev); |
|
pm_runtime_set_suspended(&client->dev); |
|
|
|
return us5182d_shutdown_en(data, US5182D_CFG0_SHUTDOWN_EN); |
|
} |
|
|
|
#if defined(CONFIG_PM_SLEEP) || defined(CONFIG_PM) |
|
static int us5182d_suspend(struct device *dev) |
|
{ |
|
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
|
|
if (data->power_mode == US5182D_CONTINUOUS) |
|
return us5182d_shutdown_en(data, US5182D_CFG0_SHUTDOWN_EN); |
|
|
|
return 0; |
|
} |
|
|
|
static int us5182d_resume(struct device *dev) |
|
{ |
|
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); |
|
struct us5182d_data *data = iio_priv(indio_dev); |
|
|
|
if (data->power_mode == US5182D_CONTINUOUS) |
|
return us5182d_shutdown_en(data, |
|
~US5182D_CFG0_SHUTDOWN_EN & 0xff); |
|
|
|
return 0; |
|
} |
|
#endif |
|
|
|
static const struct dev_pm_ops us5182d_pm_ops = { |
|
SET_SYSTEM_SLEEP_PM_OPS(us5182d_suspend, us5182d_resume) |
|
SET_RUNTIME_PM_OPS(us5182d_suspend, us5182d_resume, NULL) |
|
}; |
|
|
|
static const struct acpi_device_id us5182d_acpi_match[] = { |
|
{ "USD5182", 0}, |
|
{} |
|
}; |
|
|
|
MODULE_DEVICE_TABLE(acpi, us5182d_acpi_match); |
|
|
|
static const struct i2c_device_id us5182d_id[] = { |
|
{"usd5182", 0}, |
|
{} |
|
}; |
|
|
|
MODULE_DEVICE_TABLE(i2c, us5182d_id); |
|
|
|
static const struct of_device_id us5182d_of_match[] = { |
|
{ .compatible = "upisemi,usd5182" }, |
|
{} |
|
}; |
|
MODULE_DEVICE_TABLE(of, us5182d_of_match); |
|
|
|
static struct i2c_driver us5182d_driver = { |
|
.driver = { |
|
.name = US5182D_DRV_NAME, |
|
.pm = &us5182d_pm_ops, |
|
.of_match_table = us5182d_of_match, |
|
.acpi_match_table = ACPI_PTR(us5182d_acpi_match), |
|
}, |
|
.probe = us5182d_probe, |
|
.remove = us5182d_remove, |
|
.id_table = us5182d_id, |
|
|
|
}; |
|
module_i2c_driver(us5182d_driver); |
|
|
|
MODULE_AUTHOR("Adriana Reus <[email protected]>"); |
|
MODULE_DESCRIPTION("Driver for us5182d Proximity and Light Sensor"); |
|
MODULE_LICENSE("GPL v2");
|
|
|