mirror of
https://github.com/hardkernel/linux.git
synced 2026-06-07 19:30:30 +09:00
iio: light: Add initial support for Ultra Capteur UCS12CM0
The UCS12CM0 is a color-based light to digital converter which combines photodiodes, current amplifiers, analog circuit and digital signal processor. Features: * I2C interface (Fast Speed Mode at 400kHz/s) * Supply voltage range from 2.4V to 3.6V * Operating temperature from -40°C to +85°C * Package level trimming * Power on reset & brown out reset * Waiting time function for reducing power consumption * R, G, B, W and IR five channel parallel output * Fluorescent light flicker immunity * Selectable analog gain * Selectable resolution (up to 16-bit) * High sensitivity in low illumination * Wide detect range in high illumination * High accuracy of LUX & CCT Signed-off-by: Jason Zhang <jason.zhang@rock-chips.com> Change-Id: Id960065ae8ebf9e6d23f7a4da9143add49db3d59
This commit is contained in:
@@ -517,6 +517,16 @@ config TSL4531
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called tsl4531.
|
||||
|
||||
config UCS12CM0
|
||||
tristate "UCS12CM0 illuminance and correlated color temperature sensor"
|
||||
depends on I2C
|
||||
help
|
||||
Say Y here if you want to build a driver for the Ultra Capteur
|
||||
UCS12CM0 illuminance and correlated color temperature sensor.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called ucs12cm0.
|
||||
|
||||
config US5182D
|
||||
tristate "UPISEMI light and proximity sensor"
|
||||
depends on I2C
|
||||
|
||||
@@ -50,6 +50,7 @@ obj-$(CONFIG_TCS3472) += tcs3472.o
|
||||
obj-$(CONFIG_TSL2583) += tsl2583.o
|
||||
obj-$(CONFIG_TSL2772) += tsl2772.o
|
||||
obj-$(CONFIG_TSL4531) += tsl4531.o
|
||||
obj-$(CONFIG_UCS12CM0) += ucs12cm0.o
|
||||
obj-$(CONFIG_US5182D) += us5182d.o
|
||||
obj-$(CONFIG_VCNL4000) += vcnl4000.o
|
||||
obj-$(CONFIG_VCNL4035) += vcnl4035.o
|
||||
|
||||
627
drivers/iio/light/ucs12cm0.c
Normal file
627
drivers/iio/light/ucs12cm0.c
Normal file
@@ -0,0 +1,627 @@
|
||||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* UCS12CM0 illuminance and correlated color temperature sensor
|
||||
*
|
||||
* Copyright (C) 2022-2025 ROCKCHIP.
|
||||
* Author: Jason Zhang <jason.zhang@rock-chips.com>
|
||||
*
|
||||
* IIO driver for UCS12CM0 (7-bit I2C slave address 0x38)
|
||||
*/
|
||||
#include <linux/module.h>
|
||||
#include <linux/mod_devicetable.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/util_macros.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/iio/sysfs.h>
|
||||
#include <linux/gpio.h>
|
||||
#include <linux/of_gpio.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/iio/triggered_buffer.h>
|
||||
#include <linux/iio/kfifo_buf.h>
|
||||
#include <linux/iio/buffer.h>
|
||||
|
||||
#define UCS12CM0_SYS_CTRL 0x00
|
||||
#define UCS12CM0_INT_CTRL 0x01
|
||||
#define UCS12CM0_INT_FLAG 0x02
|
||||
#define UCS12CM0_WAIT 0x03
|
||||
#define UCS12CM0_ALS_GAIN 0x04
|
||||
#define UCS12CM0_ALS_TIME 0x05
|
||||
#define UCS12CM0_PS_LED 0x06
|
||||
#define UCS12CM0_PS_GAIN 0x07
|
||||
#define UCS12CM0_PS_PULSE 0x08
|
||||
#define UCS12CM0_PS_TIME 0x09
|
||||
#define UCS12CM0_PS_AVERAGE 0x0a
|
||||
#define UCS12CM0_PS_PERSIST 0x0b
|
||||
#define UCS12CM0_ALS_THDLL 0x0c
|
||||
#define UCS12CM0_ALS_THDLH 0x0d
|
||||
#define UCS12CM0_ALS_THDHL 0x0e
|
||||
#define UCS12CM0_ALS_THDHH 0x0f
|
||||
#define UCS12CM0_PS_THDLL 0x10
|
||||
#define UCS12CM0_PS_THDLH 0x11
|
||||
#define UCS12CM0_PS_THDHL 0x12
|
||||
#define UCS12CM0_PS_THDHH 0x13
|
||||
#define UCS12CM0_PS_OFFSET_L 0x14
|
||||
#define UCS12CM0_PS_OFFSET_H 0x15
|
||||
#define UCS12CM0_PS_DATA_L 0x18
|
||||
#define UCS12CM0_PS_DATA_H 0x19
|
||||
#define UCS12CM0_CLS_R_DATA_L 0x1c
|
||||
#define UCS12CM0_CLS_R_DATA_H 0x1d
|
||||
#define UCS12CM0_CLS_G_DATA_L 0x1e
|
||||
#define UCS12CM0_CLS_G_DATA_H 0x1f
|
||||
#define UCS12CM0_CLS_B_DATA_L 0x20
|
||||
#define UCS12CM0_CLS_B_DATA_H 0x21
|
||||
#define UCS12CM0_CLS_W_DATA_L 0x22
|
||||
#define UCS12CM0_CLS_W_DATA_H 0x23
|
||||
#define UCS12CM0_IR_DATA_L 0x24
|
||||
#define UCS12CM0_IR_DATA_H 0x25
|
||||
#define UCS12CM0_ID 0xbc
|
||||
|
||||
/* bis of the SYS_CTRL register */
|
||||
#define UCS12CM0_EN_CLS BIT(0) /* Enables CLS function */
|
||||
#define UCS12CM0_EN_IR BIT(1) /* Enables IR function */
|
||||
#define UCS12CM0_EN_FRST BIT(5) /* Enables Brown Out Reset circuit */
|
||||
#define UCS12CM0_EN_WAIT BIT(6) /* Waiting time will be inserted between two
|
||||
* measurements
|
||||
*/
|
||||
#define UCS12CM0_SWRST BIT(7) /* Software reset. Reset all register to
|
||||
* default value
|
||||
*/
|
||||
|
||||
/* bis of the INT_FLAG register */
|
||||
#define UCS12CM0_INT_CLS BIT(0) /* CLS Interrupt flag. It correlation with
|
||||
* sensor data and CLS high/low threshold.
|
||||
* Write zero to clear the flag.
|
||||
*/
|
||||
#define UCS12CM0_INT_DATA BIT(6)/* It shows if any data is invalid after
|
||||
* completion of each conversion cycle. This
|
||||
* bit is read-only.
|
||||
*/
|
||||
#define UCS12CM0_INT_POR BIT(7) /* Power-On-Reset Interrupt flag trigger the
|
||||
* INT pin when the flag sets to one. Write
|
||||
* zero to clear the flag.
|
||||
*/
|
||||
|
||||
#define UCS12CM0_CCT_CHANNEL(_si, _mod) { \
|
||||
.type = IIO_CCT, \
|
||||
.address = _si, \
|
||||
.channel2 = _mod, \
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
|
||||
BIT(IIO_CHAN_INFO_SCALE) | \
|
||||
BIT(IIO_CHAN_INFO_AVERAGE_RAW), \
|
||||
.modified = 1, \
|
||||
.scan_index = _si, \
|
||||
.scan_type = { \
|
||||
.sign = 'u', \
|
||||
.realbits = 16, \
|
||||
.storagebits = 16, \
|
||||
}, \
|
||||
}
|
||||
|
||||
enum {
|
||||
UCS12CM0_CCT_READ,
|
||||
UCS12CM0_CCT_GREEN,
|
||||
UCS12CM0_CCT_BLUE,
|
||||
UCS12CM0_CCT_WHITE,
|
||||
UCS12CM0_CCT_ALL
|
||||
};
|
||||
|
||||
struct ucs12cm0_scan {
|
||||
u16 chans[4];
|
||||
/* Ensure natural alignment of timestamp */
|
||||
s64 timestamp;
|
||||
};
|
||||
|
||||
struct ucs12cm0_data {
|
||||
struct i2c_client *client;
|
||||
int calibrated;
|
||||
u32 raw[UCS12CM0_CCT_ALL];
|
||||
u32 average[UCS12CM0_CCT_ALL];
|
||||
};
|
||||
|
||||
static const u8 ucs12cm0_chan_regs[UCS12CM0_CCT_ALL] = {
|
||||
UCS12CM0_CLS_R_DATA_L,
|
||||
UCS12CM0_CLS_G_DATA_L,
|
||||
UCS12CM0_CLS_B_DATA_L,
|
||||
UCS12CM0_CLS_W_DATA_L
|
||||
};
|
||||
|
||||
static const struct iio_chan_spec ucs12cm0_channels[] = {
|
||||
UCS12CM0_CCT_CHANNEL(UCS12CM0_CCT_READ, IIO_MOD_LIGHT_RED),
|
||||
UCS12CM0_CCT_CHANNEL(UCS12CM0_CCT_GREEN, IIO_MOD_LIGHT_GREEN),
|
||||
UCS12CM0_CCT_CHANNEL(UCS12CM0_CCT_BLUE, IIO_MOD_LIGHT_BLUE),
|
||||
UCS12CM0_CCT_CHANNEL(UCS12CM0_CCT_WHITE, IIO_MOD_LIGHT_CLEAR),
|
||||
IIO_CHAN_SOFT_TIMESTAMP(4),
|
||||
};
|
||||
|
||||
static int ucs12cm0_read(struct i2c_client *client, u8 cmd, void *databuf,
|
||||
u8 len)
|
||||
{
|
||||
struct i2c_msg msgs[2] = {
|
||||
{
|
||||
.addr = client->addr,
|
||||
.len = sizeof(cmd),
|
||||
.buf = (u8 *) &cmd
|
||||
}, {
|
||||
.addr = client->addr,
|
||||
.len = len,
|
||||
.buf = databuf,
|
||||
.flags = I2C_M_RD
|
||||
}
|
||||
};
|
||||
int ret;
|
||||
|
||||
ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
|
||||
if (ret < 0)
|
||||
dev_err(&client->dev, "failed reading register 0x%04x\n", cmd);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int ucs12cm0_read_byte(struct i2c_client *client, u8 cmd)
|
||||
{
|
||||
u8 data;
|
||||
int ret;
|
||||
|
||||
ret = ucs12cm0_read(client, cmd, &data, sizeof(data));
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return data;
|
||||
}
|
||||
|
||||
static int ucs12cm0_read_word(struct i2c_client *client, u8 cmd)
|
||||
{
|
||||
__le16 data;
|
||||
int ret;
|
||||
|
||||
ret = ucs12cm0_read(client, cmd, &data, sizeof(data));
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return le16_to_cpu(data);
|
||||
}
|
||||
|
||||
static int ucs12cm0_read_average(struct ucs12cm0_data *data, int chan)
|
||||
{
|
||||
u8 cmd;
|
||||
int sum = 0;
|
||||
int average;
|
||||
int i;
|
||||
int ret;
|
||||
|
||||
cmd = ucs12cm0_chan_regs[chan];
|
||||
for (i = 0; i < 10; ++i) {
|
||||
ret = ucs12cm0_read_word(data->client, cmd);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
sum += ret;
|
||||
}
|
||||
|
||||
average = sum / 10;
|
||||
|
||||
return average;
|
||||
}
|
||||
|
||||
static int ucs12cm0_write_byte(struct i2c_client *client, u8 cmd, u8 val)
|
||||
{
|
||||
u8 buf[2];
|
||||
struct i2c_msg msgs[1] = {
|
||||
{
|
||||
.addr = client->addr,
|
||||
.len = sizeof(buf),
|
||||
.buf = (u8 *) &buf
|
||||
}
|
||||
};
|
||||
int ret;
|
||||
|
||||
buf[0] = cmd;
|
||||
buf[1] = val;
|
||||
|
||||
ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "failed writing register 0x%04x\n", cmd);
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ucs12cm0_read_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
int *val, int *val2, long mask)
|
||||
{
|
||||
struct ucs12cm0_data *data = iio_priv(indio_dev);
|
||||
u8 cmd;
|
||||
int ret;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
cmd = ucs12cm0_chan_regs[chan->address];
|
||||
ret = ucs12cm0_read_word(data->client, cmd);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
*val = ret;
|
||||
|
||||
return IIO_VAL_INT;
|
||||
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
if (data->calibrated) {
|
||||
*val = data->average[chan->address];
|
||||
*val2 = data->raw[chan->address];
|
||||
} else {
|
||||
*val = 1;
|
||||
*val2 = 1;
|
||||
}
|
||||
|
||||
return IIO_VAL_FRACTIONAL;
|
||||
|
||||
case IIO_CHAN_INFO_AVERAGE_RAW:
|
||||
*val = data->average[chan->address];
|
||||
|
||||
return IIO_VAL_INT;
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static int ucs12cm0_write_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
int val, int val2, long mask)
|
||||
{
|
||||
struct ucs12cm0_data *data = iio_priv(indio_dev);
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
data->raw[chan->address] = val;
|
||||
|
||||
return 0;
|
||||
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
return -EPERM;
|
||||
|
||||
case IIO_CHAN_INFO_AVERAGE_RAW:
|
||||
return -EPERM;
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static int ucs12cm0_write_raw_get_fmt(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
long mask)
|
||||
{
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
return IIO_VAL_INT;
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
return IIO_VAL_FRACTIONAL;
|
||||
case IIO_CHAN_INFO_AVERAGE_RAW:
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static ssize_t start_calibrating_store(struct device *dev,
|
||||
struct device_attribute *attr,
|
||||
const char *buf, size_t len)
|
||||
{
|
||||
struct iio_dev *indio_dev = dev_to_iio_dev(dev);
|
||||
struct ucs12cm0_data *data = iio_priv(indio_dev);
|
||||
int i;
|
||||
long chans = 0;
|
||||
int ret;
|
||||
|
||||
if (!strncmp(buf, "red", 3)) {
|
||||
set_bit(UCS12CM0_CCT_READ, &chans);
|
||||
} else if (!strncmp(buf, "green", 5)) {
|
||||
set_bit(UCS12CM0_CCT_GREEN, &chans);
|
||||
} else if (!strncmp(buf, "blue", 4)) {
|
||||
set_bit(UCS12CM0_CCT_BLUE, &chans);
|
||||
} else if (!strncmp(buf, "white", 5)) {
|
||||
set_bit(UCS12CM0_CCT_WHITE, &chans);
|
||||
} else if (!strncmp(buf, "all", 3)) {
|
||||
set_bit(UCS12CM0_CCT_READ, &chans);
|
||||
set_bit(UCS12CM0_CCT_GREEN, &chans);
|
||||
set_bit(UCS12CM0_CCT_BLUE, &chans);
|
||||
set_bit(UCS12CM0_CCT_WHITE, &chans);
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
for_each_set_bit(i, &chans, UCS12CM0_CCT_ALL) {
|
||||
if (!data->raw[i])
|
||||
return -EPERM;
|
||||
|
||||
dev_info(&data->client->dev, "raw = %d\n",
|
||||
data->raw[i]);
|
||||
}
|
||||
|
||||
for_each_set_bit(i, &chans, UCS12CM0_CCT_ALL) {
|
||||
ret = ucs12cm0_read_average(data, i);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
else if (ret == 0)
|
||||
return -EINVAL;
|
||||
|
||||
data->average[i] = ret;
|
||||
|
||||
dev_info(&data->client->dev, "average = %d\n",
|
||||
data->average[i]);
|
||||
}
|
||||
|
||||
/*
|
||||
* TODO: store the calibration data in the ROM because UCS12CM0
|
||||
* doesn't have any rom-related register.
|
||||
*/
|
||||
data->calibrated = 1;
|
||||
|
||||
return len;
|
||||
}
|
||||
|
||||
static IIO_DEVICE_ATTR_WO(start_calibrating, 0);
|
||||
|
||||
static struct attribute *ucs12cm0_attributes[] = {
|
||||
&iio_dev_attr_start_calibrating.dev_attr.attr,
|
||||
NULL
|
||||
};
|
||||
|
||||
static const struct attribute_group ucs12cm0_attribute_group = {
|
||||
.attrs = ucs12cm0_attributes,
|
||||
};
|
||||
|
||||
static const struct iio_info ucs12cm0_info = {
|
||||
.read_raw = ucs12cm0_read_raw,
|
||||
.write_raw = ucs12cm0_write_raw,
|
||||
.write_raw_get_fmt = ucs12cm0_write_raw_get_fmt,
|
||||
.attrs = &ucs12cm0_attribute_group,
|
||||
};
|
||||
|
||||
/**
|
||||
* ucs12cm0_active - enable or disable the CLS
|
||||
* @client: the i2c client used by the driver.
|
||||
* @enable: enable/disable the CLS of ucs12cm0.
|
||||
*
|
||||
* Returns negative errno, else the number of messages executed.
|
||||
*/
|
||||
static int ucs12cm0_active(struct i2c_client *client, int enable)
|
||||
{
|
||||
u8 val;
|
||||
int ret = 0;
|
||||
|
||||
ret = ucs12cm0_read_byte(client, UCS12CM0_SYS_CTRL);
|
||||
if (ret < 0)
|
||||
goto out;
|
||||
|
||||
val = ret;
|
||||
if (enable)
|
||||
val |= UCS12CM0_EN_CLS;
|
||||
else
|
||||
val &= ~UCS12CM0_EN_CLS;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_SYS_CTRL, val);
|
||||
if (ret < 0)
|
||||
dev_err(&client->dev, "Failed to active sensor\n");
|
||||
|
||||
out:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int ucs12cm0_buffer_postenable(struct iio_dev *indio_dev)
|
||||
{
|
||||
struct ucs12cm0_data *data = iio_priv(indio_dev);
|
||||
|
||||
return ucs12cm0_active(data->client, 1);
|
||||
}
|
||||
|
||||
static int ucs12cm0_buffer_predisable(struct iio_dev *indio_dev)
|
||||
{
|
||||
struct ucs12cm0_data *data = iio_priv(indio_dev);
|
||||
|
||||
return ucs12cm0_active(data->client, 0);
|
||||
}
|
||||
|
||||
static const struct iio_buffer_setup_ops ucs12cm0_buffer_setup_ops = {
|
||||
.postenable = ucs12cm0_buffer_postenable,
|
||||
.predisable = ucs12cm0_buffer_predisable,
|
||||
};
|
||||
|
||||
static int ucs12cm0_init(struct ucs12cm0_data *data)
|
||||
{
|
||||
int ret;
|
||||
struct i2c_client *client = data->client;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_SYS_CTRL, 0x00);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_INT_CTRL, 0x13);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_INT_FLAG, 0x00);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_WAIT, 0x00);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_ALS_GAIN, 0x84);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_ALS_TIME, 0x33);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_PS_LED, 0x00);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_PS_GAIN, 0x00);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_PS_PULSE, 0x00);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_PS_TIME, 0x0f);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_PS_AVERAGE, 0x0f);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_PS_PERSIST, 0x00);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_PS_OFFSET_L, 0x0000);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_ALS_THDHL, 0xff);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_ALS_THDHH, 0xff);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_ALS_THDLL, 0x00);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
ret = ucs12cm0_write_byte(client, UCS12CM0_ALS_THDLH, 0x00);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
return 0;
|
||||
|
||||
err:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static irqreturn_t ucs12cm0_interrupt_handler(int irq, void *priv)
|
||||
{
|
||||
struct iio_dev *indio_dev = priv;
|
||||
struct ucs12cm0_data *data = iio_priv(indio_dev);
|
||||
struct i2c_client *client = data->client;
|
||||
struct ucs12cm0_scan scan;
|
||||
int ret;
|
||||
|
||||
ret = ucs12cm0_read_byte(client, UCS12CM0_INT_FLAG);
|
||||
if (ret < 0)
|
||||
goto out;
|
||||
|
||||
if (ret & UCS12CM0_INT_CLS) {
|
||||
if (ucs12cm0_read(client, UCS12CM0_CLS_R_DATA_L, scan.chans,
|
||||
sizeof(scan.chans)) < 0)
|
||||
goto clear_irq;
|
||||
|
||||
iio_push_to_buffers_with_timestamp(indio_dev, &scan,
|
||||
ktime_get_boottime_ns());
|
||||
}
|
||||
|
||||
clear_irq:
|
||||
if (ret & UCS12CM0_INT_CLS) {
|
||||
ret &= ~UCS12CM0_INT_CLS;
|
||||
ucs12cm0_write_byte(client, UCS12CM0_INT_FLAG, ret);
|
||||
}
|
||||
|
||||
if (ret & UCS12CM0_INT_POR) {
|
||||
ret &= ~UCS12CM0_INT_POR;
|
||||
ucs12cm0_write_byte(client, UCS12CM0_INT_FLAG, ret);
|
||||
}
|
||||
|
||||
out:
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static int ucs12cm0_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct ucs12cm0_data *data;
|
||||
struct iio_dev *indio_dev;
|
||||
struct iio_buffer *buffer;
|
||||
int ret;
|
||||
|
||||
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
|
||||
if (!indio_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
buffer = devm_iio_kfifo_allocate(&client->dev);
|
||||
if (!buffer)
|
||||
return -ENOMEM;
|
||||
|
||||
iio_device_attach_buffer(indio_dev, buffer);
|
||||
|
||||
data = iio_priv(indio_dev);
|
||||
i2c_set_clientdata(client, indio_dev);
|
||||
data->client = client;
|
||||
|
||||
indio_dev->info = &ucs12cm0_info;
|
||||
indio_dev->channels = ucs12cm0_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(ucs12cm0_channels);
|
||||
indio_dev->name = "ucs12cm0";
|
||||
indio_dev->modes = (INDIO_DIRECT_MODE | INDIO_BUFFER_SOFTWARE);
|
||||
indio_dev->setup_ops = &ucs12cm0_buffer_setup_ops;
|
||||
|
||||
ret = ucs12cm0_init(data);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (client->irq <= 0) {
|
||||
dev_err(&client->dev, "no valid irq defined\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
ret = devm_request_threaded_irq(&client->dev, client->irq,
|
||||
NULL, ucs12cm0_interrupt_handler,
|
||||
IRQF_TRIGGER_LOW | IRQF_ONESHOT,
|
||||
"ucs12cm0_irq", indio_dev);
|
||||
if (ret) {
|
||||
dev_err(&client->dev, "request irq (%d) failed\n",
|
||||
client->irq);
|
||||
return ret;
|
||||
}
|
||||
|
||||
return devm_iio_device_register(&client->dev, indio_dev);
|
||||
}
|
||||
|
||||
static const struct of_device_id ucs12cm0_of_match[] = {
|
||||
{ .compatible = "ultracapteur,ucs12cm0", },
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, ucs12cm0_of_match);
|
||||
|
||||
static const struct i2c_device_id ucs12cm0_id[] = {
|
||||
{ "ucs12cm0", 0 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, ucs12cm0_id);
|
||||
|
||||
static struct i2c_driver ucs12cm0_driver = {
|
||||
.driver = {
|
||||
.name = "ucs12cm0",
|
||||
.of_match_table = ucs12cm0_of_match,
|
||||
},
|
||||
.probe = ucs12cm0_probe,
|
||||
.id_table = ucs12cm0_id,
|
||||
};
|
||||
|
||||
module_i2c_driver(ucs12cm0_driver);
|
||||
|
||||
MODULE_AUTHOR("Jason Zhang <jason.zhang@rock-chips.com>");
|
||||
MODULE_DESCRIPTION("UCS12CM0 illuminance and correlated color temperature sensor driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
Reference in New Issue
Block a user