> (1). Not all machines use ACPI method. For example, one of my machines > loads driver by manually. the driver fails to compile if CONFIG_ACPI is not defined, e.g. on ARM platform, hence I think 'depends on ACPI' is appropriate in Kconfig maybe you could #ifdef certain function in the driver if ACPI is not available in order to support devices without ACPI drivers/iio/light/cm3218x.c: In function ‘cm3218x_acpi_get_cpm_info’: drivers/iio/light/cm3218x.c:195:2: error: unknown type name ‘acpi_handle’ drivers/iio/light/cm3218x.c:196:9: error: variable ‘buffer’ has initializer but incomplete type struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; ^ drivers/iio/light/cm3218x.c:196:31: error: ‘ACPI_ALLOCATE_BUFFER’ undeclared (first use in this function) struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; ^ ... > (2). About the ARA register, some of sensors use SMBus ARA, others use I2C > to report interrupt. I need to call i2c_new_dummy() to read the ARA > register to clean interrupt. Otherwise, device may be blocked by SMBus > protocol. In the _remove(), I have to call i2c_unregister_device(chip->ara). > Otherwise, I cannot get the handler for ARA when I reload this module. my concern is that if an error occurs in _probe() after calling i2c_new_dummy(), the matching i2c_unregister_device(chip->ara) is missing regards, p. > ----- Original Message ----- From: "Peter Meerwald" <pmeerw@xxxxxxxxxx> > To: "Kevin Tsai" <ktsai@xxxxxxxxxxxxxxxx> > Cc: "Jonathan Cameron" <jic23@xxxxxxxxxx>; <linux-iio@xxxxxxxxxxxxxxx> > Sent: Tuesday, March 25, 2014 16:39 > Subject: Re: [PATCH V3 1/1] iio: add Capella cm3218x ambient light sensor > driver. > > > > > > > Add Capella Microsystem CM3218X family Ambient Light Sensor IIO driver. > > > This driver will convert raw data to lux value. Default parameters are > > > for reference only. It will detect ACPI table to load per-system > > > manufacturing > > > parameters. > > > > > > V2: Follow Jonathan Cameron's advise to separate device id. > > > Also, follow Peter Meerwald's advise to correct whitespace, prefix, and, > > > comments. > > > > > > V3: Follow Peter Meerwald's advise to create a separated i2c_client > > > handler to > > > access SMBus ARA register. > > > > couple of minor comments... > > > > > Signed-off-by: Kevin Tsai <ktsai@xxxxxxxxxxxxxxxx> > > > --- > > > .../devicetree/bindings/i2c/trivial-devices.txt | 1 + > > > drivers/iio/light/Kconfig | 11 + > > > drivers/iio/light/Makefile | 1 + > > > drivers/iio/light/cm3218x.c | 745 > > > +++++++++++++++++++++ > > > 4 files changed, 758 insertions(+) > > > create mode 100644 drivers/iio/light/cm3218x.c > > > > > > diff --git a/Documentation/devicetree/bindings/i2c/trivial-devices.txt > > > b/Documentation/devicetree/bindings/i2c/trivial-devices.txt > > > index 1a1ac2e..c3c869b 100644 > > > --- a/Documentation/devicetree/bindings/i2c/trivial-devices.txt > > > +++ b/Documentation/devicetree/bindings/i2c/trivial-devices.txt > > > @@ -17,6 +17,7 @@ at,24c08 i2c serial eeprom (24cxx) > > > atmel,24c02 i2c serial eeprom (24cxx) > > > atmel,at97sc3204t i2c trusted platform module (TPM) > > > capella,cm32181 CM32181: Ambient Light Sensor > > > +capella,cm3218x CM3218X: Ambient Light Sensor > > > catalyst,24c32 i2c serial eeprom > > > dallas,ds1307 64 x 8, Serial, I2C Real-Time Clock > > > dallas,ds1338 I2C RTC with 56-Byte NV RAM > > > diff --git a/drivers/iio/light/Kconfig b/drivers/iio/light/Kconfig > > > index d12b2a0..97a341a 100644 > > > --- a/drivers/iio/light/Kconfig > > > +++ b/drivers/iio/light/Kconfig > > > @@ -38,6 +38,17 @@ config CM32181 > > > To compile this driver as a module, choose M here: > > > the module will be called cm32181. > > > > > > +config CM3218X > > > + depends on I2C > > > > depends on I2C && ACPI ??? > > > > > + tristate "CM3218X driver" > > > + help > > > + Say Y here if you use cm3218x. > > > + This option enables ambient light sensor using > > > + Capella cm3218x device driver. > > > + > > > + To compile this driver as a module, choose M here: > > > + the module will be called cm3218x. > > > + > > > config CM36651 > > > depends on I2C > > > tristate "CM36651 driver" > > > diff --git a/drivers/iio/light/Makefile b/drivers/iio/light/Makefile > > > index 60e35ac..a506c23 100644 > > > --- a/drivers/iio/light/Makefile > > > +++ b/drivers/iio/light/Makefile > > > @@ -6,6 +6,7 @@ > > > obj-$(CONFIG_ADJD_S311) += adjd_s311.o > > > obj-$(CONFIG_APDS9300) += apds9300.o > > > obj-$(CONFIG_CM32181) += cm32181.o > > > +obj-$(CONFIG_CM3218X) += cm3218x.o > > > obj-$(CONFIG_CM36651) += cm36651.o > > > obj-$(CONFIG_GP2AP020A00F) += gp2ap020a00f.o > > > obj-$(CONFIG_HID_SENSOR_ALS) += hid-sensor-als.o > > > diff --git a/drivers/iio/light/cm3218x.c b/drivers/iio/light/cm3218x.c > > > new file mode 100644 > > > index 0000000..efd0d0a > > > --- /dev/null > > > +++ b/drivers/iio/light/cm3218x.c > > > @@ -0,0 +1,745 @@ > > > +/* > > > + * Copyright (C) 2014 Capella Microsystems Inc. > > > + * Author: Kevin Tsai <ktsai@xxxxxxxxxxxxxxxx> > > > + * > > > + * 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. > > > + * > > > + * Special thanks Srinivas Pandruvada > > > <srinivas.pandruvada@xxxxxxxxxxxxxxx> > > > + * help to add ACPI support. > > > + * > > > + */ > > > + > > > +#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> > > > +#include <linux/init.h> > > > +#include <linux/acpi.h> > > > + > > > +/* Registers Address */ > > > +#define CM3218X_REG_ADDR_CMD 0x00 > > > +#define CM3218X_REG_ADDR_WH 0x01 > > > +#define CM3218X_REG_ADDR_WL 0x02 > > > +#define CM3218X_REG_ADDR_TEST 0x03 > > > +#define CM3218X_REG_ADDR_ALS 0x04 > > > +#define CM3218X_REG_ADDR_STATUS 0x06 > > > +#define CM3218X_REG_ADDR_ID 0x07 > > > + > > > +/* Number of Configurable Registers */ > > > +#define CM3218X_CONF_REG_NUM 16 > > > + > > > +/* CMD register */ > > > +#define CM3218X_CMD_ALS_DISABLE BIT(0) > > > +#define CM3218X_CMD_ALS_INT_EN BIT(1) > > > +#define CM3218X_CMD_ALS_THRES_WINDOW BIT(2) > > > + > > > +#define CM3218X_CMD_ALS_PERS_SHIFT 4 > > > +#define CM3218X_CMD_ALS_PERS_MASK (0x03 << CM3218X_CMD_ALS_PERS_SHIFT) > > > +#define CM3218X_CMD_ALS_PERS_DEFAULT (0x01 << > > > CM3218X_CMD_ALS_PERS_SHIFT) > > > + > > > +#define CM3218X_CMD_ALS_IT_SHIFT 6 > > > +#define CM3218X_CMD_ALS_IT_MASK (0x0F << CM3218X_CMD_ALS_IT_SHIFT) > > > +#define CM3218X_CMD_ALS_IT_DEFAULT (0x01 << CM3218X_CMD_ALS_IT_SHIFT) > > > + > > > +#define CM3218X_CMD_ALS_HS_SHIFT 11 > > > +#define CM3218X_CMD_ALS_HS_MASK (0x01 << CM3218X_CMD_ALS_HS_SHIFT) > > > +#define CM3218X_CMD_ALS_HS_DEFAULT (0x00 << CM3218X_CMD_ALS_HS_SHIFT) > > > + > > > +#define CM3218X_CMD_DEFAULT (CM3218X_CMD_ALS_THRES_WINDOW |\ > > > + CM3218X_CMD_ALS_PERS_DEFAULT |\ > > > + CM3218X_CMD_ALS_IT_DEFAULT |\ > > > + CM3218X_CMD_ALS_HS_DEFAULT) > > > + > > > +#define CM3218X_WH_DEFAULT 0xFFFF > > > +#define CM3218X_WL_DEFAULT 0x0000 > > > + > > > +#define CM3218X_CALIBSCALE_DEFAULT 100000 > > > +#define CM3218X_CALIBSCALE_RESOLUTION 100000 > > > +#define CM3218X_MLUX_PER_LUX 1000 > > > +#define CM3218X_THRESHOLD_PERCENT 10 /* 10 percent */ > > > + > > > +#define CM3218X_ARA 0x0C > > > + > > > +/* CM3218X family */ > > > +enum { > > > + cm3218, > > > + cm32181, > > > + cm32182 > > > +}; > > > + > > > +/* CM3218 Family */ > > > +#define CM3218_MLUX_PER_BIT_DEFAULT 5 /* Depend on system */ > > > +#define CM3218_MLUX_PER_BIT_BASE_IT 800000 > > > +static const int CM3218_als_it_bits[] = {0, 1, 2, 3}; > > > +static const int CM3218_als_it_values[] = {100000, 200000, 400000, > > > 800000}; > > > + > > > +/* CM32181 Family */ > > > +#define CM32181_MLUX_PER_BIT_DEFAULT 5 > > > +#define CM32181_MLUX_PER_BIT_BASE_IT 800000 > > > +static const int CM32181_als_it_bits[] = {12, 8, 0, 1, 2, 3}; > > > +static const int CM32181_als_it_values[] = { > > > + 25000, 50000, 100000, 200000, 400000, 800000}; > > > + > > > +struct cm3218x_als_info { > > > + u32 id; > > > + int int_type; > > > +#define CM3218X_INT_TYPE_SMBUS 0 > > > +#define CM3218X_INT_TYPE_I2C 1 > > > + int regs_bmp; > > > + int calibscale; > > > + int mlux_per_bit; > > > + int mlux_per_bit_base_it; > > > + const int *als_it_bits; > > > + const int *als_it_values; > > > + int num_als_it; > > > + int als_raw; > > > +}; > > > + > > > +static struct cm3218x_als_info cm3218_info = { > > > + 3218, CM3218X_INT_TYPE_SMBUS, 0x0F, CM3218X_CALIBSCALE_DEFAULT, > > > + CM3218_MLUX_PER_BIT_DEFAULT, CM3218_MLUX_PER_BIT_BASE_IT, > > > + CM3218_als_it_bits, CM3218_als_it_values, > > > + ARRAY_SIZE(CM3218_als_it_bits), 0}; > > > > const? > > > > > + > > > +static struct cm3218x_als_info cm32181_info = { > > > + 32181, CM3218X_INT_TYPE_I2C, 0x0F, CM3218X_CALIBSCALE_DEFAULT, > > > + CM32181_MLUX_PER_BIT_DEFAULT, CM32181_MLUX_PER_BIT_BASE_IT, > > > + CM32181_als_it_bits, CM32181_als_it_values, > > > + ARRAY_SIZE(CM32181_als_it_bits), 0}; > > > + > > > +static struct cm3218x_als_info cm32182_info = { > > > + 32182, CM3218X_INT_TYPE_I2C, 0x0F, CM3218X_CALIBSCALE_DEFAULT, > > > + CM32181_MLUX_PER_BIT_DEFAULT, CM32181_MLUX_PER_BIT_BASE_IT, > > > + CM32181_als_it_bits, CM32181_als_it_values, > > > + ARRAY_SIZE(CM32181_als_it_bits), 0}; > > > + > > > +struct cm3218x_chip { > > > + struct i2c_client *client; > > > + struct i2c_client *ara; > > > + struct mutex lock; > > > + u16 conf_regs[CM3218X_CONF_REG_NUM]; > > > + struct cm3218x_als_info *als_info; > > > +}; > > > + > > > +static int cm3218x_get_lux(struct cm3218x_chip *chip); > > > +static int cm3218x_threshold_update(struct cm3218x_chip *chip, int > > > percent); > > > +static int cm3218x_read_als_it(struct cm3218x_chip *chip, int *val2); > > > + > > > +/** > > > + * cm3218x_interrupt_config() - Enable/Disable CM3218X interrupt > > > + * @chip: pointer of struct cm3218x. > > > + * @enable: 0 to disable; otherwise to enable > > > + * > > > + * Config CM3218X interrupt control bit. > > > + * > > > + * Return: 0 for success; otherwise for error code. > > > + */ > > > +static int cm3218x_interrupt_config(struct cm3218x_chip *chip, int > > > enable) > > > +{ > > > + struct i2c_client *client = chip->client; > > > + struct cm3218x_als_info *als_info = chip->als_info; > > > + int status; > > > + > > > + if (!als_info) > > > + return -ENODEV; > > > + > > > + /* Force to clean interrupt */ > > > + if (als_info->int_type == CM3218X_INT_TYPE_I2C) { > > > + status = i2c_smbus_read_word_data(client, > > > + CM3218X_REG_ADDR_STATUS); > > > + if (status < 0) > > > + als_info->int_type = CM3218X_INT_TYPE_SMBUS; > > > + } > > > + if (chip->ara && als_info->int_type == CM3218X_INT_TYPE_SMBUS) > > > + i2c_smbus_read_byte(chip->ara); > > > + > > > + if (enable) > > > + chip->conf_regs[CM3218X_REG_ADDR_CMD] |= > > > + CM3218X_CMD_ALS_INT_EN; > > > + else > > > + chip->conf_regs[CM3218X_REG_ADDR_CMD] &= > > > + ~CM3218X_CMD_ALS_INT_EN; > > > + > > > + status = i2c_smbus_write_word_data(client, CM3218X_REG_ADDR_CMD, > > > + chip->conf_regs[CM3218X_REG_ADDR_CMD]); > > > + > > > + if (status < 0) > > > + return -ENODEV; > > > + > > > + return status; > > > +} > > > + > > > +/** > > > + * cm3218x_acpi_get_cpm_info() - Get CPM object from ACPI > > > + * @client pointer of struct i2c_client. > > > + * @obj_name pointer of ACPI object name. > > > + * @count maximum size of return array. > > > + * @vals pointer of array for return elements. > > > + * > > > + * Convert ACPI CPM table to array. Special thanks Srinivas Pandruvada's > > > + * help to implement this routine. > > > + * > > > + * Return: -ENODEV for fail. Otherwise is number of elements. > > > + */ > > > +static int cm3218x_acpi_get_cpm_info(struct i2c_client *client, char > > > *obj_name, > > > + int count, u64 *vals) > > > +{ > > > + acpi_handle handle; > > > + struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; > > > + int i; > > > + acpi_status status; > > > + union acpi_object *cpm; > > > + > > > + handle = ACPI_HANDLE(&client->dev); > > > + if (!handle) > > > + return -ENODEV; > > > + > > > + status = acpi_evaluate_object(handle, obj_name, NULL, &buffer); > > > + if (ACPI_FAILURE(status)) { > > > + dev_err(&client->dev, "object %s not found\n", obj_name); > > > + return -ENODEV; > > > + } > > > + > > > + cpm = buffer.pointer; > > > + for (i = 0; i < cpm->package.count && i < count; ++i) { > > > + union acpi_object *elem; > > > + elem = &(cpm->package.elements[i]); > > > + vals[i] = elem->integer.value; > > > + } > > > + > > > + kfree(buffer.pointer); > > > + > > > + return cpm->package.count; > > > +} > > > + > > > +/** > > > + * cm3218x_reg_init() - Initialize CM3218X registers > > > + * @chip: pointer of struct cm3218x. > > > + * > > > + * Initialize CM3218X ambient light sensor register to default values. > > > + * > > > + Return: 0 for success; otherwise for error code. > > > + */ > > > +static int cm3218x_reg_init(struct cm3218x_chip *chip) > > > +{ > > > + struct i2c_client *client = chip->client; > > > + int i; > > > + s32 ret; > > > + int cpm_elem_count; > > > + u64 cpm_elems[20]; > > > + struct cm3218x_als_info *als_info; > > > + > > > + /* Default device */ > > > + chip->als_info = &cm3218_info; > > > + chip->conf_regs[CM3218X_REG_ADDR_CMD] = CM3218X_CMD_DEFAULT; > > > + chip->conf_regs[CM3218X_REG_ADDR_WH] = CM3218X_WH_DEFAULT; > > > + chip->conf_regs[CM3218X_REG_ADDR_WL] = CM3218X_WL_DEFAULT; > > > + > > > + /* Disable interrupt */ > > > + cm3218x_interrupt_config(chip, 0); > > > + > > > + /* Disable Test Mode */ > > > + i2c_smbus_write_word_data(client, CM3218X_REG_ADDR_TEST, 0x0000); > > > + > > > + /* Disable device */ > > > + i2c_smbus_write_word_data(client, CM3218X_REG_ADDR_CMD, > > > + CM3218X_CMD_ALS_DISABLE); > > > + > > > + /* Identify device */ > > > + ret = i2c_smbus_read_word_data(client, CM3218X_REG_ADDR_ID); > > > + if (ret < 0) > > > + return ret; > > > + switch (ret & 0xFF) { > > > + case 0x18: > > > + als_info = chip->als_info = &cm3218_info; > > > + if (ret & 0x0800) > > > + als_info->int_type = CM3218X_INT_TYPE_I2C; > > > + else > > > + als_info->int_type = CM3218X_INT_TYPE_SMBUS; > > > + break; > > > + case 0x81: > > > + als_info = chip->als_info = &cm32181_info; > > > + break; > > > + case 0x82: > > > + als_info = chip->als_info = &cm32182_info; > > > + break; > > > + default: > > > + return -ENODEV; > > > + } > > > + > > > + if (ACPI_HANDLE(&client->dev)) { > > > + /* Load from ACPI */ > > > + cpm_elem_count = cm3218x_acpi_get_cpm_info(client, "CPM0", > > > + ARRAY_SIZE(cpm_elems), > > > + cpm_elems); > > > + if (cpm_elem_count > 0) { > > > + int header_num = 3; > > > + int reg_num = cpm_elem_count - header_num; > > > + > > > + als_info->regs_bmp = cpm_elems[2]; > > > + for (i = 0; i < reg_num; i++) > > > + if (als_info->regs_bmp & (1<<i)) > > > + chip->conf_regs[i] = > > > + cpm_elems[header_num+i]; > > > + } > > > + > > > + cpm_elem_count = cm3218x_acpi_get_cpm_info(client, "CPM1", > > > + ARRAY_SIZE(cpm_elems), > > > + cpm_elems); > > > + if (cpm_elem_count > 0) { > > > + als_info->mlux_per_bit = (int)cpm_elems[0] / 100; > > > + als_info->calibscale = (int)cpm_elems[1]; > > > + } > > > + } > > > + > > > + /* Force to disable interrupt */ > > > + chip->conf_regs[CM3218X_REG_ADDR_CMD] &= ~CM3218X_CMD_ALS_INT_EN; > > > + > > > + /* Initialize registers */ > > > + for (i = 0; i < CM3218X_CONF_REG_NUM; i++) { > > > + if (als_info->regs_bmp & (1<<i)) { > > > + ret = i2c_smbus_write_word_data(client, i, > > > + chip->conf_regs[i]); > > > + if (ret < 0) > > > + return ret; > > > + } > > > + } > > > + > > > + return 0; > > > +} > > > + > > > +/** > > > + * cm3218x_read_als_it() - Get sensor integration time (ms) > > > + * @chip: pointer of struct cm3218x > > > + * @val2: pointer of int to load the als_it value. > > > + * > > > + * Report the current integartion time in milliseconds. > > > > integration > > > > > + * > > > + * Return: IIO_VAL_INT_PLUS_MICRO for success, otherwise -EINVAL. > > > + */ > > > +static int cm3218x_read_als_it(struct cm3218x_chip *chip, int *val2) > > > +{ > > > + struct cm3218x_als_info *als_info = chip->als_info; > > > + u16 als_it; > > > + int i; > > > + > > > + als_it = chip->conf_regs[CM3218X_REG_ADDR_CMD]; > > > + als_it &= CM3218X_CMD_ALS_IT_MASK; > > > + als_it >>= CM3218X_CMD_ALS_IT_SHIFT; > > > + for (i = 0; i < als_info->num_als_it; i++) { > > > + if (als_it == als_info->als_it_bits[i]) { > > > + *val2 = als_info->als_it_values[i]; > > > + return IIO_VAL_INT_PLUS_MICRO; > > > + } > > > + } > > > + > > > + return -EINVAL; > > > +} > > > + > > > +/** > > > + * cm3218x_write_als_it() - Write sensor integration time > > > + * @chip: pointer of struct cm3218x. > > > + * @val: integration time in milliseconds. > > > + * > > > + * Convert integration time (ms) to sensor value. > > > + * > > > + * Return: i2c_smbus_write_word_data command return value. > > > + */ > > > +static int cm3218x_write_als_it(struct cm3218x_chip *chip, int val) > > > +{ > > > + struct i2c_client *client = chip->client; > > > + struct cm3218x_als_info *als_info = chip->als_info; > > > + u16 als_it; > > > + int ret, i; > > > + > > > + for (i = 0; i < als_info->num_als_it; i++) > > > + if (val <= als_info->als_it_values[i]) > > > + break; > > > + if (i >= als_info->num_als_it) > > > + i = als_info->num_als_it - 1; > > > + > > > + als_it = als_info->als_it_bits[i]; > > > + als_it <<= CM3218X_CMD_ALS_IT_SHIFT; > > > + > > > + mutex_lock(&chip->lock); > > > + chip->conf_regs[CM3218X_REG_ADDR_CMD] &= > > > + ~CM3218X_CMD_ALS_IT_MASK; > > > + chip->conf_regs[CM3218X_REG_ADDR_CMD] |= > > > + als_it; > > > + ret = i2c_smbus_write_word_data(client, CM3218X_REG_ADDR_CMD, > > > + chip->conf_regs[CM3218X_REG_ADDR_CMD]); > > > + mutex_unlock(&chip->lock); > > > + > > > + return ret; > > > +} > > > + > > > +/** > > > + * cm3218x_get_lux() - report current lux value > > > + * @chip: pointer of struct cm3218x. > > > + * > > > + * Convert sensor raw data to lux. It depends on integration > > > + * time and calibscale variable. > > > + * > > > + * Return: Positive value is lux, otherwise is error code. > > > + */ > > > +static int cm3218x_get_lux(struct cm3218x_chip *chip) > > > +{ > > > + struct i2c_client *client = chip->client; > > > + struct cm3218x_als_info *als_info = chip->als_info; > > > + int ret; > > > + int als_it; > > > + u64 tmp; > > > + > > > + /* Calculate mlux per bit based on als_it */ > > > + ret = cm3218x_read_als_it(chip, &als_it); > > > + if (ret < 0) > > > + return -EINVAL; > > > + tmp = (__force u64)als_info->mlux_per_bit; > > > + tmp *= als_info->mlux_per_bit_base_it; > > > + tmp = div_u64(tmp, als_it); > > > + > > > + /* Get als_raw */ > > > + if (!(chip->conf_regs[CM3218X_REG_ADDR_CMD] & CM3218X_CMD_ALS_INT_EN)) > > > + als_info->als_raw = i2c_smbus_read_word_data( > > > + client, > > > + CM3218X_REG_ADDR_ALS); > > > + if (als_info->als_raw < 0) > > > + return als_info->als_raw; > > > + > > > + tmp *= als_info->als_raw; > > > + tmp *= als_info->calibscale; > > > + tmp = div_u64(tmp, CM3218X_CALIBSCALE_RESOLUTION); > > > + tmp = div_u64(tmp, CM3218X_MLUX_PER_LUX); > > > + > > > + if (tmp > 0xFFFF) > > > + tmp = 0xFFFF; > > > + > > > + return (int)tmp; > > > +} > > > + > > > +static int cm3218x_read_raw(struct iio_dev *indio_dev, > > > + struct iio_chan_spec const *chan, > > > + int *val, int *val2, long mask) > > > +{ > > > + struct cm3218x_chip *chip = iio_priv(indio_dev); > > > + struct cm3218x_als_info *als_info = chip->als_info; > > > + int ret; > > > + > > > + switch (mask) { > > > + case IIO_CHAN_INFO_PROCESSED: > > > + ret = cm3218x_get_lux(chip); > > > + if (ret < 0) > > > + return ret; > > > + *val = ret; > > > + return IIO_VAL_INT; > > > + case IIO_CHAN_INFO_CALIBSCALE: > > > + *val = als_info->calibscale; > > > + return IIO_VAL_INT; > > > + case IIO_CHAN_INFO_INT_TIME: > > > + *val = 0; > > > + ret = cm3218x_read_als_it(chip, val2); > > > + return ret; > > > + } > > > + > > > + return -EINVAL; > > > +} > > > + > > > +static int cm3218x_write_raw(struct iio_dev *indio_dev, > > > + struct iio_chan_spec const *chan, > > > + int val, int val2, long mask) > > > +{ > > > + struct cm3218x_chip *chip = iio_priv(indio_dev); > > > + struct cm3218x_als_info *als_info = chip->als_info; > > > + long ms; > > > + > > > + switch (mask) { > > > + case IIO_CHAN_INFO_CALIBSCALE: > > > + als_info->calibscale = val; > > > + return val; > > > + case IIO_CHAN_INFO_INT_TIME: > > > + ms = val * 1000000 + val2; > > > + return cm3218x_write_als_it(chip, (int)ms); > > > + } > > > + > > > + return -EINVAL; > > > +} > > > + > > > +/** > > > + * cm3218x_get_it_available() - Get available ALS IT value > > > + * @dev: pointer of struct device. > > > + * @attr: pointer of struct device_attribute. > > > + * @buf: pointer of return string buffer. > > > + * > > > + * Display the available integration time in milliseconds. > > > + * > > > + * Return: string length. > > > + */ > > > +static ssize_t cm3218x_get_it_available(struct device *dev, > > > + struct device_attribute *attr, char *buf) > > > +{ > > > + struct cm3218x_chip *chip = iio_priv(dev_to_iio_dev(dev)); > > > + struct cm3218x_als_info *als_info = chip->als_info; > > > + int i, len; > > > + > > > + for (i = 0, len = 0; i < als_info->num_als_it; i++) > > > + len += scnprintf(buf + len, PAGE_SIZE - len, "%u.%06u ", > > > + als_info->als_it_values[i]/1000000, > > > + als_info->als_it_values[i]%1000000); > > > + return len + scnprintf(buf + len, PAGE_SIZE - len, "\n"); > > > +} > > > + > > > +/** > > > + * cm3218x_threshold_update() - Update the threshold registers. > > > + * @chip: pointer of struct cm3218x_chip. > > > + * @percent: +/- percent. > > > + * > > > + * Based on the current ALS value, tupdate the hi and low threshold > > > registers. > > > > tupdate? > > > > > + * > > > + * Return: 0 for success; otherwise for error code. > > > + */ > > > +static int cm3218x_threshold_update(struct cm3218x_chip *chip, int > > > percent) > > > +{ > > > + struct i2c_client *client = chip->client; > > > + struct cm3218x_als_info *als_info = chip->als_info; > > > + int ret; > > > + int wh, wl; > > > + > > > + ret = als_info->als_raw = i2c_smbus_read_word_data(client, > > > + CM3218X_REG_ADDR_ALS); > > > + if (ret < 0) > > > + return ret; > > > + > > > + wh = wl = ret; > > > + ret *= percent; > > > + ret /= 100; > > > + if (ret < 1) > > > + ret = 1; > > > + wh += ret; > > > + wl -= ret; > > > + if (wh > 65535) > > > + wh = 65535; > > > + if (wl < 0) > > > + wl = 0; > > > + > > > + chip->conf_regs[CM3218X_REG_ADDR_WH] = wh; > > > + ret = i2c_smbus_write_word_data( > > > + client, > > > + CM3218X_REG_ADDR_WH, > > > + chip->conf_regs[CM3218X_REG_ADDR_WH]); > > > + if (ret < 0) > > > + return ret; > > > + > > > + chip->conf_regs[CM3218X_REG_ADDR_WL] = wl; > > > + ret = i2c_smbus_write_word_data( > > > + client, > > > + CM3218X_REG_ADDR_WL, > > > + chip->conf_regs[CM3218X_REG_ADDR_WL]); > > > + > > > + return ret; > > > +} > > > + > > > +/** > > > + * cm3218x_event_handler() - Interrupt handling routine. > > > + * @irq: irq number. > > > + * @private: pointer of void. > > > + * > > > + * Clean interrupt and reset threshold registers. > > > + * > > > + * Return: IRQ_HANDLED. > > > + */ > > > +static irqreturn_t cm3218x_event_handler(int irq, void *private) > > > +{ > > > + struct iio_dev *dev_info = private; > > > + struct cm3218x_chip *chip = iio_priv(dev_info); > > > + int ret; > > > + > > > + mutex_lock(&chip->lock); > > > + > > > + /* Disable interrupt */ > > > + ret = cm3218x_interrupt_config(chip, 0); > > > + if (ret < 0) > > > + goto error_handler_unlock; > > > + > > > + /* Update Hi/Lo windows */ > > > + ret = cm3218x_threshold_update(chip, CM3218X_THRESHOLD_PERCENT); > > > + if (ret < 0) > > > + goto error_handler_unlock; > > > + > > > + /* Enable interrupt */ > > > + ret = cm3218x_interrupt_config(chip, 1); > > > > no need to check ret value > > > > > + if (ret < 0) > > > + goto error_handler_unlock; > > > + > > > +error_handler_unlock: > > > + mutex_unlock(&chip->lock); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +static const struct iio_chan_spec cm3218x_channels[] = { > > > + { > > > + .type = IIO_LIGHT, > > > + .info_mask_separate = > > > + BIT(IIO_CHAN_INFO_PROCESSED) | > > > + BIT(IIO_CHAN_INFO_CALIBSCALE) | > > > + BIT(IIO_CHAN_INFO_INT_TIME), > > > + } > > > +}; > > > + > > > +static IIO_DEVICE_ATTR(in_illuminance_integration_time_available, > > > + S_IRUGO, cm3218x_get_it_available, NULL, 0); > > > + > > > +static struct attribute *cm3218x_attributes[] = { > > > + &iio_dev_attr_in_illuminance_integration_time_available.dev_attr.attr, > > > + NULL, > > > +}; > > > + > > > +static const struct attribute_group cm3218x_attribute_group = { > > > + .attrs = cm3218x_attributes > > > +}; > > > + > > > +static const struct iio_info cm3218x_info = { > > > + .driver_module = THIS_MODULE, > > > + .read_raw = &cm3218x_read_raw, > > > + .write_raw = &cm3218x_write_raw, > > > + .attrs = &cm3218x_attribute_group, > > > +}; > > > + > > > +static int cm3218x_probe(struct i2c_client *client, > > > + const struct i2c_device_id *id) > > > +{ > > > + struct cm3218x_chip *chip; > > > + struct iio_dev *indio_dev; > > > + int ret; > > > + > > > + indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*chip)); > > > + if (!indio_dev) { > > > + dev_err(&client->dev, "devm_iio_device_alloc failed\n"); > > > + return -ENOMEM; > > > + } > > > + > > > + chip = iio_priv(indio_dev); > > > + i2c_set_clientdata(client, indio_dev); > > > + chip->client = client; > > > + chip->ara = i2c_new_dummy(client->adapter, CM3218X_ARA); > > > + > > > > there is no i2c_unregister_device(chip->ara) in the error path below; but > > i2c_unregister_device(chip->ara) is called in _remove() > > > > > + mutex_init(&chip->lock); > > > + indio_dev->dev.parent = &client->dev; > > > + indio_dev->channels = cm3218x_channels; > > > + indio_dev->num_channels = ARRAY_SIZE(cm3218x_channels); > > > + indio_dev->info = &cm3218x_info; > > > + if (id && id->name) > > > + indio_dev->name = id->name; > > > + else > > > + indio_dev->name = (char *)dev_name(&client->dev); > > > + indio_dev->modes = INDIO_DIRECT_MODE; > > > + > > > + ret = cm3218x_reg_init(chip); > > > + if (ret) { > > > + dev_err(&client->dev, > > > + "%s: register init failed\n", > > > + __func__); > > > + return ret; > > > + } > > > + > > > + if (client->irq) { > > > + ret = request_threaded_irq(client->irq, > > > + NULL, > > > + cm3218x_event_handler, > > > + IRQF_TRIGGER_FALLING | IRQF_ONESHOT, > > > + "cm3218x_event", > > > + indio_dev); > > > + > > > + if (ret < 0) { > > > + dev_err(&client->dev, "irq request error %d\n", > > > + -ret); > > > + goto error_disable_int; > > > + } > > > + } > > > + > > > + ret = iio_device_register(indio_dev); > > > + if (ret < 0) { > > > + dev_err(&client->dev, > > > + "%s: regist device failed\n", > > > + __func__); > > > + goto error_free_irq; > > > + } > > > + > > > + if (client->irq) { > > > + ret = cm3218x_threshold_update(chip, CM3218X_THRESHOLD_PERCENT); > > > + if (ret < 0) > > > + goto error_free_irq; > > > + > > > + ret = cm3218x_interrupt_config(chip, 1); > > > + if (ret < 0) > > > + goto error_free_irq; > > > + } > > > + > > > + return 0; > > > + > > > +error_free_irq: > > > + free_irq(client->irq, indio_dev); > > > > in _remove() free_irq() is only called when client->irq != 0 > > > > > +error_disable_int: > > > + cm3218x_interrupt_config(chip, 0); > > > + return ret; > > > +} > > > + > > > +static int cm3218x_remove(struct i2c_client *client) > > > +{ > > > + struct iio_dev *indio_dev = i2c_get_clientdata(client); > > > + struct cm3218x_chip *chip = iio_priv(indio_dev); > > > + > > > + cm3218x_interrupt_config(chip, 0); > > > + if (chip->ara) > > > + i2c_unregister_device(chip->ara); > > > + if (client->irq) > > > + free_irq(client->irq, indio_dev); > > > + iio_device_unregister(indio_dev); > > > + return 0; > > > +} > > > + > > > +static const struct i2c_device_id cm3218x_id[] = { > > > + { "cm3218", cm3218}, > > > + { "cm32181", cm32181}, > > > + { "cm32182", cm32182}, > > > + { } > > > +}; > > > + > > > +MODULE_DEVICE_TABLE(i2c, cm3218x_id); > > > + > > > +static const struct of_device_id cm3218x_of_match[] = { > > > + { .compatible = "capella,cm3218" }, > > > + { } > > > +}; > > > + > > > +static const struct acpi_device_id cm3218x_acpi_match[] = { > > > + { "CPLM3218", 0}, > > > + {}, > > > +}; > > > + > > > +MODULE_DEVICE_TABLE(acpi, cm3218x_acpi_match); > > > + > > > +static struct i2c_driver cm3218x_driver = { > > > + .driver = { > > > + .name = "cm3218x", > > > + .acpi_match_table = ACPI_PTR(cm3218x_acpi_match), > > > + .of_match_table = of_match_ptr(cm3218x_of_match), > > > + .owner = THIS_MODULE, > > > + }, > > > + .id_table = cm3218x_id, > > > + .probe = cm3218x_probe, > > > + .remove = cm3218x_remove, > > > +}; > > > + > > > +module_i2c_driver(cm3218x_driver); > > > + > > > +MODULE_AUTHOR("Kevin Tsai <ktsai@xxxxxxxxxxxxxxxx>"); > > > +MODULE_DESCRIPTION("CM3218X ambient light sensor driver"); > > > +MODULE_LICENSE("GPL"); > > > > > > > -- > > > > Peter Meerwald > > +43-664-2444418 (mobile) > -- Peter Meerwald +43-664-2444418 (mobile)