mirror of
https://github.com/FEX-Emu/linux.git
synced 2024-12-23 01:40:30 +00:00
Staging: IIO: tsl2561 digital light sensor core support
This is a pretty minimalist example of an IIO driver. Signed-off-by: Jonathan Cameron <jic23@cam.ac.uk> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
d1325cf450
commit
78632b609a
@ -12,5 +12,6 @@ menuconfig IIO
|
||||
if IIO
|
||||
|
||||
source "drivers/staging/iio/adc/Kconfig"
|
||||
source "drivers/staging/iio/light/Kconfig"
|
||||
|
||||
endif # IIO
|
||||
|
@ -6,3 +6,4 @@ obj-$(CONFIG_IIO) += industrialio.o
|
||||
industrialio-y := industrialio-core.o
|
||||
|
||||
obj-y += adc/
|
||||
obj-y += light/
|
13
drivers/staging/iio/light/Kconfig
Normal file
13
drivers/staging/iio/light/Kconfig
Normal file
@ -0,0 +1,13 @@
|
||||
#
|
||||
# Light sensors
|
||||
#
|
||||
comment "Light sensors"
|
||||
|
||||
config TSL2561
|
||||
tristate "TAOS TSL2561 light-to-digital convertor"
|
||||
depends on I2C
|
||||
help
|
||||
Say yes bere to build support for the TAOS light to digital
|
||||
convertor. This chip has two light sensors. One is broadband
|
||||
including infrared whilst the other measures only infrared.
|
||||
Provides direct access via sysfs.
|
5
drivers/staging/iio/light/Makefile
Normal file
5
drivers/staging/iio/light/Makefile
Normal file
@ -0,0 +1,5 @@
|
||||
#
|
||||
# Makefile for industrial I/O Light sensors
|
||||
#
|
||||
|
||||
obj-$(CONFIG_TSL2561) += tsl2561.o
|
12
drivers/staging/iio/light/light.h
Normal file
12
drivers/staging/iio/light/light.h
Normal file
@ -0,0 +1,12 @@
|
||||
#include "../sysfs.h"
|
||||
|
||||
/* Light to digital sensor attributes */
|
||||
|
||||
#define IIO_DEV_ATTR_LIGHT_INFRARED(_num, _show, _addr) \
|
||||
IIO_DEVICE_ATTR(light_infrared##_num, S_IRUGO, _show, NULL, _addr)
|
||||
|
||||
#define IIO_DEV_ATTR_LIGHT_BROAD(_num, _show, _addr) \
|
||||
IIO_DEVICE_ATTR(light_broadspectrum##_num, S_IRUGO, _show, NULL, _addr)
|
||||
|
||||
#define IIO_DEV_ATTR_LIGHT_VISIBLE(_num, _show, _addr) \
|
||||
IIO_DEVICE_ATTR(light_visible##_num, S_IRUGO, _show, NULL, _addr)
|
276
drivers/staging/iio/light/tsl2561.c
Normal file
276
drivers/staging/iio/light/tsl2561.c
Normal file
@ -0,0 +1,276 @@
|
||||
/*
|
||||
* tsl2561.c - Linux kernel modules for light to digital convertor
|
||||
*
|
||||
* Copyright (C) 2008-2009 Jonathan Cameron <jic23@cam.ac.uk>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*
|
||||
* Some portions based upon the tsl2550 driver.
|
||||
*
|
||||
* This driver could probably be adapted easily to talk to the tsl2560 (smbus)
|
||||
*
|
||||
* Needs some work to support the events this can generate.
|
||||
* Todo: Implement interrupt handling. Currently a hardware bug means
|
||||
* this isn't available on my test board.
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/i2c.h>
|
||||
#include "../iio.h"
|
||||
#include "../sysfs.h"
|
||||
#include "light.h"
|
||||
|
||||
#define TSL2561_CONTROL_REGISTER 0x00
|
||||
#define TSL2561_TIMING_REGISTER 0x01
|
||||
#define TSL2561_THRESHLOW_LOW_REGISTER 0x02
|
||||
#define TSL2561_THRESHLOW_HIGH_REGISTER 0x03
|
||||
#define TSL2561_THRESHHIGH_LOW_REGISTER 0x04
|
||||
#define TSL2561_THRESHHIGH_HIGH_REGISTER 0x05
|
||||
#define TSL2561_INT_CONTROL_REGISTER 0x06
|
||||
|
||||
#define TSL2561_INT_REG_INT_OFF 0x00
|
||||
#define TSL2561_INT_REG_INT_LEVEL 0x08
|
||||
#define TSL2561_INT_REG_INT_SMBUS 0x10
|
||||
#define TSL2561_INT_REG_INT_TEST 0x18
|
||||
|
||||
#define TSL2561_ID_REGISTER 0x0A
|
||||
|
||||
#define TSL2561_DATA_0_LOW 0x0C
|
||||
#define TSL2561_DATA_1_LOW 0x0E
|
||||
|
||||
/* Control Register Values */
|
||||
#define TSL2561_CONT_REG_PWR_ON 0x03
|
||||
#define TSL2561_CONT_REG_PWR_OFF 0x00
|
||||
|
||||
/**
|
||||
* struct tsl2561_state - device specific state
|
||||
* @indio_dev: the industrialio I/O info structure
|
||||
* @client: i2c client
|
||||
* @command_buf: single command buffer used for all operations
|
||||
* @command_buf_lock: ensure unique access to command_buf
|
||||
*/
|
||||
struct tsl2561_state {
|
||||
struct iio_dev *indio_dev;
|
||||
struct i2c_client *client;
|
||||
struct tsl2561_command *command_buf;
|
||||
struct mutex command_buf_lock;
|
||||
};
|
||||
|
||||
/**
|
||||
* struct tsl2561_command - command byte for smbus
|
||||
* @address: register address
|
||||
* @block: is this a block r/w
|
||||
* @word: is this a word r/w
|
||||
* @clear: set to 1 to clear pending interrupt
|
||||
* @cmd: select the command register - always 1.
|
||||
*/
|
||||
struct tsl2561_command {
|
||||
unsigned int address:4;
|
||||
unsigned int block:1;
|
||||
unsigned int word:1;
|
||||
unsigned int clear:1;
|
||||
unsigned int cmd:1;
|
||||
};
|
||||
|
||||
static inline void tsl2561_init_command_buf(struct tsl2561_command *buf)
|
||||
{
|
||||
buf->address = 0;
|
||||
buf->block = 0;
|
||||
buf->word = 0;
|
||||
buf->clear = 0;
|
||||
buf->cmd = 1;
|
||||
}
|
||||
|
||||
static ssize_t tsl2561_read_val(struct device *dev,
|
||||
struct device_attribute *attr,
|
||||
char *buf)
|
||||
{
|
||||
int ret = 0, data;
|
||||
ssize_t len = 0;
|
||||
struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct tsl2561_state *st = indio_dev->dev_data;
|
||||
|
||||
mutex_lock(&st->command_buf_lock);
|
||||
st->command_buf->cmd = 1;
|
||||
st->command_buf->word = 1;
|
||||
st->command_buf->address = this_attr->address;
|
||||
|
||||
data = i2c_smbus_read_word_data(st->client, *(char *)(st->command_buf));
|
||||
if (data < 0) {
|
||||
ret = data;
|
||||
goto error_ret;
|
||||
}
|
||||
len = sprintf(buf, "%u\n", data);
|
||||
|
||||
error_ret:
|
||||
mutex_unlock(&st->command_buf_lock);
|
||||
|
||||
return ret ? ret : len;
|
||||
}
|
||||
|
||||
static IIO_DEV_ATTR_LIGHT_INFRARED(0, tsl2561_read_val, TSL2561_DATA_0_LOW);
|
||||
static IIO_DEV_ATTR_LIGHT_BROAD(0, tsl2561_read_val, TSL2561_DATA_1_LOW);
|
||||
|
||||
static struct attribute *tsl2561_attributes[] = {
|
||||
&iio_dev_attr_light_infrared0.dev_attr.attr,
|
||||
&iio_dev_attr_light_broadspectrum0.dev_attr.attr,
|
||||
NULL,
|
||||
};
|
||||
|
||||
static const struct attribute_group tsl2561_attribute_group = {
|
||||
.attrs = tsl2561_attributes,
|
||||
};
|
||||
|
||||
static int tsl2561_initialize(struct tsl2561_state *st)
|
||||
{
|
||||
int err;
|
||||
|
||||
mutex_lock(&st->command_buf_lock);
|
||||
st->command_buf->word = 0;
|
||||
st->command_buf->block = 0;
|
||||
st->command_buf->address = TSL2561_CONTROL_REGISTER;
|
||||
err = i2c_smbus_write_byte_data(st->client, *(char *)(st->command_buf),
|
||||
TSL2561_CONT_REG_PWR_ON);
|
||||
if (err)
|
||||
goto error_ret;
|
||||
|
||||
st->command_buf->address = TSL2561_INT_CONTROL_REGISTER;
|
||||
err = i2c_smbus_write_byte_data(st->client, *(char *)(st->command_buf),
|
||||
TSL2561_INT_REG_INT_TEST);
|
||||
|
||||
error_ret:
|
||||
mutex_unlock(&st->command_buf_lock);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static int tsl2561_powerdown(struct i2c_client *client)
|
||||
{
|
||||
int err;
|
||||
struct tsl2561_command Command = {
|
||||
.cmd = 1,
|
||||
.clear = 0,
|
||||
.word = 0,
|
||||
.block = 0,
|
||||
.address = TSL2561_CONTROL_REGISTER,
|
||||
};
|
||||
|
||||
err = i2c_smbus_write_byte_data(client, *(char *)(&Command),
|
||||
TSL2561_CONT_REG_PWR_OFF);
|
||||
return (err < 0) ? err : 0;
|
||||
}
|
||||
static int __devinit tsl2561_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
int ret = 0, regdone = 0;
|
||||
struct tsl2561_state *st = kzalloc(sizeof(*st), GFP_KERNEL);
|
||||
|
||||
if (st == NULL) {
|
||||
ret = -ENOMEM;
|
||||
goto error_ret;
|
||||
}
|
||||
i2c_set_clientdata(client, st);
|
||||
st->client = client;
|
||||
mutex_init(&st->command_buf_lock);
|
||||
|
||||
st->command_buf = kmalloc(sizeof(*st->command_buf), GFP_KERNEL);
|
||||
if (st->command_buf == NULL) {
|
||||
ret = -ENOMEM;
|
||||
goto error_free_state;
|
||||
}
|
||||
tsl2561_init_command_buf(st->command_buf);
|
||||
|
||||
st->indio_dev = iio_allocate_device();
|
||||
if (st->indio_dev == NULL) {
|
||||
ret = -ENOMEM;
|
||||
goto error_free_command_buf;
|
||||
}
|
||||
st->indio_dev->attrs = &tsl2561_attribute_group;
|
||||
st->indio_dev->dev.parent = &client->dev;
|
||||
st->indio_dev->dev_data = (void *)(st);
|
||||
st->indio_dev->driver_module = THIS_MODULE;
|
||||
st->indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
ret = iio_device_register(st->indio_dev);
|
||||
if (ret)
|
||||
goto error_free_iiodev;
|
||||
regdone = 1;
|
||||
/* Intialize the chip */
|
||||
ret = tsl2561_initialize(st);
|
||||
if (ret)
|
||||
goto error_unregister_iiodev;
|
||||
|
||||
return 0;
|
||||
error_unregister_iiodev:
|
||||
error_free_iiodev:
|
||||
if (regdone)
|
||||
iio_device_unregister(st->indio_dev);
|
||||
else
|
||||
iio_free_device(st->indio_dev);
|
||||
error_free_command_buf:
|
||||
kfree(st->command_buf);
|
||||
error_free_state:
|
||||
kfree(st);
|
||||
error_ret:
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
static int __devexit tsl2561_remove(struct i2c_client *client)
|
||||
{
|
||||
struct tsl2561_state *st = i2c_get_clientdata(client);
|
||||
|
||||
iio_device_unregister(st->indio_dev);
|
||||
kfree(st);
|
||||
|
||||
return tsl2561_powerdown(client);
|
||||
}
|
||||
|
||||
static unsigned short normal_i2c[] = { 0x29, 0x39, 0x49, I2C_CLIENT_END };
|
||||
|
||||
I2C_CLIENT_INSMOD;
|
||||
|
||||
static const struct i2c_device_id tsl2561_id[] = {
|
||||
{ "tsl2561", 0 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, tsl2561_id);
|
||||
|
||||
|
||||
static struct i2c_driver tsl2561_driver = {
|
||||
.driver = {
|
||||
.name = "tsl2561",
|
||||
},
|
||||
.probe = tsl2561_probe,
|
||||
.remove = __devexit_p(tsl2561_remove),
|
||||
.id_table = tsl2561_id,
|
||||
};
|
||||
|
||||
static __init int tsl2561_init(void)
|
||||
{
|
||||
return i2c_add_driver(&tsl2561_driver);
|
||||
}
|
||||
module_init(tsl2561_init);
|
||||
|
||||
static __exit void tsl2561_exit(void)
|
||||
{
|
||||
i2c_del_driver(&tsl2561_driver);
|
||||
}
|
||||
module_exit(tsl2561_exit);
|
||||
|
||||
MODULE_AUTHOR("Jonathan Cameron <jic23@cam.ac.uk>");
|
||||
MODULE_DESCRIPTION("TSL2561 light sensor driver");
|
||||
MODULE_LICENSE("GPL");
|
Loading…
Reference in New Issue
Block a user