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.
745 lines
19 KiB
745 lines
19 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
/* |
|
* Copyright (C) 2013 Samsung Electronics Co., Ltd. |
|
* Author: Beomho Seo <[email protected]> |
|
*/ |
|
|
|
#include <linux/delay.h> |
|
#include <linux/err.h> |
|
#include <linux/i2c.h> |
|
#include <linux/mutex.h> |
|
#include <linux/module.h> |
|
#include <linux/interrupt.h> |
|
#include <linux/regulator/consumer.h> |
|
#include <linux/iio/iio.h> |
|
#include <linux/iio/sysfs.h> |
|
#include <linux/iio/events.h> |
|
|
|
/* Slave address 0x19 for PS of 7 bit addressing protocol for I2C */ |
|
#define CM36651_I2C_ADDR_PS 0x19 |
|
/* Alert Response Address */ |
|
#define CM36651_ARA 0x0C |
|
|
|
/* Ambient light sensor */ |
|
#define CM36651_CS_CONF1 0x00 |
|
#define CM36651_CS_CONF2 0x01 |
|
#define CM36651_ALS_WH_M 0x02 |
|
#define CM36651_ALS_WH_L 0x03 |
|
#define CM36651_ALS_WL_M 0x04 |
|
#define CM36651_ALS_WL_L 0x05 |
|
#define CM36651_CS_CONF3 0x06 |
|
#define CM36651_CS_CONF_REG_NUM 0x02 |
|
|
|
/* Proximity sensor */ |
|
#define CM36651_PS_CONF1 0x00 |
|
#define CM36651_PS_THD 0x01 |
|
#define CM36651_PS_CANC 0x02 |
|
#define CM36651_PS_CONF2 0x03 |
|
#define CM36651_PS_REG_NUM 0x04 |
|
|
|
/* CS_CONF1 command code */ |
|
#define CM36651_ALS_ENABLE 0x00 |
|
#define CM36651_ALS_DISABLE 0x01 |
|
#define CM36651_ALS_INT_EN 0x02 |
|
#define CM36651_ALS_THRES 0x04 |
|
|
|
/* CS_CONF2 command code */ |
|
#define CM36651_CS_CONF2_DEFAULT_BIT 0x08 |
|
|
|
/* CS_CONF3 channel integration time */ |
|
#define CM36651_CS_IT1 0x00 /* Integration time 80 msec */ |
|
#define CM36651_CS_IT2 0x40 /* Integration time 160 msec */ |
|
#define CM36651_CS_IT3 0x80 /* Integration time 320 msec */ |
|
#define CM36651_CS_IT4 0xC0 /* Integration time 640 msec */ |
|
|
|
/* PS_CONF1 command code */ |
|
#define CM36651_PS_ENABLE 0x00 |
|
#define CM36651_PS_DISABLE 0x01 |
|
#define CM36651_PS_INT_EN 0x02 |
|
#define CM36651_PS_PERS2 0x04 |
|
#define CM36651_PS_PERS3 0x08 |
|
#define CM36651_PS_PERS4 0x0C |
|
|
|
/* PS_CONF1 command code: integration time */ |
|
#define CM36651_PS_IT1 0x00 /* Integration time 0.32 msec */ |
|
#define CM36651_PS_IT2 0x10 /* Integration time 0.42 msec */ |
|
#define CM36651_PS_IT3 0x20 /* Integration time 0.52 msec */ |
|
#define CM36651_PS_IT4 0x30 /* Integration time 0.64 msec */ |
|
|
|
/* PS_CONF1 command code: duty ratio */ |
|
#define CM36651_PS_DR1 0x00 /* Duty ratio 1/80 */ |
|
#define CM36651_PS_DR2 0x40 /* Duty ratio 1/160 */ |
|
#define CM36651_PS_DR3 0x80 /* Duty ratio 1/320 */ |
|
#define CM36651_PS_DR4 0xC0 /* Duty ratio 1/640 */ |
|
|
|
/* PS_THD command code */ |
|
#define CM36651_PS_INITIAL_THD 0x05 |
|
|
|
/* PS_CANC command code */ |
|
#define CM36651_PS_CANC_DEFAULT 0x00 |
|
|
|
/* PS_CONF2 command code */ |
|
#define CM36651_PS_HYS1 0x00 |
|
#define CM36651_PS_HYS2 0x01 |
|
#define CM36651_PS_SMART_PERS_EN 0x02 |
|
#define CM36651_PS_DIR_INT 0x04 |
|
#define CM36651_PS_MS 0x10 |
|
|
|
#define CM36651_CS_COLOR_NUM 4 |
|
|
|
#define CM36651_CLOSE_PROXIMITY 0x32 |
|
#define CM36651_FAR_PROXIMITY 0x33 |
|
|
|
#define CM36651_CS_INT_TIME_AVAIL "0.08 0.16 0.32 0.64" |
|
#define CM36651_PS_INT_TIME_AVAIL "0.000320 0.000420 0.000520 0.000640" |
|
|
|
enum cm36651_operation_mode { |
|
CM36651_LIGHT_EN, |
|
CM36651_PROXIMITY_EN, |
|
CM36651_PROXIMITY_EV_EN, |
|
}; |
|
|
|
enum cm36651_light_channel_idx { |
|
CM36651_LIGHT_CHANNEL_IDX_RED, |
|
CM36651_LIGHT_CHANNEL_IDX_GREEN, |
|
CM36651_LIGHT_CHANNEL_IDX_BLUE, |
|
CM36651_LIGHT_CHANNEL_IDX_CLEAR, |
|
}; |
|
|
|
enum cm36651_command { |
|
CM36651_CMD_READ_RAW_LIGHT, |
|
CM36651_CMD_READ_RAW_PROXIMITY, |
|
CM36651_CMD_PROX_EV_EN, |
|
CM36651_CMD_PROX_EV_DIS, |
|
}; |
|
|
|
static const u8 cm36651_cs_reg[CM36651_CS_CONF_REG_NUM] = { |
|
CM36651_CS_CONF1, |
|
CM36651_CS_CONF2, |
|
}; |
|
|
|
static const u8 cm36651_ps_reg[CM36651_PS_REG_NUM] = { |
|
CM36651_PS_CONF1, |
|
CM36651_PS_THD, |
|
CM36651_PS_CANC, |
|
CM36651_PS_CONF2, |
|
}; |
|
|
|
struct cm36651_data { |
|
const struct cm36651_platform_data *pdata; |
|
struct i2c_client *client; |
|
struct i2c_client *ps_client; |
|
struct i2c_client *ara_client; |
|
struct mutex lock; |
|
struct regulator *vled_reg; |
|
unsigned long flags; |
|
int cs_int_time[CM36651_CS_COLOR_NUM]; |
|
int ps_int_time; |
|
u8 cs_ctrl_regs[CM36651_CS_CONF_REG_NUM]; |
|
u8 ps_ctrl_regs[CM36651_PS_REG_NUM]; |
|
u16 color[CM36651_CS_COLOR_NUM]; |
|
}; |
|
|
|
static int cm36651_setup_reg(struct cm36651_data *cm36651) |
|
{ |
|
struct i2c_client *client = cm36651->client; |
|
struct i2c_client *ps_client = cm36651->ps_client; |
|
int i, ret; |
|
|
|
/* CS initialization */ |
|
cm36651->cs_ctrl_regs[CM36651_CS_CONF1] = CM36651_ALS_ENABLE | |
|
CM36651_ALS_THRES; |
|
cm36651->cs_ctrl_regs[CM36651_CS_CONF2] = CM36651_CS_CONF2_DEFAULT_BIT; |
|
|
|
for (i = 0; i < CM36651_CS_CONF_REG_NUM; i++) { |
|
ret = i2c_smbus_write_byte_data(client, cm36651_cs_reg[i], |
|
cm36651->cs_ctrl_regs[i]); |
|
if (ret < 0) |
|
return ret; |
|
} |
|
|
|
/* PS initialization */ |
|
cm36651->ps_ctrl_regs[CM36651_PS_CONF1] = CM36651_PS_ENABLE | |
|
CM36651_PS_IT2; |
|
cm36651->ps_ctrl_regs[CM36651_PS_THD] = CM36651_PS_INITIAL_THD; |
|
cm36651->ps_ctrl_regs[CM36651_PS_CANC] = CM36651_PS_CANC_DEFAULT; |
|
cm36651->ps_ctrl_regs[CM36651_PS_CONF2] = CM36651_PS_HYS2 | |
|
CM36651_PS_DIR_INT | CM36651_PS_SMART_PERS_EN; |
|
|
|
for (i = 0; i < CM36651_PS_REG_NUM; i++) { |
|
ret = i2c_smbus_write_byte_data(ps_client, cm36651_ps_reg[i], |
|
cm36651->ps_ctrl_regs[i]); |
|
if (ret < 0) |
|
return ret; |
|
} |
|
|
|
/* Set shutdown mode */ |
|
ret = i2c_smbus_write_byte_data(client, CM36651_CS_CONF1, |
|
CM36651_ALS_DISABLE); |
|
if (ret < 0) |
|
return ret; |
|
|
|
ret = i2c_smbus_write_byte_data(cm36651->ps_client, |
|
CM36651_PS_CONF1, CM36651_PS_DISABLE); |
|
if (ret < 0) |
|
return ret; |
|
|
|
return 0; |
|
} |
|
|
|
static int cm36651_read_output(struct cm36651_data *cm36651, |
|
struct iio_chan_spec const *chan, int *val) |
|
{ |
|
struct i2c_client *client = cm36651->client; |
|
int ret = -EINVAL; |
|
|
|
switch (chan->type) { |
|
case IIO_LIGHT: |
|
*val = i2c_smbus_read_word_data(client, chan->address); |
|
if (*val < 0) |
|
return ret; |
|
|
|
ret = i2c_smbus_write_byte_data(client, CM36651_CS_CONF1, |
|
CM36651_ALS_DISABLE); |
|
if (ret < 0) |
|
return ret; |
|
|
|
ret = IIO_VAL_INT; |
|
break; |
|
case IIO_PROXIMITY: |
|
*val = i2c_smbus_read_byte(cm36651->ps_client); |
|
if (*val < 0) |
|
return ret; |
|
|
|
if (!test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags)) { |
|
ret = i2c_smbus_write_byte_data(cm36651->ps_client, |
|
CM36651_PS_CONF1, CM36651_PS_DISABLE); |
|
if (ret < 0) |
|
return ret; |
|
} |
|
|
|
ret = IIO_VAL_INT; |
|
break; |
|
default: |
|
break; |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static irqreturn_t cm36651_irq_handler(int irq, void *data) |
|
{ |
|
struct iio_dev *indio_dev = data; |
|
struct cm36651_data *cm36651 = iio_priv(indio_dev); |
|
struct i2c_client *client = cm36651->client; |
|
int ev_dir, ret; |
|
u64 ev_code; |
|
|
|
/* |
|
* The PS INT pin is an active low signal that PS INT move logic low |
|
* when the object is detect. Once the MCU host received the PS INT |
|
* "LOW" signal, the Host needs to read the data at Alert Response |
|
* Address(ARA) to clear the PS INT signal. After clearing the PS |
|
* INT pin, the PS INT signal toggles from low to high. |
|
*/ |
|
ret = i2c_smbus_read_byte(cm36651->ara_client); |
|
if (ret < 0) { |
|
dev_err(&client->dev, |
|
"%s: Data read failed: %d\n", __func__, ret); |
|
return IRQ_HANDLED; |
|
} |
|
switch (ret) { |
|
case CM36651_CLOSE_PROXIMITY: |
|
ev_dir = IIO_EV_DIR_RISING; |
|
break; |
|
case CM36651_FAR_PROXIMITY: |
|
ev_dir = IIO_EV_DIR_FALLING; |
|
break; |
|
default: |
|
dev_err(&client->dev, |
|
"%s: Data read wrong: %d\n", __func__, ret); |
|
return IRQ_HANDLED; |
|
} |
|
|
|
ev_code = IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY, |
|
CM36651_CMD_READ_RAW_PROXIMITY, |
|
IIO_EV_TYPE_THRESH, ev_dir); |
|
|
|
iio_push_event(indio_dev, ev_code, iio_get_time_ns(indio_dev)); |
|
|
|
return IRQ_HANDLED; |
|
} |
|
|
|
static int cm36651_set_operation_mode(struct cm36651_data *cm36651, int cmd) |
|
{ |
|
struct i2c_client *client = cm36651->client; |
|
struct i2c_client *ps_client = cm36651->ps_client; |
|
int ret = -EINVAL; |
|
|
|
switch (cmd) { |
|
case CM36651_CMD_READ_RAW_LIGHT: |
|
ret = i2c_smbus_write_byte_data(client, CM36651_CS_CONF1, |
|
cm36651->cs_ctrl_regs[CM36651_CS_CONF1]); |
|
break; |
|
case CM36651_CMD_READ_RAW_PROXIMITY: |
|
if (test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags)) |
|
return CM36651_PROXIMITY_EV_EN; |
|
|
|
ret = i2c_smbus_write_byte_data(ps_client, CM36651_PS_CONF1, |
|
cm36651->ps_ctrl_regs[CM36651_PS_CONF1]); |
|
break; |
|
case CM36651_CMD_PROX_EV_EN: |
|
if (test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags)) { |
|
dev_err(&client->dev, |
|
"Already proximity event enable state\n"); |
|
return ret; |
|
} |
|
set_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags); |
|
|
|
ret = i2c_smbus_write_byte_data(ps_client, |
|
cm36651_ps_reg[CM36651_PS_CONF1], |
|
CM36651_PS_INT_EN | CM36651_PS_PERS2 | CM36651_PS_IT2); |
|
|
|
if (ret < 0) { |
|
dev_err(&client->dev, "Proximity enable event failed\n"); |
|
return ret; |
|
} |
|
break; |
|
case CM36651_CMD_PROX_EV_DIS: |
|
if (!test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags)) { |
|
dev_err(&client->dev, |
|
"Already proximity event disable state\n"); |
|
return ret; |
|
} |
|
clear_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags); |
|
ret = i2c_smbus_write_byte_data(ps_client, |
|
CM36651_PS_CONF1, CM36651_PS_DISABLE); |
|
break; |
|
} |
|
|
|
if (ret < 0) |
|
dev_err(&client->dev, "Write register failed\n"); |
|
|
|
return ret; |
|
} |
|
|
|
static int cm36651_read_channel(struct cm36651_data *cm36651, |
|
struct iio_chan_spec const *chan, int *val) |
|
{ |
|
struct i2c_client *client = cm36651->client; |
|
int cmd, ret; |
|
|
|
if (chan->type == IIO_LIGHT) |
|
cmd = CM36651_CMD_READ_RAW_LIGHT; |
|
else if (chan->type == IIO_PROXIMITY) |
|
cmd = CM36651_CMD_READ_RAW_PROXIMITY; |
|
else |
|
return -EINVAL; |
|
|
|
ret = cm36651_set_operation_mode(cm36651, cmd); |
|
if (ret < 0) { |
|
dev_err(&client->dev, "CM36651 set operation mode failed\n"); |
|
return ret; |
|
} |
|
/* Delay for work after enable operation */ |
|
msleep(50); |
|
ret = cm36651_read_output(cm36651, chan, val); |
|
if (ret < 0) { |
|
dev_err(&client->dev, "CM36651 read output failed\n"); |
|
return ret; |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static int cm36651_read_int_time(struct cm36651_data *cm36651, |
|
struct iio_chan_spec const *chan, int *val2) |
|
{ |
|
switch (chan->type) { |
|
case IIO_LIGHT: |
|
if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT1) |
|
*val2 = 80000; |
|
else if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT2) |
|
*val2 = 160000; |
|
else if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT3) |
|
*val2 = 320000; |
|
else if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT4) |
|
*val2 = 640000; |
|
else |
|
return -EINVAL; |
|
break; |
|
case IIO_PROXIMITY: |
|
if (cm36651->ps_int_time == CM36651_PS_IT1) |
|
*val2 = 320; |
|
else if (cm36651->ps_int_time == CM36651_PS_IT2) |
|
*val2 = 420; |
|
else if (cm36651->ps_int_time == CM36651_PS_IT3) |
|
*val2 = 520; |
|
else if (cm36651->ps_int_time == CM36651_PS_IT4) |
|
*val2 = 640; |
|
else |
|
return -EINVAL; |
|
break; |
|
default: |
|
return -EINVAL; |
|
} |
|
|
|
return IIO_VAL_INT_PLUS_MICRO; |
|
} |
|
|
|
static int cm36651_write_int_time(struct cm36651_data *cm36651, |
|
struct iio_chan_spec const *chan, int val) |
|
{ |
|
struct i2c_client *client = cm36651->client; |
|
struct i2c_client *ps_client = cm36651->ps_client; |
|
int int_time, ret; |
|
|
|
switch (chan->type) { |
|
case IIO_LIGHT: |
|
if (val == 80000) |
|
int_time = CM36651_CS_IT1; |
|
else if (val == 160000) |
|
int_time = CM36651_CS_IT2; |
|
else if (val == 320000) |
|
int_time = CM36651_CS_IT3; |
|
else if (val == 640000) |
|
int_time = CM36651_CS_IT4; |
|
else |
|
return -EINVAL; |
|
|
|
ret = i2c_smbus_write_byte_data(client, CM36651_CS_CONF3, |
|
int_time >> 2 * (chan->address)); |
|
if (ret < 0) { |
|
dev_err(&client->dev, "CS integration time write failed\n"); |
|
return ret; |
|
} |
|
cm36651->cs_int_time[chan->address] = int_time; |
|
break; |
|
case IIO_PROXIMITY: |
|
if (val == 320) |
|
int_time = CM36651_PS_IT1; |
|
else if (val == 420) |
|
int_time = CM36651_PS_IT2; |
|
else if (val == 520) |
|
int_time = CM36651_PS_IT3; |
|
else if (val == 640) |
|
int_time = CM36651_PS_IT4; |
|
else |
|
return -EINVAL; |
|
|
|
ret = i2c_smbus_write_byte_data(ps_client, |
|
CM36651_PS_CONF1, int_time); |
|
if (ret < 0) { |
|
dev_err(&client->dev, "PS integration time write failed\n"); |
|
return ret; |
|
} |
|
cm36651->ps_int_time = int_time; |
|
break; |
|
default: |
|
return -EINVAL; |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static int cm36651_read_raw(struct iio_dev *indio_dev, |
|
struct iio_chan_spec const *chan, |
|
int *val, int *val2, long mask) |
|
{ |
|
struct cm36651_data *cm36651 = iio_priv(indio_dev); |
|
int ret; |
|
|
|
mutex_lock(&cm36651->lock); |
|
|
|
switch (mask) { |
|
case IIO_CHAN_INFO_RAW: |
|
ret = cm36651_read_channel(cm36651, chan, val); |
|
break; |
|
case IIO_CHAN_INFO_INT_TIME: |
|
*val = 0; |
|
ret = cm36651_read_int_time(cm36651, chan, val2); |
|
break; |
|
default: |
|
ret = -EINVAL; |
|
} |
|
|
|
mutex_unlock(&cm36651->lock); |
|
|
|
return ret; |
|
} |
|
|
|
static int cm36651_write_raw(struct iio_dev *indio_dev, |
|
struct iio_chan_spec const *chan, |
|
int val, int val2, long mask) |
|
{ |
|
struct cm36651_data *cm36651 = iio_priv(indio_dev); |
|
struct i2c_client *client = cm36651->client; |
|
int ret = -EINVAL; |
|
|
|
if (mask == IIO_CHAN_INFO_INT_TIME) { |
|
ret = cm36651_write_int_time(cm36651, chan, val2); |
|
if (ret < 0) |
|
dev_err(&client->dev, "Integration time write failed\n"); |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static int cm36651_read_prox_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 cm36651_data *cm36651 = iio_priv(indio_dev); |
|
|
|
*val = cm36651->ps_ctrl_regs[CM36651_PS_THD]; |
|
|
|
return 0; |
|
} |
|
|
|
static int cm36651_write_prox_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 cm36651_data *cm36651 = iio_priv(indio_dev); |
|
struct i2c_client *client = cm36651->client; |
|
int ret; |
|
|
|
if (val < 3 || val > 255) |
|
return -EINVAL; |
|
|
|
cm36651->ps_ctrl_regs[CM36651_PS_THD] = val; |
|
ret = i2c_smbus_write_byte_data(cm36651->ps_client, CM36651_PS_THD, |
|
cm36651->ps_ctrl_regs[CM36651_PS_THD]); |
|
|
|
if (ret < 0) { |
|
dev_err(&client->dev, "PS threshold write failed: %d\n", ret); |
|
return ret; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static int cm36651_write_prox_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 cm36651_data *cm36651 = iio_priv(indio_dev); |
|
int cmd, ret; |
|
|
|
mutex_lock(&cm36651->lock); |
|
|
|
cmd = state ? CM36651_CMD_PROX_EV_EN : CM36651_CMD_PROX_EV_DIS; |
|
ret = cm36651_set_operation_mode(cm36651, cmd); |
|
|
|
mutex_unlock(&cm36651->lock); |
|
|
|
return ret; |
|
} |
|
|
|
static int cm36651_read_prox_event_config(struct iio_dev *indio_dev, |
|
const struct iio_chan_spec *chan, |
|
enum iio_event_type type, |
|
enum iio_event_direction dir) |
|
{ |
|
struct cm36651_data *cm36651 = iio_priv(indio_dev); |
|
int event_en; |
|
|
|
mutex_lock(&cm36651->lock); |
|
|
|
event_en = test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags); |
|
|
|
mutex_unlock(&cm36651->lock); |
|
|
|
return event_en; |
|
} |
|
|
|
#define CM36651_LIGHT_CHANNEL(_color, _idx) { \ |
|
.type = IIO_LIGHT, \ |
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ |
|
BIT(IIO_CHAN_INFO_INT_TIME), \ |
|
.address = _idx, \ |
|
.modified = 1, \ |
|
.channel2 = IIO_MOD_LIGHT_##_color, \ |
|
} \ |
|
|
|
static const struct iio_event_spec cm36651_event_spec[] = { |
|
{ |
|
.type = IIO_EV_TYPE_THRESH, |
|
.dir = IIO_EV_DIR_EITHER, |
|
.mask_separate = BIT(IIO_EV_INFO_VALUE) | |
|
BIT(IIO_EV_INFO_ENABLE), |
|
} |
|
}; |
|
|
|
static const struct iio_chan_spec cm36651_channels[] = { |
|
{ |
|
.type = IIO_PROXIMITY, |
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | |
|
BIT(IIO_CHAN_INFO_INT_TIME), |
|
.event_spec = cm36651_event_spec, |
|
.num_event_specs = ARRAY_SIZE(cm36651_event_spec), |
|
}, |
|
CM36651_LIGHT_CHANNEL(RED, CM36651_LIGHT_CHANNEL_IDX_RED), |
|
CM36651_LIGHT_CHANNEL(GREEN, CM36651_LIGHT_CHANNEL_IDX_GREEN), |
|
CM36651_LIGHT_CHANNEL(BLUE, CM36651_LIGHT_CHANNEL_IDX_BLUE), |
|
CM36651_LIGHT_CHANNEL(CLEAR, CM36651_LIGHT_CHANNEL_IDX_CLEAR), |
|
}; |
|
|
|
static IIO_CONST_ATTR(in_illuminance_integration_time_available, |
|
CM36651_CS_INT_TIME_AVAIL); |
|
static IIO_CONST_ATTR(in_proximity_integration_time_available, |
|
CM36651_PS_INT_TIME_AVAIL); |
|
|
|
static struct attribute *cm36651_attributes[] = { |
|
&iio_const_attr_in_illuminance_integration_time_available.dev_attr.attr, |
|
&iio_const_attr_in_proximity_integration_time_available.dev_attr.attr, |
|
NULL, |
|
}; |
|
|
|
static const struct attribute_group cm36651_attribute_group = { |
|
.attrs = cm36651_attributes |
|
}; |
|
|
|
static const struct iio_info cm36651_info = { |
|
.read_raw = &cm36651_read_raw, |
|
.write_raw = &cm36651_write_raw, |
|
.read_event_value = &cm36651_read_prox_thresh, |
|
.write_event_value = &cm36651_write_prox_thresh, |
|
.read_event_config = &cm36651_read_prox_event_config, |
|
.write_event_config = &cm36651_write_prox_event_config, |
|
.attrs = &cm36651_attribute_group, |
|
}; |
|
|
|
static int cm36651_probe(struct i2c_client *client, |
|
const struct i2c_device_id *id) |
|
{ |
|
struct cm36651_data *cm36651; |
|
struct iio_dev *indio_dev; |
|
int ret; |
|
|
|
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*cm36651)); |
|
if (!indio_dev) |
|
return -ENOMEM; |
|
|
|
cm36651 = iio_priv(indio_dev); |
|
|
|
cm36651->vled_reg = devm_regulator_get(&client->dev, "vled"); |
|
if (IS_ERR(cm36651->vled_reg)) { |
|
dev_err(&client->dev, "get regulator vled failed\n"); |
|
return PTR_ERR(cm36651->vled_reg); |
|
} |
|
|
|
ret = regulator_enable(cm36651->vled_reg); |
|
if (ret) { |
|
dev_err(&client->dev, "enable regulator vled failed\n"); |
|
return ret; |
|
} |
|
|
|
i2c_set_clientdata(client, indio_dev); |
|
|
|
cm36651->client = client; |
|
cm36651->ps_client = i2c_new_dummy_device(client->adapter, |
|
CM36651_I2C_ADDR_PS); |
|
if (IS_ERR(cm36651->ps_client)) { |
|
dev_err(&client->dev, "%s: new i2c device failed\n", __func__); |
|
ret = PTR_ERR(cm36651->ps_client); |
|
goto error_disable_reg; |
|
} |
|
|
|
cm36651->ara_client = i2c_new_dummy_device(client->adapter, CM36651_ARA); |
|
if (IS_ERR(cm36651->ara_client)) { |
|
dev_err(&client->dev, "%s: new i2c device failed\n", __func__); |
|
ret = PTR_ERR(cm36651->ara_client); |
|
goto error_i2c_unregister_ps; |
|
} |
|
|
|
mutex_init(&cm36651->lock); |
|
indio_dev->channels = cm36651_channels; |
|
indio_dev->num_channels = ARRAY_SIZE(cm36651_channels); |
|
indio_dev->info = &cm36651_info; |
|
indio_dev->name = id->name; |
|
indio_dev->modes = INDIO_DIRECT_MODE; |
|
|
|
ret = cm36651_setup_reg(cm36651); |
|
if (ret) { |
|
dev_err(&client->dev, "%s: register setup failed\n", __func__); |
|
goto error_i2c_unregister_ara; |
|
} |
|
|
|
ret = request_threaded_irq(client->irq, NULL, cm36651_irq_handler, |
|
IRQF_TRIGGER_FALLING | IRQF_ONESHOT, |
|
"cm36651", indio_dev); |
|
if (ret) { |
|
dev_err(&client->dev, "%s: request irq failed\n", __func__); |
|
goto error_i2c_unregister_ara; |
|
} |
|
|
|
ret = iio_device_register(indio_dev); |
|
if (ret) { |
|
dev_err(&client->dev, "%s: regist device failed\n", __func__); |
|
goto error_free_irq; |
|
} |
|
|
|
return 0; |
|
|
|
error_free_irq: |
|
free_irq(client->irq, indio_dev); |
|
error_i2c_unregister_ara: |
|
i2c_unregister_device(cm36651->ara_client); |
|
error_i2c_unregister_ps: |
|
i2c_unregister_device(cm36651->ps_client); |
|
error_disable_reg: |
|
regulator_disable(cm36651->vled_reg); |
|
return ret; |
|
} |
|
|
|
static int cm36651_remove(struct i2c_client *client) |
|
{ |
|
struct iio_dev *indio_dev = i2c_get_clientdata(client); |
|
struct cm36651_data *cm36651 = iio_priv(indio_dev); |
|
|
|
iio_device_unregister(indio_dev); |
|
regulator_disable(cm36651->vled_reg); |
|
free_irq(client->irq, indio_dev); |
|
i2c_unregister_device(cm36651->ps_client); |
|
i2c_unregister_device(cm36651->ara_client); |
|
|
|
return 0; |
|
} |
|
|
|
static const struct i2c_device_id cm36651_id[] = { |
|
{ "cm36651", 0 }, |
|
{ } |
|
}; |
|
|
|
MODULE_DEVICE_TABLE(i2c, cm36651_id); |
|
|
|
static const struct of_device_id cm36651_of_match[] = { |
|
{ .compatible = "capella,cm36651" }, |
|
{ } |
|
}; |
|
MODULE_DEVICE_TABLE(of, cm36651_of_match); |
|
|
|
static struct i2c_driver cm36651_driver = { |
|
.driver = { |
|
.name = "cm36651", |
|
.of_match_table = cm36651_of_match, |
|
}, |
|
.probe = cm36651_probe, |
|
.remove = cm36651_remove, |
|
.id_table = cm36651_id, |
|
}; |
|
|
|
module_i2c_driver(cm36651_driver); |
|
|
|
MODULE_AUTHOR("Beomho Seo <[email protected]>"); |
|
MODULE_DESCRIPTION("CM36651 proximity/ambient light sensor driver"); |
|
MODULE_LICENSE("GPL v2");
|
|
|