tegrakernel/kernel/nvidia/drivers/iio/light/nvs_cm3218.c

/* Copyright (c) 2014-2017, NVIDIA CORPORATION.  All rights reserved.
 *
 * 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.
 */

/* The NVS = NVidia Sensor framework */
/* See nvs_iio.c and nvs.h for documentation */
/* See nvs_light.c and nvs_light.h for documentation */


#include <linux/i2c.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/err.h>
#include <linux/delay.h>
#include <linux/regulator/consumer.h>
#include <linux/workqueue.h>
#include <linux/interrupt.h>
#include <linux/gpio.h>
#include <linux/of_gpio.h>
#include <linux/of.h>
#include <linux/nvs.h>
#include <linux/nvs_light.h>

#define CM_DRIVER_VERSION		(303)
#define CM_VENDOR			"Capella Microsystems, Inc."
#define CM_NAME				"cm3218x"
#define CM_NAME_CM3218			"cm3218"
#define CM_NAME_CM32180			"cm32180"
#define CM_NAME_CM32181			"cm32181"
#define CM_DEVID_CM3218			(0x01)
#define CM_DEVID_CM32180		(0x02)
#define CM_DEVID_CM32181		(0x03)
#define CM_HW_DELAY_MS			(10)
#define CM_ALS_CFG_DFLT			(0x0800)
#define CM_ALS_PSM_DFLT			(0x07)
#define CM_R_SET_DFLT			(604)
#define CM_LIGHT_VERSION		(1)
#define CM_LIGHT_SCALE_IVAL		(0)
#define CM_LIGHT_SCALE_MICRO		(10000)
#define CM_LIGHT_THRESHOLD_LO		(10)
#define CM_LIGHT_THRESHOLD_HI		(10)
#define CM_POLL_DLY_MS_MAX		(4000)
/* HW registers */
#define CM_REG_CFG			(0x00)
#define CM_REG_CFG_ALS_SM		(11)
#define CM_REG_CFG_ALS_IT		(6)
#define CM_REG_CFG_ALS_PERS		(4)
#define CM_REG_CFG_RSRV_ID		(2)
#define CM_REG_CFG_ALS_INT_EN		(1)
#define CM_REG_CFG_ALS_SD		(0)
#define CM_REG_CFG_USER_MSK_CM3218	(0x08F0)
#define CM_REG_CFG_USER_MSK_CM32180	(0x18F0)
#define CM_REG_CFG_USER_MSK_CM32181	(0x1BF0)
#define CM_REG_WH			(0x01)
#define CM_REG_WL			(0x02)
#define CM_REG_PSM			(0x03)
#define CM_REG_PSM_PSM			(1)
#define CM_REG_PSM_EN			(0)
#define CM_REG_PSM_MASK			(0x07)
#define CM_REG_ALS			(0x04)
#define CM_REG_ALS_IF			(0x06)
#define CM_REG_ALS_IF_L			(15)
#define CM_REG_ALS_IF_H			(14)
#define CM_REG_N			(8)
/* the CM3218 & CM32180 device uses the CM_I2C_ARA to clear the INT pin */
#define CM_I2C_ARA			(0x0C) /* I2C Alert Response Address */

enum CM_DBG {
	CM_DBG_STS = 0,
	/* skip sequence to "hide" debug features */
	CM_DBG_CFG = 2,
	CM_DBG_PSM,
	CM_DBG_REG,
	CM_DBG_ARA,
	CM_DBG_RD,
};


/* regulator names in order of powering on */
static char *cm_vregs[] = {
	"vdd",
};

static unsigned short cm_i2c_addrs[] = {
	0x10,
	0x48,
};

static struct nvs_light_dynamic cm3218_nld_tbl[] = {
	{ {0, 3571},  {234,  25485},  {0, 130000}, 1000, 0x08C4 },
	{ {0, 7140},  {467,  919900}, {0, 130000}, 500,  0x0884 },
	{ {0, 14280}, {935,  839800}, {0, 130000}, 250,  0x0844 },
	{ {0, 28570}, {1872, 334950}, {0, 130000}, 125,  0x0804 }
};

static struct nvs_light_dynamic cm32180_nld_tbl[] = {
	{ {0, 3571},  {234,  25485},  {0, 130000}, 1000, 0x08C4 },
	{ {0, 7140},  {467,  919900}, {0, 130000}, 500,  0x0884 },
	{ {0, 14280}, {935,  839800}, {0, 130000}, 250,  0x0844 },
	{ {0, 28570}, {1872, 334950}, {0, 130000}, 125,  0x0804 }
};

static struct nvs_light_dynamic cm32181_nld_tbl[] = {
	{ {0, 5000},   {327,   675000}, {0, 35000}, 800, 0x00C0 },
	{ {0, 10000},  {655,   350000}, {0, 35000}, 400, 0x0080 },
	{ {0, 21000},  {13762, 350000}, {0, 35000}, 200, 0x0040 },
	{ {0, 42000},  {27524, 700000}, {0, 35000}, 100, 0x0000 },
	{ {0, 84000},  {55049, 400000}, {0, 35000}, 50,  0x0200 },
	{ {0, 167000}, {10944, 345000}, {0, 35000}, 25,  0x0300 }
};

struct cm_psm {
	unsigned int ms;
	struct nvs_float milliamp;
};

static struct cm_psm cm_psm_tbl[] = {
	{ 500,  {0, 21000} },
	{ 1000, {0, 15000} },
	{ 2000, {0, 10000} },
	{ 4000, {0, 6000} }
};

struct cm_state {
	struct i2c_client *i2c;
	struct i2c_client *ara;
	struct nvs_fn_if *nvs;
	struct sensor_cfg cfg;
	struct workqueue_struct *wq;
	struct work_struct ws;
	struct regulator_bulk_data vreg[ARRAY_SIZE(cm_vregs)];
	struct nvs_light light;
	struct nvs_light_dynamic nld_tbl[ARRAY_SIZE(cm32181_nld_tbl)];
	struct nld_thresh nld_thr[ARRAY_SIZE(cm32181_nld_tbl)];
	unsigned int sts;		/* debug flags */
	unsigned int errs;		/* error count */
	unsigned int enabled;		/* enable status */
	int gpio_irq;			/* interrupt GPIO */
	bool ara_war;			/* force ARA on every I2C */
	u16 i2c_addr;			/* I2C address */
	u8 dev_id;			/* device ID */
	u16 als_cfg_mask;		/* ALS register 0 user mask */
	u16 als_cfg;			/* ALS register 0 user settings */
	u16 als_psm;			/* ALS Power Save Mode */
	u32 r_set;			/* Rset resistor value */
	u16 rc[CM_REG_N];		/* register cache for reg dump */
};


static void cm_err(struct cm_state *st)
{
	st->errs++;
	if (!st->errs)
		st->errs--;
}

/* CM3218 & CM32180 don't respond to I2C until the IRQ is ACK'd with the ARA.
 * The problem is that ARA may be needed regardless of whether the IRQ is
 * enabled or not so we test the IRQ GPIO before each I2C transaction as a WAR.
 */
static int cm_irq_ack(struct cm_state *st, bool force)
{
	int gpio_sts;
	int ret = 0;

	if (st->ara && st->gpio_irq >= 0) {
		if (force)
			gpio_sts = false;
		else
			gpio_sts = gpio_get_value(st->gpio_irq);
		if (!gpio_sts)
			ret = i2c_smbus_read_byte(st->ara);
		if (st->sts & NVS_STS_SPEW_IRQ)
			dev_info(&st->i2c->dev, "%s GPIO ARA %d=%d ret=%d\n",
				 __func__, st->gpio_irq, gpio_sts, ret);
	}
	/* ret < 0: error
	 * ret = 0: no action
	 * ret > 0: ACK
	 */
	return ret;
}

static int cm_i2c_rd(struct cm_state *st, u8 reg, u16 *val)
{
	struct i2c_msg msg[2];
	int ret;

	cm_irq_ack(st, st->ara_war);
	msg[0].addr = st->i2c_addr;
	msg[0].flags = 0;
	msg[0].len = 1;
	msg[0].buf = &reg;
	msg[1].addr = st->i2c_addr;
	msg[1].flags = I2C_M_RD;
	msg[1].len = 2;
	msg[1].buf = (__u8 *)val;
	ret = i2c_transfer(st->i2c->adapter, msg, 2);
	if (ret != 2 && st->ara) {
		cm_irq_ack(st, true);
		ret = i2c_transfer(st->i2c->adapter, msg, 2);
	}
	if (ret == 2) {
		*val = le16_to_cpup(val);
		ret = 0;
	} else {
		cm_err(st);
		ret = -EIO;
	}
	if (st->sts & NVS_STS_SPEW_MSG)
		dev_info(&st->i2c->dev, "%s reg=%hhx val=%hx err=%d\n",
			 __func__, reg, *val, ret);
	return ret;
}

static int cm_i2c_wr(struct cm_state *st, u8 reg, u16 val)
{
	struct i2c_msg msg;
	u8 buf[3];
	int ret = 0;

	if (st->i2c_addr) {
		cm_irq_ack(st, false);
		buf[0] = reg;
		val = cpu_to_le16(val);
		buf[1] = val & 0xFF;
		buf[2] = val >> 8;
		msg.addr = st->i2c_addr;
		msg.flags = 0;
		msg.len = sizeof(buf);
		msg.buf = buf;
		ret = i2c_transfer(st->i2c->adapter, &msg, 1);
		if (ret != 1 && st->ara) {
			cm_irq_ack(st, true);
			ret = i2c_transfer(st->i2c->adapter, &msg, 1);
		}
		if (ret == 1) {
			st->rc[reg] = val;
			ret = 0;
		} else {
			cm_err(st);
			ret = -EIO;
		}
		if (st->sts & NVS_STS_SPEW_MSG)
			dev_info(&st->i2c->dev, "%s reg=%hhx val=%hx err=%d\n",
				 __func__, reg, val, ret);
	}
	return ret;
}

static int cm_pm(struct cm_state *st, bool enable)
{
	int ret;

	if (enable) {
		ret = nvs_vregs_enable(&st->i2c->dev, st->vreg,
				       ARRAY_SIZE(cm_vregs));
		if (ret)
			mdelay(CM_HW_DELAY_MS);
		if (st->dev_id == CM_DEVID_CM32181)
			cm_i2c_wr(st, CM_REG_PSM, st->als_psm);
	} else {
		ret = nvs_vregs_sts(st->vreg, ARRAY_SIZE(cm_vregs));
		if ((ret < 0) || (ret == ARRAY_SIZE(cm_vregs))) {
			ret = cm_i2c_wr(st, CM_REG_CFG, st->rc[CM_REG_CFG] |
					1 << CM_REG_CFG_ALS_SD);
		} else if (ret > 0) {
			nvs_vregs_enable(&st->i2c->dev, st->vreg,
					 ARRAY_SIZE(cm_vregs));
			mdelay(CM_HW_DELAY_MS);
			ret = cm_i2c_wr(st, CM_REG_CFG, st->rc[CM_REG_CFG] |
					1 << CM_REG_CFG_ALS_SD);
		}
		ret |= nvs_vregs_disable(&st->i2c->dev, st->vreg,
					 ARRAY_SIZE(cm_vregs));
	}
	if (ret > 0)
		ret = 0;
	if (ret) {
		dev_err(&st->i2c->dev, "%s pwr=%x ERR=%d\n",
			__func__, enable, ret);
	} else {
		if (st->sts & NVS_STS_SPEW_MSG)
			dev_info(&st->i2c->dev, "%s pwr=%x\n",
				 __func__, enable);
	}
	return ret;
}

static void cm_pm_exit(struct cm_state *st)
{
	cm_pm(st, false);
	nvs_vregs_exit(&st->i2c->dev, st->vreg, ARRAY_SIZE(cm_vregs));
}

static int cm_pm_init(struct cm_state *st)
{
	int ret;

	st->enabled = 0;
	nvs_vregs_init(&st->i2c->dev,
		       st->vreg, ARRAY_SIZE(cm_vregs), cm_vregs);
	ret = cm_pm(st, true);
	return ret;
}

static int cm_cmd_wr(struct cm_state *st, bool irq_en)
{
	u16 als_cfg;
	int ret = 0;

	als_cfg = st->als_cfg;
	als_cfg |= st->nld_tbl[st->light.nld_i].driver_data;
	cm_i2c_wr(st, CM_REG_CFG, als_cfg); /* disable IRQ */
	if (irq_en && st->i2c->irq) {
		ret = cm_i2c_wr(st, CM_REG_WL, st->light.hw_thresh_lo);
		ret |= cm_i2c_wr(st, CM_REG_WH, st->light.hw_thresh_hi);
		if (!ret) {
			als_cfg |= (1 << CM_REG_CFG_ALS_INT_EN);
			ret = cm_i2c_wr(st, CM_REG_CFG, als_cfg);
			if (!ret)
				ret = RET_HW_UPDATE; /* flag IRQ enabled */
		}
	}
	return ret;
}

static int cm_rd(struct cm_state *st)
{
	u16 hw;
	s64 ts;
	int ret = 0;

	/* spec is vague so one of these should clear the IRQ for CM32181 */
	if (st->dev_id == CM_DEVID_CM32181)
		ret = cm_i2c_rd(st, CM_REG_ALS_IF, &hw);
	ret |= cm_i2c_rd(st, CM_REG_ALS, &hw);
	if (ret)
		return ret;

	ts = nvs_timestamp();
	if (st->sts & NVS_STS_SPEW_DATA)
		dev_info(&st->i2c->dev,
			 "poll light hw %hu %lld  diff=%d %lldns  index=%u\n",
			 hw, ts, hw - st->light.hw, ts - st->light.timestamp,
			 st->light.nld_i);
	st->light.hw = hw;
	st->light.timestamp = ts;
	ret = nvs_light_read(&st->light);
	switch (ret) {
	case RET_POLL_NEXT:
		if (st->light.nld_i_change)
			ret = cm_cmd_wr(st, false);
		break;

	case RET_NO_CHANGE:
		if (st->i2c->irq)
			ret = RET_HW_UPDATE;
		break;

	case RET_HW_UPDATE:
		ret = cm_cmd_wr(st, true);
		break;

	default:
		break;
	}

	return ret;
}

static int cm_read(struct cm_state *st)
{
	int ret;

	st->nvs->nvs_mutex_lock(st->light.nvs_st);
	ret = cm_rd(st);
	st->nvs->nvs_mutex_unlock(st->light.nvs_st);
	return ret;
}

static void cm_work(struct work_struct *ws)
{
	struct cm_state *st = container_of((struct work_struct *)ws,
					   struct cm_state, ws);
	int ret;

	while (st->enabled) {
		msleep(st->light.poll_delay_ms);
		ret = cm_read(st);
		if (ret == RET_HW_UPDATE)
			/* switch to IRQ driven */
			break;
	}
}

static irqreturn_t cm_irq_thread(int irq, void *dev_id)
{
	struct cm_state *st = (struct cm_state *)dev_id;
	int ret;

	if (st->sts & NVS_STS_SPEW_IRQ)
		dev_info(&st->i2c->dev, "%s\n", __func__);
	if (st->enabled) {
		ret = cm_read(st);
		if (ret < RET_HW_UPDATE) {
			/* switch to polling */
			cancel_work_sync(&st->ws);
			queue_work(st->wq, &st->ws);
		}
	}
	return IRQ_HANDLED;
}

static int cm_disable(struct cm_state *st)
{
	int ret;

	ret = cm_pm(st, false);
	if (!ret)
		st->enabled = 0;
	return ret;
}

static int cm_enable(void *client, int snsr_id, int enable)
{
	struct cm_state *st = (struct cm_state *)client;
	int ret;

	if (enable < 0)
		return st->enabled;

	if (enable) {
		ret = cm_pm(st, true);
		if (!ret) {
			nvs_light_enable(&st->light);
			ret = cm_cmd_wr(st, false);
			if (ret) {
				cm_disable(st);
			} else {
				st->enabled = enable;
				cancel_work_sync(&st->ws);
				queue_work(st->wq, &st->ws);
			}
		}
	} else {
		ret = cm_disable(st);
	}
	return ret;
}

static int cm_batch(void *client, int snsr_id, int flags,
		    unsigned int period, unsigned int timeout)
{
	struct cm_state *st = (struct cm_state *)client;

	if (timeout)
		/* timeout not supported (no HW FIFO) */
		return -EINVAL;

	st->light.delay_us = period;
	return 0;
}

static int cm_resolution(void *client, int snsr_id, int resolution)
{
	struct cm_state *st = (struct cm_state *)client;
	int ret;

	ret = nvs_light_resolution(&st->light, resolution);
	if (st->light.nld_i_change) {
		cm_cmd_wr(st, false);
		cancel_work_sync(&st->ws);
		queue_work(st->wq, &st->ws);
	}
	return ret;
}

static int cm_max_range(void *client, int snsr_id, int max_range)
{
	struct cm_state *st = (struct cm_state *)client;
	int ret;

	ret = nvs_light_max_range(&st->light, max_range);
	if (st->light.nld_i_change) {
		cm_cmd_wr(st, false);
		cancel_work_sync(&st->ws);
		queue_work(st->wq, &st->ws);
	}
	return ret;
}

static int cm_thresh_lo(void *client, int snsr_id, int thresh_lo)
{
	struct cm_state *st = (struct cm_state *)client;

	return nvs_light_threshold_calibrate_lo(&st->light, thresh_lo);
}

static int cm_thresh_hi(void *client, int snsr_id, int thresh_hi)
{
	struct cm_state *st = (struct cm_state *)client;

	return nvs_light_threshold_calibrate_hi(&st->light, thresh_hi);
}

static int cm_regs(void *client, int snsr_id, char *buf)
{
	struct cm_state *st = (struct cm_state *)client;
	ssize_t t;
	u16 val;
	u8 i;
	u8 n;
	int ret;

	if (st->dev_id == CM_DEVID_CM32181)
		n = CM_REG_ALS_IF;
	else
		n = CM_REG_ALS;
	t = sprintf(buf, "registers:\n");
	for (i = 0; i < CM_REG_ALS; i++)
		t += sprintf(buf + t, "%#2x=%#4x\n", i, st->rc[i]);
	for (; i <= n; i++) {
		ret = cm_i2c_rd(st, i, &val);
		if (ret)
			t += sprintf(buf + t, "%#2x=ERR: %d\n", i, ret);
		else
			t += sprintf(buf + t, "%#2x=%#4x\n", i, val);
	}
	return t;
}

static int cm_nvs_write(void *client, int snsr_id, unsigned int nvs)
{
	struct cm_state *st = (struct cm_state *)client;
	u16 val;
	u8 reg;
	int ret;

	switch (nvs & 0xFF) {
	case CM_DBG_STS:
		return 0;

	case CM_DBG_CFG:
		st->als_cfg = (nvs >> 8) & st->als_cfg_mask;
		dev_info(&st->i2c->dev, "%s als_cfg=%hx\n",
			 __func__, st->als_cfg);
		return 0;

	case CM_DBG_PSM:
		if (st->dev_id == CM_DEVID_CM32181) {
			st->als_psm = (nvs >> 8) & CM_REG_PSM_MASK;
			dev_info(&st->i2c->dev,
				 "%s als_psm=%hx (applied when enabled)\n",
				 __func__, st->als_psm);
		} else {
			dev_info(&st->i2c->dev, "%s N/A\n", __func__);
		}
		return 0;

	case CM_DBG_REG:
		reg = (nvs >> 24) & 0xFF;
		val = (nvs >> 8) & 0xFFFF;
		st->nvs->nvs_mutex_lock(st->light.nvs_st);
		ret = cm_i2c_wr(st, reg, val);
		st->nvs->nvs_mutex_unlock(st->light.nvs_st);
		dev_info(&st->i2c->dev, "%s %hx=>%hhx  err=%d\n",
			 __func__, val, reg, ret);
		return ret;

	case CM_DBG_ARA:
		if (st->ara) {
			st->nvs->nvs_mutex_lock(st->light.nvs_st);
			ret = i2c_smbus_read_byte(st->ara);
			st->nvs->nvs_mutex_unlock(st->light.nvs_st);
			dev_info(&st->i2c->dev, "%s ARA=%d\n", __func__, ret);
		} else {
			dev_info(&st->i2c->dev, "%s N/A\n", __func__);
		}
		return 0;

	case CM_DBG_RD:
		cm_read(st);
		dev_info(&st->i2c->dev, "%s cm_read done\n", __func__);
		return 0;

	default:
		ret = -EINVAL;
		break;
	}

	return ret;
}

static int cm_nvs_read(void *client, int snsr_id, char *buf)
{
	struct cm_state *st = (struct cm_state *)client;
	ssize_t t;
	int ret;

	t = sprintf(buf, "driver v.%u\n", CM_DRIVER_VERSION);
	if (st->ara && st->gpio_irq >= 0) {
		ret = gpio_get_value(st->gpio_irq);
		t += sprintf(buf + t, "gpio_irq %d=%d\n", st->gpio_irq, ret);
		t += sprintf(buf + t, "ARA_WAR=%x\n", st->ara_war);
	}
	t += sprintf(buf + t, "irq=%d\n", st->i2c->irq);
	t += sprintf(buf + t, "als_cfg=%hx\n", st->als_cfg);
	if (st->dev_id == CM_DEVID_CM32181)
		t += sprintf(buf + t, "als_psm=%hx\n", st->als_psm);
	return nvs_light_dbg(&st->light, buf + t);
}

static struct nvs_fn_dev cm_fn_dev = {
	.enable				= cm_enable,
	.batch				= cm_batch,
	.resolution			= cm_resolution,
	.max_range			= cm_max_range,
	.thresh_lo			= cm_thresh_lo,
	.thresh_hi			= cm_thresh_hi,
	.regs				= cm_regs,
	.nvs_write			= cm_nvs_write,
	.nvs_read			= cm_nvs_read,
};

#ifdef CONFIG_SUSPEND
static int cm_suspend(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct cm_state *st = i2c_get_clientdata(client);
	int ret = 0;

	if (st->nvs && st->light.nvs_st)
		ret = st->nvs->suspend(st->light.nvs_st);
	if (st->sts & NVS_STS_SPEW_MSG)
		dev_info(&client->dev, "%s\n", __func__);
	return ret;
}

static int cm_resume(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct cm_state *st = i2c_get_clientdata(client);
	int ret = 0;

	if (st->nvs && st->light.nvs_st)
		ret = st->nvs->resume(st->light.nvs_st);
	if (st->sts & NVS_STS_SPEW_MSG)
		dev_info(&client->dev, "%s\n", __func__);
	return ret;
}
#endif

static SIMPLE_DEV_PM_OPS(cm_pm_ops, cm_suspend, cm_resume);

static void cm_shutdown(struct i2c_client *client)
{
	struct cm_state *st = i2c_get_clientdata(client);

	if (st->nvs && st->light.nvs_st)
		st->nvs->shutdown(st->light.nvs_st);
	if (st->sts & NVS_STS_SPEW_MSG)
		dev_info(&client->dev, "%s\n", __func__);
}

static int cm_remove(struct i2c_client *client)
{
	struct cm_state *st = i2c_get_clientdata(client);

	if (st != NULL) {
		cm_shutdown(client);
		if (st->nvs && st->light.nvs_st)
			st->nvs->remove(st->light.nvs_st);
		if (st->wq) {
			destroy_workqueue(st->wq);
			st->wq = NULL;
		}
		cm_pm_exit(st);
		if (st->ara)
			i2c_unregister_device(st->ara);
	}
	dev_info(&client->dev, "%s\n", __func__);
	return 0;
}

static int cm_id_dev(struct cm_state *st, const char *name)
{
	u16 val = 0;
	unsigned int i;
	unsigned int j;
	int ret = 1;

	/* CM3218 & CM32180 POR will come up with random registers which may
	 * cause a pending IRQ.  The WAR is to do the cm_irq_ack ARA before the
	 * first communication attempt.
	 */
	if (!strcmp(name, CM_NAME_CM3218)) {
		st->dev_id = CM_DEVID_CM3218;
		cm_irq_ack(st, true);
	} else if (!strcmp(name, CM_NAME_CM32180)) {
		st->dev_id = CM_DEVID_CM32180;
		cm_irq_ack(st, true);
	} else if ((!strcmp(name, CM_NAME_CM32181)) || !st->ara) {
		st->dev_id = CM_DEVID_CM32181;
	}
	if (!st->dev_id) {
		cm_irq_ack(st, true);
		ret = cm_i2c_rd(st, CM_REG_CFG, &val);
		if (ret) {
			return ret;
		} else {
			if (val & (1 << CM_REG_CFG_RSRV_ID)) {
				if (st->i2c_addr == 0x10)
					st->dev_id = CM_DEVID_CM3218;
				else
					/* st->i2c_addr == 0x48 */
					st->dev_id = CM_DEVID_CM32180;
			} else {
				st->dev_id = CM_DEVID_CM32181;
			}
		}
	}
	switch (st->dev_id) {
	case CM_DEVID_CM3218:
		st->cfg.part = CM_NAME_CM3218;
		st->als_cfg_mask = CM_REG_CFG_USER_MSK_CM3218;
		memcpy(&st->nld_tbl, &cm3218_nld_tbl, sizeof(cm3218_nld_tbl));
		st->light.nld_tbl_n = ARRAY_SIZE(cm3218_nld_tbl);
		i = ARRAY_SIZE(cm3218_nld_tbl) - 1;
		if (st->light.nld_i_hi > i)
			st->light.nld_i_hi = i;
		if (st->light.nld_i_lo > i)
			st->light.nld_i_lo = i;
		break;

	case CM_DEVID_CM32180:
		st->cfg.part = CM_NAME_CM32180;
		st->als_cfg_mask = CM_REG_CFG_USER_MSK_CM32180;
		memcpy(&st->nld_tbl, &cm32180_nld_tbl,
		       sizeof(cm32180_nld_tbl));
		st->light.nld_tbl_n = ARRAY_SIZE(cm32180_nld_tbl);
		i = ARRAY_SIZE(cm32180_nld_tbl) - 1;
		if (st->light.nld_i_hi > i)
			st->light.nld_i_hi = i;
		if (st->light.nld_i_lo > i)
			st->light.nld_i_lo = i;
		break;

	case CM_DEVID_CM32181:
		if (st->ara) {
			i2c_unregister_device(st->ara);
			st->ara = NULL;
		}
		st->cfg.part = CM_NAME_CM32181;
		st->als_cfg_mask = CM_REG_CFG_USER_MSK_CM32181;
		memcpy(&st->nld_tbl, &cm32181_nld_tbl, sizeof(st->nld_tbl));
		st->light.nld_tbl_n = ARRAY_SIZE(cm32181_nld_tbl);
		if (st->als_psm & (1 << CM_REG_PSM_EN)) {
			j = st->als_psm >> 1;
			for (i = 0; i < ARRAY_SIZE(cm32181_nld_tbl); i++) {
				st->nld_tbl[i].delay_min_ms +=
							      cm_psm_tbl[j].ms;
				st->nld_tbl[i].milliamp.ival =
						   cm_psm_tbl[j].milliamp.ival;
				st->nld_tbl[i].milliamp.fval =
						   cm_psm_tbl[j].milliamp.fval;
			}
		}
		break;
	}

	/* this device supports these programmable parameters */
	st->light.nld_thr = st->nld_thr;
	if (nvs_light_of_dt(&st->light, st->i2c->dev.of_node, st->cfg.part)) {
		st->light.nld_i_lo = 0;
		st->light.nld_i_hi = st->light.nld_tbl_n - 1;
	}
	st->als_cfg &= st->als_cfg_mask;
	if (ret != 1)
		dev_info(&st->i2c->dev, "%s found %s\n",
			 __func__, st->cfg.part);
	i = st->light.nld_i_lo;
	st->cfg.resolution.ival = st->nld_tbl[i].resolution.ival;
	st->cfg.resolution.fval = st->nld_tbl[i].resolution.fval;
	i = st->light.nld_i_hi;
	st->cfg.max_range.ival = st->nld_tbl[i].max_range.ival;
	st->cfg.max_range.fval = st->nld_tbl[i].max_range.fval;
	st->cfg.milliamp.ival = st->nld_tbl[i].milliamp.ival;
	st->cfg.milliamp.fval = st->nld_tbl[i].milliamp.fval;
	st->cfg.delay_us_min = st->nld_tbl[i].delay_min_ms * 1000;
	return 0;
}

static int cm_id_i2c(struct cm_state *st, const char *name)
{
	int i;
	int ret;

	for (i = 0; i < ARRAY_SIZE(cm_i2c_addrs); i++) {
		if (st->i2c->addr == cm_i2c_addrs[i])
			break;
	}

	if (i < ARRAY_SIZE(cm_i2c_addrs)) {
		st->i2c_addr = st->i2c->addr;
		ret = cm_id_dev(st, name);
	} else {
		name = CM_NAME;
		for (i = 0; i < ARRAY_SIZE(cm_i2c_addrs); i++) {
			st->i2c_addr = cm_i2c_addrs[i];
			ret = cm_id_dev(st, name);
			if (!ret)
				break;
		}
	}
	if (ret)
		st->i2c_addr = 0;
	return ret;
}

static struct sensor_cfg cm_cfg_dflt = {
	.name			= NVS_LIGHT_STRING,
	.ch_n			= 1,
	.ch_sz			= 4,
	.part			= CM_NAME,
	.vendor			= CM_VENDOR,
	.version		= CM_LIGHT_VERSION,
	.delay_us_max		= CM_POLL_DLY_MS_MAX * 1000,
	.flags			= SENSOR_FLAG_ON_CHANGE_MODE,
	.scale			= {
		.ival		= CM_LIGHT_SCALE_IVAL,
		.fval		= CM_LIGHT_SCALE_MICRO,
	},
	.thresh_lo		= CM_LIGHT_THRESHOLD_LO,
	.thresh_hi		= CM_LIGHT_THRESHOLD_HI,
};

static int cm_of_dt(struct cm_state *st, struct device_node *dn)
{
	int ret;

	/* default device specific parameters */
	st->als_cfg = CM_ALS_CFG_DFLT;
	st->als_psm = CM_ALS_PSM_DFLT;
	st->r_set = CM_R_SET_DFLT;
	/* default NVS ALS programmable parameters */
	memcpy(&st->cfg, &cm_cfg_dflt, sizeof(st->cfg));
	st->light.cfg = &st->cfg;
	st->light.hw_mask = 0xFFFF;
	st->light.nld_tbl = st->nld_tbl;
	st->gpio_irq = -1;
	/* device tree parameters */
	if (dn) {
		/* common NVS parameters */
		ret = nvs_of_dt(dn, &st->cfg, NULL);
		if (ret == -ENODEV)
			return -ENODEV;

		/* device specific parameters */
		of_property_read_u16(dn, "als_cfg", &st->als_cfg);
		of_property_read_u16(dn, "als_psm", &st->als_psm);
		st->als_psm &= CM_REG_PSM_MASK;
		of_property_read_u32(dn, "Rset", &st->r_set);
		ret = 0;
		of_property_read_s32(dn, "ARA_WAR", &ret);
		if (ret)
			st->ara_war = true;
		st->gpio_irq = of_get_named_gpio(dn, "gpio_irq", 0);
	}

	if (st->gpio_irq >= 0) {
		if (gpio_is_valid(st->gpio_irq)) {
			ret = gpio_request(st->gpio_irq, CM_NAME);
			if (ret) {
				dev_err(&st->i2c->dev,
					"%s gpio_request(%d %s) ERR:%d\n",
					__func__, st->gpio_irq, CM_NAME, ret);
				return -EPROBE_DEFER;
			} else {
				ret = gpio_direction_input(st->gpio_irq);
				if (ret < 0) {
					dev_err(&st->i2c->dev,
						"%s gpio_dir_inp(%d) ERR:%d\n",
						__func__, st->gpio_irq, ret);
					return -ENODEV;
				}
			}

			st->ara = i2c_new_dummy(st->i2c->adapter, CM_I2C_ARA);
			if (!st->ara) {
				/* must have ARA control for IRQ acknowledge */
				dev_err(&st->i2c->dev,
					"%s ERR: i2c_new_dummy\n",
					__func__);
				return -ENODEV;
			}
		} else {
			return -EPROBE_DEFER;
		}
	}

	return 0;
}

static int cm_probe(struct i2c_client *client,
		    const struct i2c_device_id *id)
{
	struct cm_state *st;
	int ret;

	dev_info(&client->dev, "%s\n", __func__);
	st = devm_kzalloc(&client->dev, sizeof(*st), GFP_KERNEL);
	if (st == NULL) {
		dev_err(&client->dev, "%s devm_kzalloc ERR\n", __func__);
		return -ENOMEM;
	}

	i2c_set_clientdata(client, st);
	st->i2c = client;
	ret = cm_of_dt(st, client->dev.of_node);
	if (ret) {
		if (ret == -ENODEV) {
			dev_info(&client->dev, "%s DT disabled\n", __func__);
		} else {
			dev_err(&client->dev, "%s _of_dt ERR\n", __func__);
			ret = -ENODEV;
		}
		goto cm_probe_exit;
	}

	cm_pm_init(st);
	ret = cm_id_i2c(st, id->name);
	if (ret) {
		dev_err(&client->dev, "%s _id_i2c ERR\n", __func__);
		ret = -ENODEV;
		goto cm_probe_exit;
	}

	cm_pm(st, false);
	cm_fn_dev.errs = &st->errs;
	cm_fn_dev.sts = &st->sts;
	st->nvs = nvs_iio();
	if (st->nvs == NULL) {
		dev_err(&client->dev, "%s nvs_iio ERR\n", __func__);
		ret = -ENODEV;
		goto cm_probe_exit;
	}

	st->light.handler = st->nvs->handler;
	ret = st->nvs->probe(&st->light.nvs_st, st, &client->dev,
			     &cm_fn_dev, &st->cfg);
	if (ret) {
		dev_err(&client->dev, "%s nvs_probe ERR\n", __func__);
		ret = -ENODEV;
		goto cm_probe_exit;
	}

	st->wq = create_workqueue(CM_NAME);
	if (!st->wq) {
		dev_err(&client->dev, "%s create_workqueue ERR\n", __func__);
		ret = -ENOMEM;
		goto cm_probe_exit;
	}

	INIT_WORK(&st->ws, cm_work);
	if (st->gpio_irq >= 0 && !client->irq)
		client->irq = gpio_to_irq(st->gpio_irq);
	if (client->irq) {
		ret = request_threaded_irq(client->irq, NULL, cm_irq_thread,
					   IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
					   CM_NAME, st);
		if (ret) {
			dev_err(&client->dev, "%s req_threaded_irq ERR %d\n",
				__func__, ret);
			ret = -ENOMEM;
			goto cm_probe_exit;
		}
	}

	dev_info(&client->dev, "%s done\n", __func__);
	return 0;

cm_probe_exit:
	cm_remove(client);
	return ret;
}

static const struct i2c_device_id cm_i2c_device_id[] = {
	{ CM_NAME, 0 },
	{ CM_NAME_CM3218, 0 },
	{ CM_NAME_CM32180, 0 },
	{ CM_NAME_CM32181, 0 },
	{}
};

MODULE_DEVICE_TABLE(i2c, cm_i2c_device_id);

static const struct of_device_id cm_of_match[] = {
	{ .compatible = "capella,cm3218x", },
	{ .compatible = "capella,cm3218", },
	{ .compatible = "capella,cm32180", },
	{ .compatible = "capella,cm32181", },
	{},
};

MODULE_DEVICE_TABLE(of, cm_of_match);

static struct i2c_driver cm_driver = {
	.class		= I2C_CLASS_HWMON,
	.probe		= cm_probe,
	.remove		= cm_remove,
	.shutdown	= cm_shutdown,
	.driver = {
		.name		= CM_NAME,
		.owner		= THIS_MODULE,
		.of_match_table	= of_match_ptr(cm_of_match),
		.pm		= &cm_pm_ops,
	},
	.id_table	= cm_i2c_device_id,
};
module_i2c_driver(cm_driver);

MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("CM3218x driver");
MODULE_AUTHOR("NVIDIA Corporation");