brintos

brintos / linux-shallow public Read only

0
0
Text · 8.3 KiB · b176bf4 Raw
348 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * isl29125.c - Support for Intersil ISL29125 RGB light sensor4 *5 * Copyright (c) 2014 Peter Meerwald <pmeerw@pmeerw.net>6 *7 * RGB light sensor with 16-bit channels for red, green, blue);8 * 7-bit I2C slave address 0x449 *10 * TODO: interrupt support, IR compensation, thresholds, 12bit11 */12 13#include <linux/module.h>14#include <linux/i2c.h>15#include <linux/delay.h>16#include <linux/pm.h>17 18#include <linux/iio/iio.h>19#include <linux/iio/sysfs.h>20#include <linux/iio/trigger_consumer.h>21#include <linux/iio/buffer.h>22#include <linux/iio/triggered_buffer.h>23 24#define ISL29125_DRV_NAME "isl29125"25 26#define ISL29125_DEVICE_ID 0x0027#define ISL29125_CONF1 0x0128#define ISL29125_CONF2 0x0229#define ISL29125_CONF3 0x0330#define ISL29125_STATUS 0x0831#define ISL29125_GREEN_DATA 0x0932#define ISL29125_RED_DATA 0x0b33#define ISL29125_BLUE_DATA 0x0d34 35#define ISL29125_ID 0x7d36 37#define ISL29125_MODE_MASK GENMASK(2, 0)38#define ISL29125_MODE_PD 0x039#define ISL29125_MODE_G 0x140#define ISL29125_MODE_R 0x241#define ISL29125_MODE_B 0x342#define ISL29125_MODE_RGB 0x543 44#define ISL29125_SENSING_RANGE_0 5722   /* 375 lux full range */45#define ISL29125_SENSING_RANGE_1 152590 /* 10k lux full range */46 47#define ISL29125_MODE_RANGE BIT(3)48 49#define ISL29125_STATUS_CONV BIT(1)50 51struct isl29125_data {52	struct i2c_client *client;53	u8 conf1;54	/* Ensure timestamp is naturally aligned */55	struct {56		u16 chans[3];57		s64 timestamp __aligned(8);58	} scan;59};60 61#define ISL29125_CHANNEL(_color, _si) { \62	.type = IIO_INTENSITY, \63	.modified = 1, \64	.info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \65	.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \66	.channel2 = IIO_MOD_LIGHT_##_color, \67	.scan_index = _si, \68	.scan_type = { \69		.sign = 'u', \70		.realbits = 16, \71		.storagebits = 16, \72		.endianness = IIO_CPU, \73	}, \74}75 76static const struct iio_chan_spec isl29125_channels[] = {77	ISL29125_CHANNEL(GREEN, 0),78	ISL29125_CHANNEL(RED, 1),79	ISL29125_CHANNEL(BLUE, 2),80	IIO_CHAN_SOFT_TIMESTAMP(3),81};82 83static const struct {84	u8 mode, data;85} isl29125_regs[] = {86	{ISL29125_MODE_G, ISL29125_GREEN_DATA},87	{ISL29125_MODE_R, ISL29125_RED_DATA},88	{ISL29125_MODE_B, ISL29125_BLUE_DATA},89};90 91static int isl29125_read_data(struct isl29125_data *data, int si)92{93	int tries = 5;94	int ret;95 96	ret = i2c_smbus_write_byte_data(data->client, ISL29125_CONF1,97		data->conf1 | isl29125_regs[si].mode);98	if (ret < 0)99		return ret;100 101	msleep(101);102 103	while (tries--) {104		ret = i2c_smbus_read_byte_data(data->client, ISL29125_STATUS);105		if (ret < 0)106			goto fail;107		if (ret & ISL29125_STATUS_CONV)108			break;109		msleep(20);110	}111 112	if (tries < 0) {113		dev_err(&data->client->dev, "data not ready\n");114		ret = -EIO;115		goto fail;116	}117 118	ret = i2c_smbus_read_word_data(data->client, isl29125_regs[si].data);119 120fail:121	i2c_smbus_write_byte_data(data->client, ISL29125_CONF1, data->conf1);122	return ret;123}124 125static int isl29125_read_raw(struct iio_dev *indio_dev,126			   struct iio_chan_spec const *chan,127			   int *val, int *val2, long mask)128{129	struct isl29125_data *data = iio_priv(indio_dev);130	int ret;131 132	switch (mask) {133	case IIO_CHAN_INFO_RAW:134		ret = iio_device_claim_direct_mode(indio_dev);135		if (ret)136			return ret;137		ret = isl29125_read_data(data, chan->scan_index);138		iio_device_release_direct_mode(indio_dev);139		if (ret < 0)140			return ret;141		*val = ret;142		return IIO_VAL_INT;143	case IIO_CHAN_INFO_SCALE:144		*val = 0;145		if (data->conf1 & ISL29125_MODE_RANGE)146			*val2 = ISL29125_SENSING_RANGE_1; /*10k lux full range*/147		else148			*val2 = ISL29125_SENSING_RANGE_0; /*375 lux full range*/149		return IIO_VAL_INT_PLUS_MICRO;150	}151	return -EINVAL;152}153 154static int isl29125_write_raw(struct iio_dev *indio_dev,155			       struct iio_chan_spec const *chan,156			       int val, int val2, long mask)157{158	struct isl29125_data *data = iio_priv(indio_dev);159 160	switch (mask) {161	case IIO_CHAN_INFO_SCALE:162		if (val != 0)163			return -EINVAL;164		if (val2 == ISL29125_SENSING_RANGE_1)165			data->conf1 |= ISL29125_MODE_RANGE;166		else if (val2 == ISL29125_SENSING_RANGE_0)167			data->conf1 &= ~ISL29125_MODE_RANGE;168		else169			return -EINVAL;170		return i2c_smbus_write_byte_data(data->client, ISL29125_CONF1,171			data->conf1);172	default:173		return -EINVAL;174	}175}176 177static irqreturn_t isl29125_trigger_handler(int irq, void *p)178{179	struct iio_poll_func *pf = p;180	struct iio_dev *indio_dev = pf->indio_dev;181	struct isl29125_data *data = iio_priv(indio_dev);182	int i, j = 0;183 184	iio_for_each_active_channel(indio_dev, i) {185		int ret = i2c_smbus_read_word_data(data->client,186			isl29125_regs[i].data);187		if (ret < 0)188			goto done;189 190		data->scan.chans[j++] = ret;191	}192 193	iio_push_to_buffers_with_timestamp(indio_dev, &data->scan,194		iio_get_time_ns(indio_dev));195 196done:197	iio_trigger_notify_done(indio_dev->trig);198 199	return IRQ_HANDLED;200}201 202static IIO_CONST_ATTR(scale_available, "0.005722 0.152590");203 204static struct attribute *isl29125_attributes[] = {205	&iio_const_attr_scale_available.dev_attr.attr,206	NULL207};208 209static const struct attribute_group isl29125_attribute_group = {210	.attrs = isl29125_attributes,211};212 213static const struct iio_info isl29125_info = {214	.read_raw = isl29125_read_raw,215	.write_raw = isl29125_write_raw,216	.attrs = &isl29125_attribute_group,217};218 219static int isl29125_buffer_postenable(struct iio_dev *indio_dev)220{221	struct isl29125_data *data = iio_priv(indio_dev);222 223	data->conf1 |= ISL29125_MODE_RGB;224	return i2c_smbus_write_byte_data(data->client, ISL29125_CONF1,225		data->conf1);226}227 228static int isl29125_buffer_predisable(struct iio_dev *indio_dev)229{230	struct isl29125_data *data = iio_priv(indio_dev);231 232	data->conf1 &= ~ISL29125_MODE_MASK;233	data->conf1 |= ISL29125_MODE_PD;234	return i2c_smbus_write_byte_data(data->client, ISL29125_CONF1,235		data->conf1);236}237 238static const struct iio_buffer_setup_ops isl29125_buffer_setup_ops = {239	.postenable = isl29125_buffer_postenable,240	.predisable = isl29125_buffer_predisable,241};242 243static int isl29125_probe(struct i2c_client *client)244{245	struct isl29125_data *data;246	struct iio_dev *indio_dev;247	int ret;248 249	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));250	if (indio_dev == NULL)251		return -ENOMEM;252 253	data = iio_priv(indio_dev);254	i2c_set_clientdata(client, indio_dev);255	data->client = client;256 257	indio_dev->info = &isl29125_info;258	indio_dev->name = ISL29125_DRV_NAME;259	indio_dev->channels = isl29125_channels;260	indio_dev->num_channels = ARRAY_SIZE(isl29125_channels);261	indio_dev->modes = INDIO_DIRECT_MODE;262 263	ret = i2c_smbus_read_byte_data(data->client, ISL29125_DEVICE_ID);264	if (ret < 0)265		return ret;266	if (ret != ISL29125_ID)267		return -ENODEV;268 269	data->conf1 = ISL29125_MODE_PD | ISL29125_MODE_RANGE;270	ret = i2c_smbus_write_byte_data(data->client, ISL29125_CONF1,271		data->conf1);272	if (ret < 0)273		return ret;274 275	ret = i2c_smbus_write_byte_data(data->client, ISL29125_STATUS, 0);276	if (ret < 0)277		return ret;278 279	ret = iio_triggered_buffer_setup(indio_dev, NULL,280		isl29125_trigger_handler, &isl29125_buffer_setup_ops);281	if (ret < 0)282		return ret;283 284	ret = iio_device_register(indio_dev);285	if (ret < 0)286		goto buffer_cleanup;287 288	return 0;289 290buffer_cleanup:291	iio_triggered_buffer_cleanup(indio_dev);292	return ret;293}294 295static int isl29125_powerdown(struct isl29125_data *data)296{297	return i2c_smbus_write_byte_data(data->client, ISL29125_CONF1,298		(data->conf1 & ~ISL29125_MODE_MASK) | ISL29125_MODE_PD);299}300 301static void isl29125_remove(struct i2c_client *client)302{303	struct iio_dev *indio_dev = i2c_get_clientdata(client);304 305	iio_device_unregister(indio_dev);306	iio_triggered_buffer_cleanup(indio_dev);307	isl29125_powerdown(iio_priv(indio_dev));308}309 310static int isl29125_suspend(struct device *dev)311{312	struct isl29125_data *data = iio_priv(i2c_get_clientdata(313		to_i2c_client(dev)));314	return isl29125_powerdown(data);315}316 317static int isl29125_resume(struct device *dev)318{319	struct isl29125_data *data = iio_priv(i2c_get_clientdata(320		to_i2c_client(dev)));321	return i2c_smbus_write_byte_data(data->client, ISL29125_CONF1,322		data->conf1);323}324 325static DEFINE_SIMPLE_DEV_PM_OPS(isl29125_pm_ops, isl29125_suspend,326				isl29125_resume);327 328static const struct i2c_device_id isl29125_id[] = {329	{ "isl29125" },330	{ }331};332MODULE_DEVICE_TABLE(i2c, isl29125_id);333 334static struct i2c_driver isl29125_driver = {335	.driver = {336		.name	= ISL29125_DRV_NAME,337		.pm	= pm_sleep_ptr(&isl29125_pm_ops),338	},339	.probe		= isl29125_probe,340	.remove		= isl29125_remove,341	.id_table	= isl29125_id,342};343module_i2c_driver(isl29125_driver);344 345MODULE_AUTHOR("Peter Meerwald <pmeerw@pmeerw.net>");346MODULE_DESCRIPTION("ISL29125 RGB light sensor driver");347MODULE_LICENSE("GPL");348