/* drivers/input/sensors/lsensor/cm3218.c
*
- Copyright © 2012-2016 ROCKCHIP.
- QQ：712288614 >
- This software is licensed under the terms of the GNU General Public
- License version 2, as published by the Free Software Foundation, and
- may be copied, distributed, and modified under those terms.
- 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.
*/
#include <linux/interrupt.h>
#include <linux/i2c.h>
#include <linux/slab.h>
#include <linux/irq.h>
#include <linux/miscdevice.h>
#include <linux/gpio.h>
#include <linux/uaccess.h>
#include <linux/atomic.h>
#include <linux/delay.h>
#include <linux/input.h>
#include <linux/workqueue.h>
#include <linux/freezer.h>
#include <linux/of_gpio.h>
#ifdef CONFIG_HAS_EARLYSUSPEND
#include <linux/earlysuspend.h>
#endif
#include <linux/sensor-dev.h>
#define LENSFACTOR 1000
/* SMBus ARA Address */
#define CM3218_ADDR_ARA 0x0C
/* CM3218 CMD Registers */
#define CM3218_REG_ADDR_CMD 0x00
#define CM3218_CMD_ALS_SD 0x0001
#define CM3218_CMD_ALS_INT_EN 0x0002
#define CM3218_CMD_ALS_INT_DISABLE 0x0000
#define CM3218_CMD_ALS_IT_SHIFT 6
#define CM3218_CMD_ALS_IT_MASK (3 << CM3218_CMD_ALS_IT_SHIFT)
#define CM3218_CMD_ALS_IT_05T (0 << CM3218_CMD_ALS_IT_SHIFT)
#define CM3218_CMD_ALS_IT_1T (1 << CM3218_CMD_ALS_IT_SHIFT)
#define CM3218_CMD_ALS_IT_2T (2 << CM3218_CMD_ALS_IT_SHIFT)
#define CM3218_CMD_ALS_IT_4T (3 << CM3218_CMD_ALS_IT_SHIFT)
#define CM3218_DEFAULT_CMD (CM3218_CMD_ALS_IT_1T)
#define CM3218_ALS_PERS 0x0020
#define CM3218_REG_ADDR_ALS_WH 0x01
#define CM3218_DEFAULT_ALS_WH 0x000C
#define CM3218_REG_ADDR_ALS_WL 0x02
#define CM3218_DEFAULT_ALS_WL 0x000A
#define CM3218_REG_ADDR_ALS 0x04
#define CM3218_REG_ADDR_STATUS 0x06
#define CM3218_REG_ADDR_ID 0x07
/* Software parameters /
#define CM3218_MAX_CACHE_REGS (0x03 + 1) / Reg.0x00 to 0x03 */
static int als_code = 20;
static int change_sensitivity = 50;
static int if_sensor_init;
static int cm3218_read_ara(struct i2c_client *client)
{
int status;
unsigned short addr;
addr = client->addr;
client->addr = CM3218_ADDR_ARA;
status = i2c_smbus_read_byte(client);
client->addr = addr;
if (status < 0)
return -ENODEV;
return 0;
}
static int cm3218_write(struct i2c_client *client, u8 reg, u16 value)
{
u16 regval;
int ret;
dev_dbg(&client->dev,
"Write to device register 0x%02X with 0x%04X\n", reg, value);
regval = cpu_to_le16(value);
ret = i2c_smbus_write_word_data(client, reg, regval);
if (ret)
dev_err(&client->dev, "Write to device fails: 0x%x\n", ret);
return ret;
}
static int cm3218_read(struct i2c_client *client, u8 reg)
{
int regval;
int status;
status = i2c_smbus_read_word_data(client, reg);
if (status < 0) {
dev_err(&client->dev,
"Error in reading Reg.0x%02X\n", reg);
return status;
}
regval = le16_to_cpu(status);
dev_dbg(&client->dev,
"Read from device register 0x%02X = 0x%04X\n",
reg, regval);
return regval;
}
static int clear_interrupt(struct i2c_client *client)
{
int status = 0;
status = cm3218_read(client, CM3218_REG_ADDR_STATUS);
if (status < 0) {
dev_err(&client->dev, "CM3218: clean interrupt flag fail\n");
return status;
}
return status;
}
static int enable_interrupt(struct i2c_client *client)
{
int status = 0;
status = cm3218_write(
client,
CM3218_REG_ADDR_CMD,
CM3218_DEFAULT_CMD |
CM3218_CMD_ALS_INT_EN |
CM3218_ALS_PERS);
if (status < 0) {
dev_err(&client->dev, "CM3128 enable interrut fails\n");
return status;
}
return status;
}
static int disable_interrupt(struct i2c_client *client)
{
int status = 0;
status = cm3218_write(
client,
CM3218_REG_ADDR_CMD,
CM3218_DEFAULT_CMD |
CM3218_CMD_ALS_INT_DISABLE);
if (status < 0) {
dev_err(&client->dev, "CM3218: disable interrput fail\n");
return status;
}
return status;
}
static int set_als_int_threshold(struct i2c_client *client)
{
int threshold_high, threshold_low;
int status = 0;
/* Set ALS high threshold */
threshold_high = als_code * (100 + change_sensitivity) / 100;
if (threshold_high > 65535)
threshold_high = 65535;
status = cm3218_write(client, CM3218_REG_ADDR_ALS_WH, threshold_high);
if (status < 0) {
dev_err(&client->dev, "Init CM3218 CMD fails, set als wh error\n");
return status;
}
/* Set ALS low threshold */
threshold_low = als_code * (100 - change_sensitivity) / 100;
status = cm3218_write(client, CM3218_REG_ADDR_ALS_WL, threshold_low);
if (status < 0) {
dev_err(&client->dev, "Init CM3218 CMD fails, set als wh error\n");
return status;
}
return status;
}
/****operate according to sensor chip:start/
static int sensor_active(struct i2c_client *client, int enable, int rate)
{
struct sensor_private_data *sensor =
(struct sensor_private_data *)i2c_get_clientdata(client);
int result = 0;
int status = 0;
if (if_sensor_init)
return 0;
sensor->client->addr = sensor->ops->ctrl_reg;
sensor->ops->ctrl_data = cm3218_read(client, sensor->client->addr);
/* register setting according to chip datasheet */
if (!enable) {
status = CM3218_CMD_ALS_SD; /* cm3218 */
sensor->ops->ctrl_data |= status;
} else {
status = ~CM3218_CMD_ALS_SD; /* cm3218 */
sensor->ops->ctrl_data &= status;
}
DBG("%s:reg=0x%x, reg_ctrl=0x%x, enable=%d\n",
__func__,
sensor->ops->ctrl_reg,
sensor->ops->ctrl_data,
enable);
result = cm3218_write(
client,
sensor->client->addr,
sensor->ops->ctrl_data);
if (result)
dev_err(&client->dev, "%s:fail to active sensor\n", __func__);
return result;
}
static int sensor_init(struct i2c_client *client)
{
int status, i;
struct sensor_private_data *sensor =
(struct sensor_private_data *)i2c_get_clientdata(client);
if (if_sensor_init)
return 0;
for (i = 0; i < 5; i++) {
status = cm3218_write(
client, CM3218_REG_ADDR_CMD,
CM3218_CMD_ALS_SD);
if (status >= 0)
break;
cm3218_read_ara(client);
}
status = cm3218_write(client, CM3218_REG_ADDR_CMD, CM3218_DEFAULT_CMD);
if (status < 0) {
dev_err(&client->dev, "Init CM3218 CMD fails\n");
return status;
}
if (sensor->pdata->irq_enable) {
set_als_int_threshold(client);
enable_interrupt(client);
}
if_sensor_init = 1;
msleep(250);
return status;
}
static int light_report_value(struct input_dev *input, int data)
{
unsigned char index = 0;
if (data <= 700) {
index = 0;
} else if (data <= 1400) {
index = 1;
} else if (data <= 2800) {
index = 2;
} else if (data <= 5600) {
index = 3;
} else if (data <= 11200) {
index = 4;
} else if (data <= 22400) {
index = 5;
} else if (data <= 44800) {
index = 6;
} else {
index = 7;
}
input_report_abs(input, ABS_MISC, index);
input_sync(input);
return index;
}
static int cm3218_read_lux(struct i2c_client *client, int *lux)
{
int lux_data;
lux_data = cm3218_read(client, CM3218_REG_ADDR_ALS);
if (lux_data < 0) {
dev_err(&client->dev, "Error in reading Lux DATA\n");
return lux_data;
}
dev_vdbg(&client->dev, "lux = %u\n", lux_data);
if (lux_data < 0)
return lux_data;
*lux = lux_data * LENSFACTOR;
*lux /= 1000;
return 0;
}
static int sensor_report_value(struct i2c_client *client)
{
struct sensor_private_data *sensor =
(struct sensor_private_data *)i2c_get_clientdata(client);
int result = 0;
int index = 0;
/* clean interrupt flag and disable it during reading data */
if (sensor->pdata->irq_enable) {
clear_interrupt(client);
disable_interrupt(client);
}
cm3218_read_lux(client, &result);
als_code = result;
index = light_report_value(sensor->input_dev, 200 * result);
/* enable interrupt after read data */
if (sensor->pdata->irq_enable) {
set_als_int_threshold(client);
enable_interrupt(client);
}
return 0;
}
struct sensor_operate light_cm3218_ops = {
.name = “cm3218”,
/* sensor type and it should be correct /
.type = SENSOR_TYPE_LIGHT,
/ i2c id number /
.id_i2c = LIGHT_ID_CM3218,
/ read data /
.read_reg = CM3218_REG_ADDR_ALS,
.read_len = 2, / data length /
/ read device id from this register /
.id_reg = SENSOR_UNKNOW_DATA,
/ device id /
.id_data = SENSOR_UNKNOW_DATA,
.precision = 16, / 8 bits /
/ enable or disable /
.ctrl_reg = CM3218_REG_ADDR_CMD,
/ intterupt status register /
.int_status_reg = CM3218_REG_ADDR_STATUS,
/ range /
.range = {0, 65535},
/ brightness */
.brightness = {10, 255},
.trig = SENSOR_UNKNOW_DATA,
.active = sensor_active,
.init = sensor_init,
.report = sensor_report_value,
};
/****operate according to sensor chip:end/
static int light_cm3218_probe(struct i2c_client *client,
const struct i2c_device_id *devid)
{
return sensor_register_device(client, NULL, devid, &light_cm3218_ops);
}
static int light_cm3218_remove(struct i2c_client *client)
{
return sensor_unregister_device(client, NULL, &light_cm3218_ops);
}
static const struct i2c_device_id light_cm3218_id[] = {
{“light_cm3218”, LIGHT_ID_CM3218},
{}
};
static struct i2c_driver light_cm3218_driver = {
.probe = light_cm3218_probe,
.remove = light_cm3218_remove,
.shutdown = sensor_shutdown,
.id_table = light_cm3218_id,
.driver = {
.name = “light_cm3218”,
#ifdef CONFIG_PM
.pm = &sensor_pm_ops,
#endif
},
};
module_i2c_driver(light_cm3218_driver);
MODULE_AUTHOR(“QQ：712288614”);
MODULE_DESCRIPTION(“cm3218 light driver”);
MODULE_LICENSE(“GPL”);
