Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit e590d451 authored by Beomho Seo's avatar Beomho Seo Committed by Jonathan Cameron
Browse files

iio: cm36651: Add CM36651 proximity/light sensor 



This patch adds a new driver for Capella CM36651 proximity and RGB sensor.

Signed-off-by: default avatarBeomho Seo <beomho.seo@samsung.com>
Signed-off-by: default avatarJonathan Cameron <jic23@kernel.org>
parent a47f6e08

drivers/iio/light/Kconfig

+11 −0
Original line number Diff line number Diff line
@@ -27,6 +27,17 @@ config APDS9300 
	 To compile this driver as a module, choose M here: the

	 module will be called apds9300.



config CM36651

	depends on I2C

	tristate "CM36651 driver"

	help

	 Say Y here if you use cm36651.

	 This option enables proximity & RGB sensor using

	 Capella cm36651 device driver.



	 To compile this driver as a module, choose M here:

	 the module will be called cm36651.



config GP2AP020A00F

	tristate "Sharp GP2AP020A00F Proximity/ALS sensor"

	depends on I2C

drivers/iio/light/Makefile

+1 −0
Original line number Diff line number Diff line
@@ -5,6 +5,7 @@ 
# When adding new entries keep the list in alphabetical order

obj-$(CONFIG_ADJD_S311)		+= adjd_s311.o

obj-$(CONFIG_APDS9300)		+= apds9300.o

obj-$(CONFIG_CM36651)		+= cm36651.o

obj-$(CONFIG_GP2AP020A00F)	+= gp2ap020a00f.o

obj-$(CONFIG_HID_SENSOR_ALS)	+= hid-sensor-als.o

obj-$(CONFIG_SENSORS_LM3533)	+= lm3533-als.o

drivers/iio/light/cm36651.c

0 → 100644
+708 −0
Original line number Diff line number Diff line 
/*

 * Copyright (C) 2013 Samsung Electronics Co., Ltd.

 * Author: Beomho Seo <beomho.seo@samsung.com>

 *

 * This program is free software; you can redistribute  it and/or modify it

 * under  the terms of  the GNU General Public License version 2, as published

 * by the Free Software Foundation.

 */



#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 80000 usec */

#define CM36651_CS_IT2			0x40 /* Integration time 160000 usec */

#define CM36651_CS_IT3			0x80 /* Integration time 320000 usec */

#define CM36651_CS_IT4			0xC0 /* Integration time 640000 usec */



/* 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 320 usec */

#define CM36651_PS_IT2			0x10 /* Integration time 420 usec */

#define CM36651_PS_IT3			0x20 /* Integration time 520 usec */

#define CM36651_PS_IT4			0x30 /* Integration time 640 usec */



/* 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	"80000 160000 320000 640000"

#define CM36651_PS_INT_TIME_AVAIL	"320 420 520 640"



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());



	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 *val)

{

	switch (chan->type) {

	case IIO_LIGHT:

		if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT1)

			*val = 80000;

		else if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT2)

			*val = 160000;

		else if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT3)

			*val = 320000;

		else if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT4)

			*val = 640000;

		else

			return -EINVAL;

		break;

	case IIO_PROXIMITY:

		if (cm36651->ps_int_time == CM36651_PS_IT1)

			*val = 320;

		else if (cm36651->ps_int_time == CM36651_PS_IT2)

			*val = 420;

		else if (cm36651->ps_int_time == CM36651_PS_IT3)

			*val = 520;

		else if (cm36651->ps_int_time == CM36651_PS_IT4)

			*val = 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:

		ret = cm36651_read_int_time(cm36651, chan, val);

		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, val);

		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,

					u64 event_code, int *val)

{

	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,

					u64 event_code, int val)

{

	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,

					u64 event_code, int state)

{

	struct cm36651_data *cm36651 = iio_priv(indio_dev);

	int cmd, ret = -EINVAL;



	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,

							u64 event_code)

{

	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_chan_spec cm36651_channels[] = {

	{

		.type = IIO_PROXIMITY,

		.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |

				BIT(IIO_CHAN_INFO_INT_TIME),

		.event_mask = IIO_EV_BIT(IIO_EV_TYPE_THRESH, IIO_EV_DIR_EITHER)

	},

	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 = {

	.driver_module		= THIS_MODULE,

	.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(client->adapter,

						     CM36651_I2C_ADDR_PS);

	cm36651->ara_client = i2c_new_dummy(client->adapter, CM36651_ARA);

	mutex_init(&cm36651->lock);

	indio_dev->dev.parent = &client->dev;

	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_disable_reg;

	}



	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_disable_reg;

	}



	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_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);



	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" },

	{ }

};



static struct i2c_driver cm36651_driver = {

	.driver = {

		.name	= "cm36651",

		.of_match_table = of_match_ptr(cm36651_of_match),

		.owner	= THIS_MODULE,

	},

	.probe		= cm36651_probe,

	.remove		= cm36651_remove,

	.id_table	= cm36651_id,

};



module_i2c_driver(cm36651_driver);



MODULE_AUTHOR("Beomho Seo <beomho.seo@samsung.com>");

MODULE_DESCRIPTION("CM36651 proximity/ambient light sensor driver");

MODULE_LICENSE("GPL v2");