mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-26 09:45:08 +07:00
d3be83244c
This patch applies the semantic patch: @@ expression I, P, SP; @@ I = devm_iio_device_alloc(P, SP); ... - I->dev.parent = P; It updates 302 files and does 307 deletions. This semantic patch also removes some comments like '/* Establish that the iio_dev is a child of the i2c device */' But this is is only done in case where the block is left empty. The patch does not seem to cover all cases. It looks like in some cases a different variable is used in some cases to assign the parent, but it points to the same reference. In other cases, the block covered by ... may be just too big to be covered by the semantic patch. However, this looks pretty good as well, as it does cover a big bulk of the drivers that should remove the parent assignment. Signed-off-by: Alexandru Ardelean <alexandru.ardelean@analog.com> Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
525 lines
12 KiB
C
525 lines
12 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* apds9300.c - IIO driver for Avago APDS9300 ambient light sensor
|
|
*
|
|
* Copyright 2013 Oleksandr Kravchenko <o.v.kravchenko@globallogic.com>
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/pm.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/err.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/iio/iio.h>
|
|
#include <linux/iio/sysfs.h>
|
|
#include <linux/iio/events.h>
|
|
|
|
#define APDS9300_DRV_NAME "apds9300"
|
|
#define APDS9300_IRQ_NAME "apds9300_event"
|
|
|
|
/* Command register bits */
|
|
#define APDS9300_CMD BIT(7) /* Select command register. Must write as 1 */
|
|
#define APDS9300_WORD BIT(5) /* I2C write/read: if 1 word, if 0 byte */
|
|
#define APDS9300_CLEAR BIT(6) /* Interrupt clear. Clears pending interrupt */
|
|
|
|
/* Register set */
|
|
#define APDS9300_CONTROL 0x00 /* Control of basic functions */
|
|
#define APDS9300_THRESHLOWLOW 0x02 /* Low byte of low interrupt threshold */
|
|
#define APDS9300_THRESHHIGHLOW 0x04 /* Low byte of high interrupt threshold */
|
|
#define APDS9300_INTERRUPT 0x06 /* Interrupt control */
|
|
#define APDS9300_DATA0LOW 0x0c /* Low byte of ADC channel 0 */
|
|
#define APDS9300_DATA1LOW 0x0e /* Low byte of ADC channel 1 */
|
|
|
|
/* Power on/off value for APDS9300_CONTROL register */
|
|
#define APDS9300_POWER_ON 0x03
|
|
#define APDS9300_POWER_OFF 0x00
|
|
|
|
/* Interrupts */
|
|
#define APDS9300_INTR_ENABLE 0x10
|
|
/* Interrupt Persist Function: Any value outside of threshold range */
|
|
#define APDS9300_THRESH_INTR 0x01
|
|
|
|
#define APDS9300_THRESH_MAX 0xffff /* Max threshold value */
|
|
|
|
struct apds9300_data {
|
|
struct i2c_client *client;
|
|
struct mutex mutex;
|
|
int power_state;
|
|
int thresh_low;
|
|
int thresh_hi;
|
|
int intr_en;
|
|
};
|
|
|
|
/* Lux calculation */
|
|
|
|
/* Calculated values 1000 * (CH1/CH0)^1.4 for CH1/CH0 from 0 to 0.52 */
|
|
static const u16 apds9300_lux_ratio[] = {
|
|
0, 2, 4, 7, 11, 15, 19, 24, 29, 34, 40, 45, 51, 57, 64, 70, 77, 84, 91,
|
|
98, 105, 112, 120, 128, 136, 144, 152, 160, 168, 177, 185, 194, 203,
|
|
212, 221, 230, 239, 249, 258, 268, 277, 287, 297, 307, 317, 327, 337,
|
|
347, 358, 368, 379, 390, 400,
|
|
};
|
|
|
|
static unsigned long apds9300_calculate_lux(u16 ch0, u16 ch1)
|
|
{
|
|
unsigned long lux, tmp;
|
|
|
|
/* avoid division by zero */
|
|
if (ch0 == 0)
|
|
return 0;
|
|
|
|
tmp = DIV_ROUND_UP(ch1 * 100, ch0);
|
|
if (tmp <= 52) {
|
|
lux = 3150 * ch0 - (unsigned long)DIV_ROUND_UP_ULL(ch0
|
|
* apds9300_lux_ratio[tmp] * 5930ull, 1000);
|
|
} else if (tmp <= 65) {
|
|
lux = 2290 * ch0 - 2910 * ch1;
|
|
} else if (tmp <= 80) {
|
|
lux = 1570 * ch0 - 1800 * ch1;
|
|
} else if (tmp <= 130) {
|
|
lux = 338 * ch0 - 260 * ch1;
|
|
} else {
|
|
lux = 0;
|
|
}
|
|
|
|
return lux / 100000;
|
|
}
|
|
|
|
static int apds9300_get_adc_val(struct apds9300_data *data, int adc_number)
|
|
{
|
|
int ret;
|
|
u8 flags = APDS9300_CMD | APDS9300_WORD;
|
|
|
|
if (!data->power_state)
|
|
return -EBUSY;
|
|
|
|
/* Select ADC0 or ADC1 data register */
|
|
flags |= adc_number ? APDS9300_DATA1LOW : APDS9300_DATA0LOW;
|
|
|
|
ret = i2c_smbus_read_word_data(data->client, flags);
|
|
if (ret < 0)
|
|
dev_err(&data->client->dev,
|
|
"failed to read ADC%d value\n", adc_number);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int apds9300_set_thresh_low(struct apds9300_data *data, int value)
|
|
{
|
|
int ret;
|
|
|
|
if (!data->power_state)
|
|
return -EBUSY;
|
|
|
|
if (value > APDS9300_THRESH_MAX)
|
|
return -EINVAL;
|
|
|
|
ret = i2c_smbus_write_word_data(data->client, APDS9300_THRESHLOWLOW
|
|
| APDS9300_CMD | APDS9300_WORD, value);
|
|
if (ret) {
|
|
dev_err(&data->client->dev, "failed to set thresh_low\n");
|
|
return ret;
|
|
}
|
|
data->thresh_low = value;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int apds9300_set_thresh_hi(struct apds9300_data *data, int value)
|
|
{
|
|
int ret;
|
|
|
|
if (!data->power_state)
|
|
return -EBUSY;
|
|
|
|
if (value > APDS9300_THRESH_MAX)
|
|
return -EINVAL;
|
|
|
|
ret = i2c_smbus_write_word_data(data->client, APDS9300_THRESHHIGHLOW
|
|
| APDS9300_CMD | APDS9300_WORD, value);
|
|
if (ret) {
|
|
dev_err(&data->client->dev, "failed to set thresh_hi\n");
|
|
return ret;
|
|
}
|
|
data->thresh_hi = value;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int apds9300_set_intr_state(struct apds9300_data *data, int state)
|
|
{
|
|
int ret;
|
|
u8 cmd;
|
|
|
|
if (!data->power_state)
|
|
return -EBUSY;
|
|
|
|
cmd = state ? APDS9300_INTR_ENABLE | APDS9300_THRESH_INTR : 0x00;
|
|
ret = i2c_smbus_write_byte_data(data->client,
|
|
APDS9300_INTERRUPT | APDS9300_CMD, cmd);
|
|
if (ret) {
|
|
dev_err(&data->client->dev,
|
|
"failed to set interrupt state %d\n", state);
|
|
return ret;
|
|
}
|
|
data->intr_en = state;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int apds9300_set_power_state(struct apds9300_data *data, int state)
|
|
{
|
|
int ret;
|
|
u8 cmd;
|
|
|
|
cmd = state ? APDS9300_POWER_ON : APDS9300_POWER_OFF;
|
|
ret = i2c_smbus_write_byte_data(data->client,
|
|
APDS9300_CONTROL | APDS9300_CMD, cmd);
|
|
if (ret) {
|
|
dev_err(&data->client->dev,
|
|
"failed to set power state %d\n", state);
|
|
return ret;
|
|
}
|
|
data->power_state = state;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void apds9300_clear_intr(struct apds9300_data *data)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_smbus_write_byte(data->client, APDS9300_CLEAR | APDS9300_CMD);
|
|
if (ret < 0)
|
|
dev_err(&data->client->dev, "failed to clear interrupt\n");
|
|
}
|
|
|
|
static int apds9300_chip_init(struct apds9300_data *data)
|
|
{
|
|
int ret;
|
|
|
|
/* Need to set power off to ensure that the chip is off */
|
|
ret = apds9300_set_power_state(data, 0);
|
|
if (ret < 0)
|
|
goto err;
|
|
/*
|
|
* Probe the chip. To do so we try to power up the device and then to
|
|
* read back the 0x03 code
|
|
*/
|
|
ret = apds9300_set_power_state(data, 1);
|
|
if (ret < 0)
|
|
goto err;
|
|
ret = i2c_smbus_read_byte_data(data->client,
|
|
APDS9300_CONTROL | APDS9300_CMD);
|
|
if (ret != APDS9300_POWER_ON) {
|
|
ret = -ENODEV;
|
|
goto err;
|
|
}
|
|
/*
|
|
* Disable interrupt to ensure thai it is doesn't enable
|
|
* i.e. after device soft reset
|
|
*/
|
|
ret = apds9300_set_intr_state(data, 0);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
return 0;
|
|
|
|
err:
|
|
dev_err(&data->client->dev, "failed to init the chip\n");
|
|
return ret;
|
|
}
|
|
|
|
static int apds9300_read_raw(struct iio_dev *indio_dev,
|
|
struct iio_chan_spec const *chan, int *val, int *val2,
|
|
long mask)
|
|
{
|
|
int ch0, ch1, ret = -EINVAL;
|
|
struct apds9300_data *data = iio_priv(indio_dev);
|
|
|
|
mutex_lock(&data->mutex);
|
|
switch (chan->type) {
|
|
case IIO_LIGHT:
|
|
ch0 = apds9300_get_adc_val(data, 0);
|
|
if (ch0 < 0) {
|
|
ret = ch0;
|
|
break;
|
|
}
|
|
ch1 = apds9300_get_adc_val(data, 1);
|
|
if (ch1 < 0) {
|
|
ret = ch1;
|
|
break;
|
|
}
|
|
*val = apds9300_calculate_lux(ch0, ch1);
|
|
ret = IIO_VAL_INT;
|
|
break;
|
|
case IIO_INTENSITY:
|
|
ret = apds9300_get_adc_val(data, chan->channel);
|
|
if (ret < 0)
|
|
break;
|
|
*val = ret;
|
|
ret = IIO_VAL_INT;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
mutex_unlock(&data->mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int apds9300_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 apds9300_data *data = iio_priv(indio_dev);
|
|
|
|
switch (dir) {
|
|
case IIO_EV_DIR_RISING:
|
|
*val = data->thresh_hi;
|
|
break;
|
|
case IIO_EV_DIR_FALLING:
|
|
*val = data->thresh_low;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
return IIO_VAL_INT;
|
|
}
|
|
|
|
static int apds9300_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 apds9300_data *data = iio_priv(indio_dev);
|
|
int ret;
|
|
|
|
mutex_lock(&data->mutex);
|
|
if (dir == IIO_EV_DIR_RISING)
|
|
ret = apds9300_set_thresh_hi(data, val);
|
|
else
|
|
ret = apds9300_set_thresh_low(data, val);
|
|
mutex_unlock(&data->mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int apds9300_read_interrupt_config(struct iio_dev *indio_dev,
|
|
const struct iio_chan_spec *chan,
|
|
enum iio_event_type type,
|
|
enum iio_event_direction dir)
|
|
{
|
|
struct apds9300_data *data = iio_priv(indio_dev);
|
|
|
|
return data->intr_en;
|
|
}
|
|
|
|
static int apds9300_write_interrupt_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 apds9300_data *data = iio_priv(indio_dev);
|
|
int ret;
|
|
|
|
mutex_lock(&data->mutex);
|
|
ret = apds9300_set_intr_state(data, state);
|
|
mutex_unlock(&data->mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static const struct iio_info apds9300_info_no_irq = {
|
|
.read_raw = apds9300_read_raw,
|
|
};
|
|
|
|
static const struct iio_info apds9300_info = {
|
|
.read_raw = apds9300_read_raw,
|
|
.read_event_value = apds9300_read_thresh,
|
|
.write_event_value = apds9300_write_thresh,
|
|
.read_event_config = apds9300_read_interrupt_config,
|
|
.write_event_config = apds9300_write_interrupt_config,
|
|
};
|
|
|
|
static const struct iio_event_spec apds9300_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_chan_spec apds9300_channels[] = {
|
|
{
|
|
.type = IIO_LIGHT,
|
|
.channel = 0,
|
|
.indexed = true,
|
|
.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
|
|
}, {
|
|
.type = IIO_INTENSITY,
|
|
.channel = 0,
|
|
.channel2 = IIO_MOD_LIGHT_BOTH,
|
|
.indexed = true,
|
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
|
|
.event_spec = apds9300_event_spec,
|
|
.num_event_specs = ARRAY_SIZE(apds9300_event_spec),
|
|
}, {
|
|
.type = IIO_INTENSITY,
|
|
.channel = 1,
|
|
.channel2 = IIO_MOD_LIGHT_IR,
|
|
.indexed = true,
|
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
|
|
},
|
|
};
|
|
|
|
static irqreturn_t apds9300_interrupt_handler(int irq, void *private)
|
|
{
|
|
struct iio_dev *dev_info = private;
|
|
struct apds9300_data *data = iio_priv(dev_info);
|
|
|
|
iio_push_event(dev_info,
|
|
IIO_UNMOD_EVENT_CODE(IIO_INTENSITY, 0,
|
|
IIO_EV_TYPE_THRESH,
|
|
IIO_EV_DIR_EITHER),
|
|
iio_get_time_ns(dev_info));
|
|
|
|
apds9300_clear_intr(data);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int apds9300_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
struct apds9300_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;
|
|
|
|
ret = apds9300_chip_init(data);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
mutex_init(&data->mutex);
|
|
|
|
indio_dev->channels = apds9300_channels;
|
|
indio_dev->num_channels = ARRAY_SIZE(apds9300_channels);
|
|
indio_dev->name = APDS9300_DRV_NAME;
|
|
indio_dev->modes = INDIO_DIRECT_MODE;
|
|
|
|
if (client->irq)
|
|
indio_dev->info = &apds9300_info;
|
|
else
|
|
indio_dev->info = &apds9300_info_no_irq;
|
|
|
|
if (client->irq) {
|
|
ret = devm_request_threaded_irq(&client->dev, client->irq,
|
|
NULL, apds9300_interrupt_handler,
|
|
IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
|
|
APDS9300_IRQ_NAME, indio_dev);
|
|
if (ret) {
|
|
dev_err(&client->dev, "irq request error %d\n", -ret);
|
|
goto err;
|
|
}
|
|
}
|
|
|
|
ret = iio_device_register(indio_dev);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
return 0;
|
|
|
|
err:
|
|
/* Ensure that power off in case of error */
|
|
apds9300_set_power_state(data, 0);
|
|
return ret;
|
|
}
|
|
|
|
static int apds9300_remove(struct i2c_client *client)
|
|
{
|
|
struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
|
struct apds9300_data *data = iio_priv(indio_dev);
|
|
|
|
iio_device_unregister(indio_dev);
|
|
|
|
/* Ensure that power off and interrupts are disabled */
|
|
apds9300_set_intr_state(data, 0);
|
|
apds9300_set_power_state(data, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
static int apds9300_suspend(struct device *dev)
|
|
{
|
|
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
|
struct apds9300_data *data = iio_priv(indio_dev);
|
|
int ret;
|
|
|
|
mutex_lock(&data->mutex);
|
|
ret = apds9300_set_power_state(data, 0);
|
|
mutex_unlock(&data->mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int apds9300_resume(struct device *dev)
|
|
{
|
|
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
|
struct apds9300_data *data = iio_priv(indio_dev);
|
|
int ret;
|
|
|
|
mutex_lock(&data->mutex);
|
|
ret = apds9300_set_power_state(data, 1);
|
|
mutex_unlock(&data->mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static SIMPLE_DEV_PM_OPS(apds9300_pm_ops, apds9300_suspend, apds9300_resume);
|
|
#define APDS9300_PM_OPS (&apds9300_pm_ops)
|
|
#else
|
|
#define APDS9300_PM_OPS NULL
|
|
#endif
|
|
|
|
static const struct i2c_device_id apds9300_id[] = {
|
|
{ APDS9300_DRV_NAME, 0 },
|
|
{ }
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(i2c, apds9300_id);
|
|
|
|
static struct i2c_driver apds9300_driver = {
|
|
.driver = {
|
|
.name = APDS9300_DRV_NAME,
|
|
.pm = APDS9300_PM_OPS,
|
|
},
|
|
.probe = apds9300_probe,
|
|
.remove = apds9300_remove,
|
|
.id_table = apds9300_id,
|
|
};
|
|
|
|
module_i2c_driver(apds9300_driver);
|
|
|
|
MODULE_AUTHOR("Kravchenko Oleksandr <o.v.kravchenko@globallogic.com>");
|
|
MODULE_AUTHOR("GlobalLogic inc.");
|
|
MODULE_DESCRIPTION("APDS9300 ambient light photo sensor driver");
|
|
MODULE_LICENSE("GPL");
|