136edc939SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 262a1efb9SPeter Meerwald /* 35a441aadSAngus Ainslie (Purism) * vcnl4000.c - Support for Vishay VCNL4000/4010/4020/4040/4200 combined ambient 4d978bfddSPeter Meerwald-Stadler * light and proximity sensor 562a1efb9SPeter Meerwald * 662a1efb9SPeter Meerwald * Copyright 2012 Peter Meerwald <pmeerw@pmeerw.net> 75a441aadSAngus Ainslie (Purism) * Copyright 2019 Pursim SPC 862a1efb9SPeter Meerwald * 9be38866fSTomas Novotny * IIO driver for: 10be38866fSTomas Novotny * VCNL4000/10/20 (7-bit I2C slave address 0x13) 115a441aadSAngus Ainslie (Purism) * VCNL4040 (7-bit I2C slave address 0x60) 12be38866fSTomas Novotny * VCNL4200 (7-bit I2C slave address 0x51) 1362a1efb9SPeter Meerwald * 1462a1efb9SPeter Meerwald * TODO: 1562a1efb9SPeter Meerwald * allow to adjust IR current 1662a1efb9SPeter Meerwald * proximity threshold and event handling 17d978bfddSPeter Meerwald-Stadler * periodic ALS/proximity measurement (VCNL4010/20) 185a441aadSAngus Ainslie (Purism) * interrupts (VCNL4010/20/40, VCNL4200) 1962a1efb9SPeter Meerwald */ 2062a1efb9SPeter Meerwald 2162a1efb9SPeter Meerwald #include <linux/module.h> 2262a1efb9SPeter Meerwald #include <linux/i2c.h> 2362a1efb9SPeter Meerwald #include <linux/err.h> 2462a1efb9SPeter Meerwald #include <linux/delay.h> 2562a1efb9SPeter Meerwald 2662a1efb9SPeter Meerwald #include <linux/iio/iio.h> 2762a1efb9SPeter Meerwald #include <linux/iio/sysfs.h> 2862a1efb9SPeter Meerwald 2962a1efb9SPeter Meerwald #define VCNL4000_DRV_NAME "vcnl4000" 301ebc787aSTomas Novotny #define VCNL4000_PROD_ID 0x01 311ebc787aSTomas Novotny #define VCNL4010_PROD_ID 0x02 /* for VCNL4020, VCNL4010 */ 325a441aadSAngus Ainslie (Purism) #define VCNL4040_PROD_ID 0x86 33be38866fSTomas Novotny #define VCNL4200_PROD_ID 0x58 3462a1efb9SPeter Meerwald 3562a1efb9SPeter Meerwald #define VCNL4000_COMMAND 0x80 /* Command register */ 3662a1efb9SPeter Meerwald #define VCNL4000_PROD_REV 0x81 /* Product ID and Revision ID */ 3762a1efb9SPeter Meerwald #define VCNL4000_LED_CURRENT 0x83 /* IR LED current for proximity mode */ 3862a1efb9SPeter Meerwald #define VCNL4000_AL_PARAM 0x84 /* Ambient light parameter register */ 3962a1efb9SPeter Meerwald #define VCNL4000_AL_RESULT_HI 0x85 /* Ambient light result register, MSB */ 4062a1efb9SPeter Meerwald #define VCNL4000_AL_RESULT_LO 0x86 /* Ambient light result register, LSB */ 4162a1efb9SPeter Meerwald #define VCNL4000_PS_RESULT_HI 0x87 /* Proximity result register, MSB */ 4262a1efb9SPeter Meerwald #define VCNL4000_PS_RESULT_LO 0x88 /* Proximity result register, LSB */ 4362a1efb9SPeter Meerwald #define VCNL4000_PS_MEAS_FREQ 0x89 /* Proximity test signal frequency */ 4462a1efb9SPeter Meerwald #define VCNL4000_PS_MOD_ADJ 0x8a /* Proximity modulator timing adjustment */ 4562a1efb9SPeter Meerwald 46be38866fSTomas Novotny #define VCNL4200_AL_CONF 0x00 /* Ambient light configuration */ 47be38866fSTomas Novotny #define VCNL4200_PS_CONF1 0x03 /* Proximity configuration */ 48be38866fSTomas Novotny #define VCNL4200_PS_DATA 0x08 /* Proximity data */ 49be38866fSTomas Novotny #define VCNL4200_AL_DATA 0x09 /* Ambient light data */ 50be38866fSTomas Novotny #define VCNL4200_DEV_ID 0x0e /* Device ID, slave address and version */ 51be38866fSTomas Novotny 525a441aadSAngus Ainslie (Purism) #define VCNL4040_DEV_ID 0x0c /* Device ID and version */ 535a441aadSAngus Ainslie (Purism) 5462a1efb9SPeter Meerwald /* Bit masks for COMMAND register */ 55ff6a5259SPeter Meerwald-Stadler #define VCNL4000_AL_RDY BIT(6) /* ALS data ready? */ 56ff6a5259SPeter Meerwald-Stadler #define VCNL4000_PS_RDY BIT(5) /* proximity data ready? */ 57ff6a5259SPeter Meerwald-Stadler #define VCNL4000_AL_OD BIT(4) /* start on-demand ALS measurement */ 58ff6a5259SPeter Meerwald-Stadler #define VCNL4000_PS_OD BIT(3) /* start on-demand proximity measurement */ 5962a1efb9SPeter Meerwald 601ebc787aSTomas Novotny enum vcnl4000_device_ids { 611ebc787aSTomas Novotny VCNL4000, 6250c50b97STomas Novotny VCNL4010, 635a441aadSAngus Ainslie (Purism) VCNL4040, 64be38866fSTomas Novotny VCNL4200, 65be38866fSTomas Novotny }; 66be38866fSTomas Novotny 67be38866fSTomas Novotny struct vcnl4200_channel { 68be38866fSTomas Novotny u8 reg; 69be38866fSTomas Novotny ktime_t last_measurement; 70be38866fSTomas Novotny ktime_t sampling_rate; 71be38866fSTomas Novotny struct mutex lock; 721ebc787aSTomas Novotny }; 731ebc787aSTomas Novotny 7462a1efb9SPeter Meerwald struct vcnl4000_data { 7562a1efb9SPeter Meerwald struct i2c_client *client; 761ebc787aSTomas Novotny enum vcnl4000_device_ids id; 771ebc787aSTomas Novotny int rev; 781ebc787aSTomas Novotny int al_scale; 791ebc787aSTomas Novotny const struct vcnl4000_chip_spec *chip_spec; 80be38866fSTomas Novotny struct mutex vcnl4000_lock; 81be38866fSTomas Novotny struct vcnl4200_channel vcnl4200_al; 82be38866fSTomas Novotny struct vcnl4200_channel vcnl4200_ps; 8362a1efb9SPeter Meerwald }; 8462a1efb9SPeter Meerwald 851ebc787aSTomas Novotny struct vcnl4000_chip_spec { 861ebc787aSTomas Novotny const char *prod; 871ebc787aSTomas Novotny int (*init)(struct vcnl4000_data *data); 881ebc787aSTomas Novotny int (*measure_light)(struct vcnl4000_data *data, int *val); 891ebc787aSTomas Novotny int (*measure_proximity)(struct vcnl4000_data *data, int *val); 901ebc787aSTomas Novotny }; 911ebc787aSTomas Novotny 9262a1efb9SPeter Meerwald static const struct i2c_device_id vcnl4000_id[] = { 931ebc787aSTomas Novotny { "vcnl4000", VCNL4000 }, 9450c50b97STomas Novotny { "vcnl4010", VCNL4010 }, 9550c50b97STomas Novotny { "vcnl4020", VCNL4010 }, 965a441aadSAngus Ainslie (Purism) { "vcnl4040", VCNL4040 }, 97be38866fSTomas Novotny { "vcnl4200", VCNL4200 }, 9862a1efb9SPeter Meerwald { } 9962a1efb9SPeter Meerwald }; 10062a1efb9SPeter Meerwald MODULE_DEVICE_TABLE(i2c, vcnl4000_id); 10162a1efb9SPeter Meerwald 1021ebc787aSTomas Novotny static int vcnl4000_init(struct vcnl4000_data *data) 1031ebc787aSTomas Novotny { 1041ebc787aSTomas Novotny int ret, prod_id; 1051ebc787aSTomas Novotny 1061ebc787aSTomas Novotny ret = i2c_smbus_read_byte_data(data->client, VCNL4000_PROD_REV); 1071ebc787aSTomas Novotny if (ret < 0) 1081ebc787aSTomas Novotny return ret; 1091ebc787aSTomas Novotny 1101ebc787aSTomas Novotny prod_id = ret >> 4; 11158bf9aceSTomas Novotny switch (prod_id) { 11258bf9aceSTomas Novotny case VCNL4000_PROD_ID: 11358bf9aceSTomas Novotny if (data->id != VCNL4000) 11458bf9aceSTomas Novotny dev_warn(&data->client->dev, 11558bf9aceSTomas Novotny "wrong device id, use vcnl4000"); 11658bf9aceSTomas Novotny break; 11758bf9aceSTomas Novotny case VCNL4010_PROD_ID: 11858bf9aceSTomas Novotny if (data->id != VCNL4010) 11958bf9aceSTomas Novotny dev_warn(&data->client->dev, 12058bf9aceSTomas Novotny "wrong device id, use vcnl4010/4020"); 12158bf9aceSTomas Novotny break; 12258bf9aceSTomas Novotny default: 1231ebc787aSTomas Novotny return -ENODEV; 12458bf9aceSTomas Novotny } 1251ebc787aSTomas Novotny 1261ebc787aSTomas Novotny data->rev = ret & 0xf; 1271ebc787aSTomas Novotny data->al_scale = 250000; 128be38866fSTomas Novotny mutex_init(&data->vcnl4000_lock); 129be38866fSTomas Novotny 130be38866fSTomas Novotny return 0; 131be38866fSTomas Novotny }; 132be38866fSTomas Novotny 133be38866fSTomas Novotny static int vcnl4200_init(struct vcnl4000_data *data) 134be38866fSTomas Novotny { 1355a441aadSAngus Ainslie (Purism) int ret, id; 136be38866fSTomas Novotny 137be38866fSTomas Novotny ret = i2c_smbus_read_word_data(data->client, VCNL4200_DEV_ID); 138be38866fSTomas Novotny if (ret < 0) 139be38866fSTomas Novotny return ret; 140be38866fSTomas Novotny 1415a441aadSAngus Ainslie (Purism) id = ret & 0xff; 1425a441aadSAngus Ainslie (Purism) 1435a441aadSAngus Ainslie (Purism) if (id != VCNL4200_PROD_ID) { 1445a441aadSAngus Ainslie (Purism) ret = i2c_smbus_read_word_data(data->client, VCNL4040_DEV_ID); 1455a441aadSAngus Ainslie (Purism) if (ret < 0) 1465a441aadSAngus Ainslie (Purism) return ret; 1475a441aadSAngus Ainslie (Purism) 1485a441aadSAngus Ainslie (Purism) id = ret & 0xff; 1495a441aadSAngus Ainslie (Purism) 1505a441aadSAngus Ainslie (Purism) if (id != VCNL4040_PROD_ID) 151be38866fSTomas Novotny return -ENODEV; 1525a441aadSAngus Ainslie (Purism) } 1535a441aadSAngus Ainslie (Purism) 1545a441aadSAngus Ainslie (Purism) dev_dbg(&data->client->dev, "device id 0x%x", id); 155be38866fSTomas Novotny 156be38866fSTomas Novotny data->rev = (ret >> 8) & 0xf; 157be38866fSTomas Novotny 158be38866fSTomas Novotny /* Set defaults and enable both channels */ 15978ed050dSAngus Ainslie (Purism) ret = i2c_smbus_write_word_data(data->client, VCNL4200_AL_CONF, 0); 160be38866fSTomas Novotny if (ret < 0) 161be38866fSTomas Novotny return ret; 16278ed050dSAngus Ainslie (Purism) ret = i2c_smbus_write_word_data(data->client, VCNL4200_PS_CONF1, 0); 163be38866fSTomas Novotny if (ret < 0) 164be38866fSTomas Novotny return ret; 165be38866fSTomas Novotny 166be38866fSTomas Novotny data->vcnl4200_al.reg = VCNL4200_AL_DATA; 167be38866fSTomas Novotny data->vcnl4200_ps.reg = VCNL4200_PS_DATA; 1685a441aadSAngus Ainslie (Purism) switch (id) { 1695a441aadSAngus Ainslie (Purism) case VCNL4200_PROD_ID: 1705a441aadSAngus Ainslie (Purism) /* Integration time is 50ms, but the experiments */ 1715a441aadSAngus Ainslie (Purism) /* show 54ms in total. */ 172be38866fSTomas Novotny data->vcnl4200_al.sampling_rate = ktime_set(0, 54000 * 1000); 173be38866fSTomas Novotny data->vcnl4200_ps.sampling_rate = ktime_set(0, 4200 * 1000); 174bc80573eSGuido Günther data->al_scale = 24000; 1755a441aadSAngus Ainslie (Purism) break; 1765a441aadSAngus Ainslie (Purism) case VCNL4040_PROD_ID: 1775a441aadSAngus Ainslie (Purism) /* Integration time is 80ms, add 10ms. */ 1785a441aadSAngus Ainslie (Purism) data->vcnl4200_al.sampling_rate = ktime_set(0, 100000 * 1000); 1795a441aadSAngus Ainslie (Purism) data->vcnl4200_ps.sampling_rate = ktime_set(0, 100000 * 1000); 180bc80573eSGuido Günther data->al_scale = 120000; 1815a441aadSAngus Ainslie (Purism) break; 1825a441aadSAngus Ainslie (Purism) } 183be38866fSTomas Novotny data->vcnl4200_al.last_measurement = ktime_set(0, 0); 184be38866fSTomas Novotny data->vcnl4200_ps.last_measurement = ktime_set(0, 0); 185be38866fSTomas Novotny mutex_init(&data->vcnl4200_al.lock); 186be38866fSTomas Novotny mutex_init(&data->vcnl4200_ps.lock); 1871ebc787aSTomas Novotny 1881ebc787aSTomas Novotny return 0; 1891ebc787aSTomas Novotny }; 1901ebc787aSTomas Novotny 19162a1efb9SPeter Meerwald static int vcnl4000_measure(struct vcnl4000_data *data, u8 req_mask, 19262a1efb9SPeter Meerwald u8 rdy_mask, u8 data_reg, int *val) 19362a1efb9SPeter Meerwald { 19462a1efb9SPeter Meerwald int tries = 20; 19591f197e0SLars-Peter Clausen __be16 buf; 19662a1efb9SPeter Meerwald int ret; 19762a1efb9SPeter Meerwald 198be38866fSTomas Novotny mutex_lock(&data->vcnl4000_lock); 199ff34ed6dSPeter Meerwald-Stadler 20062a1efb9SPeter Meerwald ret = i2c_smbus_write_byte_data(data->client, VCNL4000_COMMAND, 20162a1efb9SPeter Meerwald req_mask); 20262a1efb9SPeter Meerwald if (ret < 0) 203ff34ed6dSPeter Meerwald-Stadler goto fail; 20462a1efb9SPeter Meerwald 20562a1efb9SPeter Meerwald /* wait for data to become ready */ 20662a1efb9SPeter Meerwald while (tries--) { 20762a1efb9SPeter Meerwald ret = i2c_smbus_read_byte_data(data->client, VCNL4000_COMMAND); 20862a1efb9SPeter Meerwald if (ret < 0) 209ff34ed6dSPeter Meerwald-Stadler goto fail; 21062a1efb9SPeter Meerwald if (ret & rdy_mask) 21162a1efb9SPeter Meerwald break; 21262a1efb9SPeter Meerwald msleep(20); /* measurement takes up to 100 ms */ 21362a1efb9SPeter Meerwald } 21462a1efb9SPeter Meerwald 21562a1efb9SPeter Meerwald if (tries < 0) { 21662a1efb9SPeter Meerwald dev_err(&data->client->dev, 21762a1efb9SPeter Meerwald "vcnl4000_measure() failed, data not ready\n"); 218ff34ed6dSPeter Meerwald-Stadler ret = -EIO; 219ff34ed6dSPeter Meerwald-Stadler goto fail; 22062a1efb9SPeter Meerwald } 22162a1efb9SPeter Meerwald 22262a1efb9SPeter Meerwald ret = i2c_smbus_read_i2c_block_data(data->client, 22362a1efb9SPeter Meerwald data_reg, sizeof(buf), (u8 *) &buf); 22462a1efb9SPeter Meerwald if (ret < 0) 225ff34ed6dSPeter Meerwald-Stadler goto fail; 22662a1efb9SPeter Meerwald 227be38866fSTomas Novotny mutex_unlock(&data->vcnl4000_lock); 22862a1efb9SPeter Meerwald *val = be16_to_cpu(buf); 22962a1efb9SPeter Meerwald 23062a1efb9SPeter Meerwald return 0; 231ff34ed6dSPeter Meerwald-Stadler 232ff34ed6dSPeter Meerwald-Stadler fail: 233be38866fSTomas Novotny mutex_unlock(&data->vcnl4000_lock); 234ff34ed6dSPeter Meerwald-Stadler return ret; 23562a1efb9SPeter Meerwald } 23662a1efb9SPeter Meerwald 237be38866fSTomas Novotny static int vcnl4200_measure(struct vcnl4000_data *data, 238be38866fSTomas Novotny struct vcnl4200_channel *chan, int *val) 239be38866fSTomas Novotny { 240be38866fSTomas Novotny int ret; 241be38866fSTomas Novotny s64 delta; 242be38866fSTomas Novotny ktime_t next_measurement; 243be38866fSTomas Novotny 244be38866fSTomas Novotny mutex_lock(&chan->lock); 245be38866fSTomas Novotny 246be38866fSTomas Novotny next_measurement = ktime_add(chan->last_measurement, 247be38866fSTomas Novotny chan->sampling_rate); 248be38866fSTomas Novotny delta = ktime_us_delta(next_measurement, ktime_get()); 249be38866fSTomas Novotny if (delta > 0) 250be38866fSTomas Novotny usleep_range(delta, delta + 500); 251be38866fSTomas Novotny chan->last_measurement = ktime_get(); 252be38866fSTomas Novotny 253be38866fSTomas Novotny mutex_unlock(&chan->lock); 254be38866fSTomas Novotny 255be38866fSTomas Novotny ret = i2c_smbus_read_word_data(data->client, chan->reg); 256be38866fSTomas Novotny if (ret < 0) 257be38866fSTomas Novotny return ret; 258be38866fSTomas Novotny 259be38866fSTomas Novotny *val = ret; 260be38866fSTomas Novotny 261be38866fSTomas Novotny return 0; 262be38866fSTomas Novotny } 263be38866fSTomas Novotny 2641ebc787aSTomas Novotny static int vcnl4000_measure_light(struct vcnl4000_data *data, int *val) 2651ebc787aSTomas Novotny { 2661ebc787aSTomas Novotny return vcnl4000_measure(data, 2671ebc787aSTomas Novotny VCNL4000_AL_OD, VCNL4000_AL_RDY, 2681ebc787aSTomas Novotny VCNL4000_AL_RESULT_HI, val); 2691ebc787aSTomas Novotny } 2701ebc787aSTomas Novotny 271be38866fSTomas Novotny static int vcnl4200_measure_light(struct vcnl4000_data *data, int *val) 272be38866fSTomas Novotny { 273be38866fSTomas Novotny return vcnl4200_measure(data, &data->vcnl4200_al, val); 274be38866fSTomas Novotny } 275be38866fSTomas Novotny 2761ebc787aSTomas Novotny static int vcnl4000_measure_proximity(struct vcnl4000_data *data, int *val) 2771ebc787aSTomas Novotny { 2781ebc787aSTomas Novotny return vcnl4000_measure(data, 2791ebc787aSTomas Novotny VCNL4000_PS_OD, VCNL4000_PS_RDY, 2801ebc787aSTomas Novotny VCNL4000_PS_RESULT_HI, val); 2811ebc787aSTomas Novotny } 2821ebc787aSTomas Novotny 283be38866fSTomas Novotny static int vcnl4200_measure_proximity(struct vcnl4000_data *data, int *val) 284be38866fSTomas Novotny { 285be38866fSTomas Novotny return vcnl4200_measure(data, &data->vcnl4200_ps, val); 286be38866fSTomas Novotny } 287be38866fSTomas Novotny 2881ebc787aSTomas Novotny static const struct vcnl4000_chip_spec vcnl4000_chip_spec_cfg[] = { 2891ebc787aSTomas Novotny [VCNL4000] = { 2901ebc787aSTomas Novotny .prod = "VCNL4000", 2911ebc787aSTomas Novotny .init = vcnl4000_init, 2921ebc787aSTomas Novotny .measure_light = vcnl4000_measure_light, 2931ebc787aSTomas Novotny .measure_proximity = vcnl4000_measure_proximity, 2941ebc787aSTomas Novotny }, 29550c50b97STomas Novotny [VCNL4010] = { 29650c50b97STomas Novotny .prod = "VCNL4010/4020", 29750c50b97STomas Novotny .init = vcnl4000_init, 29850c50b97STomas Novotny .measure_light = vcnl4000_measure_light, 29950c50b97STomas Novotny .measure_proximity = vcnl4000_measure_proximity, 30050c50b97STomas Novotny }, 3015a441aadSAngus Ainslie (Purism) [VCNL4040] = { 3025a441aadSAngus Ainslie (Purism) .prod = "VCNL4040", 3035a441aadSAngus Ainslie (Purism) .init = vcnl4200_init, 3045a441aadSAngus Ainslie (Purism) .measure_light = vcnl4200_measure_light, 3055a441aadSAngus Ainslie (Purism) .measure_proximity = vcnl4200_measure_proximity, 3065a441aadSAngus Ainslie (Purism) }, 307be38866fSTomas Novotny [VCNL4200] = { 308be38866fSTomas Novotny .prod = "VCNL4200", 309be38866fSTomas Novotny .init = vcnl4200_init, 310be38866fSTomas Novotny .measure_light = vcnl4200_measure_light, 311be38866fSTomas Novotny .measure_proximity = vcnl4200_measure_proximity, 312be38866fSTomas Novotny }, 3131ebc787aSTomas Novotny }; 3141ebc787aSTomas Novotny 31562a1efb9SPeter Meerwald static const struct iio_chan_spec vcnl4000_channels[] = { 31662a1efb9SPeter Meerwald { 31762a1efb9SPeter Meerwald .type = IIO_LIGHT, 318bb7c5940SJonathan Cameron .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | 319bb7c5940SJonathan Cameron BIT(IIO_CHAN_INFO_SCALE), 32062a1efb9SPeter Meerwald }, { 32162a1efb9SPeter Meerwald .type = IIO_PROXIMITY, 322bb7c5940SJonathan Cameron .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 32362a1efb9SPeter Meerwald } 32462a1efb9SPeter Meerwald }; 32562a1efb9SPeter Meerwald 32662a1efb9SPeter Meerwald static int vcnl4000_read_raw(struct iio_dev *indio_dev, 32762a1efb9SPeter Meerwald struct iio_chan_spec const *chan, 32862a1efb9SPeter Meerwald int *val, int *val2, long mask) 32962a1efb9SPeter Meerwald { 3305d693139SPeter Meerwald-Stadler int ret; 33162a1efb9SPeter Meerwald struct vcnl4000_data *data = iio_priv(indio_dev); 33262a1efb9SPeter Meerwald 33362a1efb9SPeter Meerwald switch (mask) { 33462a1efb9SPeter Meerwald case IIO_CHAN_INFO_RAW: 33562a1efb9SPeter Meerwald switch (chan->type) { 33662a1efb9SPeter Meerwald case IIO_LIGHT: 3371ebc787aSTomas Novotny ret = data->chip_spec->measure_light(data, val); 338*4a818643SGuido Günther if (!ret) 339*4a818643SGuido Günther ret = IIO_VAL_INT; 340*4a818643SGuido Günther break; 34162a1efb9SPeter Meerwald case IIO_PROXIMITY: 3421ebc787aSTomas Novotny ret = data->chip_spec->measure_proximity(data, val); 343*4a818643SGuido Günther if (!ret) 344*4a818643SGuido Günther ret = IIO_VAL_INT; 345*4a818643SGuido Günther break; 34662a1efb9SPeter Meerwald default: 347*4a818643SGuido Günther ret = -EINVAL; 34862a1efb9SPeter Meerwald } 349*4a818643SGuido Günther return ret; 35062a1efb9SPeter Meerwald case IIO_CHAN_INFO_SCALE: 3515d693139SPeter Meerwald-Stadler if (chan->type != IIO_LIGHT) 3525d693139SPeter Meerwald-Stadler return -EINVAL; 3535d693139SPeter Meerwald-Stadler 35462a1efb9SPeter Meerwald *val = 0; 3551ebc787aSTomas Novotny *val2 = data->al_scale; 3565d693139SPeter Meerwald-Stadler return IIO_VAL_INT_PLUS_MICRO; 35762a1efb9SPeter Meerwald default: 3585d693139SPeter Meerwald-Stadler return -EINVAL; 35962a1efb9SPeter Meerwald } 36062a1efb9SPeter Meerwald } 36162a1efb9SPeter Meerwald 36262a1efb9SPeter Meerwald static const struct iio_info vcnl4000_info = { 36362a1efb9SPeter Meerwald .read_raw = vcnl4000_read_raw, 36462a1efb9SPeter Meerwald }; 36562a1efb9SPeter Meerwald 366fc52692cSGreg Kroah-Hartman static int vcnl4000_probe(struct i2c_client *client, 36762a1efb9SPeter Meerwald const struct i2c_device_id *id) 36862a1efb9SPeter Meerwald { 36962a1efb9SPeter Meerwald struct vcnl4000_data *data; 37062a1efb9SPeter Meerwald struct iio_dev *indio_dev; 3711ebc787aSTomas Novotny int ret; 37262a1efb9SPeter Meerwald 3732669d723SPeter Meerwald indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 37462a1efb9SPeter Meerwald if (!indio_dev) 37562a1efb9SPeter Meerwald return -ENOMEM; 37662a1efb9SPeter Meerwald 37762a1efb9SPeter Meerwald data = iio_priv(indio_dev); 37862a1efb9SPeter Meerwald i2c_set_clientdata(client, indio_dev); 37962a1efb9SPeter Meerwald data->client = client; 3801ebc787aSTomas Novotny data->id = id->driver_data; 3811ebc787aSTomas Novotny data->chip_spec = &vcnl4000_chip_spec_cfg[data->id]; 38262a1efb9SPeter Meerwald 3831ebc787aSTomas Novotny ret = data->chip_spec->init(data); 38462a1efb9SPeter Meerwald if (ret < 0) 3852669d723SPeter Meerwald return ret; 38662a1efb9SPeter Meerwald 387d978bfddSPeter Meerwald-Stadler dev_dbg(&client->dev, "%s Ambient light/proximity sensor, Rev: %02x\n", 3881ebc787aSTomas Novotny data->chip_spec->prod, data->rev); 38962a1efb9SPeter Meerwald 39062a1efb9SPeter Meerwald indio_dev->dev.parent = &client->dev; 39162a1efb9SPeter Meerwald indio_dev->info = &vcnl4000_info; 39262a1efb9SPeter Meerwald indio_dev->channels = vcnl4000_channels; 39362a1efb9SPeter Meerwald indio_dev->num_channels = ARRAY_SIZE(vcnl4000_channels); 39462a1efb9SPeter Meerwald indio_dev->name = VCNL4000_DRV_NAME; 39562a1efb9SPeter Meerwald indio_dev->modes = INDIO_DIRECT_MODE; 39662a1efb9SPeter Meerwald 397691dab42SSachin Kamat return devm_iio_device_register(&client->dev, indio_dev); 39862a1efb9SPeter Meerwald } 39962a1efb9SPeter Meerwald 400ebd457d5SAngus Ainslie (Purism) static const struct of_device_id vcnl_4000_of_match[] = { 401ebd457d5SAngus Ainslie (Purism) { 402ebd457d5SAngus Ainslie (Purism) .compatible = "vishay,vcnl4000", 4031436a78cSMarco Felsch .data = (void *)VCNL4000, 404ebd457d5SAngus Ainslie (Purism) }, 405ebd457d5SAngus Ainslie (Purism) { 406ebd457d5SAngus Ainslie (Purism) .compatible = "vishay,vcnl4010", 4071436a78cSMarco Felsch .data = (void *)VCNL4010, 408ebd457d5SAngus Ainslie (Purism) }, 409ebd457d5SAngus Ainslie (Purism) { 4101436a78cSMarco Felsch .compatible = "vishay,vcnl4020", 4111436a78cSMarco Felsch .data = (void *)VCNL4010, 412ebd457d5SAngus Ainslie (Purism) }, 413ebd457d5SAngus Ainslie (Purism) { 4147fd1c260SMarco Felsch .compatible = "vishay,vcnl4040", 4157fd1c260SMarco Felsch .data = (void *)VCNL4040, 4167fd1c260SMarco Felsch }, 4177fd1c260SMarco Felsch { 418ebd457d5SAngus Ainslie (Purism) .compatible = "vishay,vcnl4200", 4191436a78cSMarco Felsch .data = (void *)VCNL4200, 420ebd457d5SAngus Ainslie (Purism) }, 421ebd457d5SAngus Ainslie (Purism) {}, 422ebd457d5SAngus Ainslie (Purism) }; 423ebd457d5SAngus Ainslie (Purism) MODULE_DEVICE_TABLE(of, vcnl_4000_of_match); 424ebd457d5SAngus Ainslie (Purism) 42562a1efb9SPeter Meerwald static struct i2c_driver vcnl4000_driver = { 42662a1efb9SPeter Meerwald .driver = { 42762a1efb9SPeter Meerwald .name = VCNL4000_DRV_NAME, 428ebd457d5SAngus Ainslie (Purism) .of_match_table = vcnl_4000_of_match, 42962a1efb9SPeter Meerwald }, 43062a1efb9SPeter Meerwald .probe = vcnl4000_probe, 43162a1efb9SPeter Meerwald .id_table = vcnl4000_id, 43262a1efb9SPeter Meerwald }; 43362a1efb9SPeter Meerwald 43462a1efb9SPeter Meerwald module_i2c_driver(vcnl4000_driver); 43562a1efb9SPeter Meerwald 43662a1efb9SPeter Meerwald MODULE_AUTHOR("Peter Meerwald <pmeerw@pmeerw.net>"); 43762a1efb9SPeter Meerwald MODULE_DESCRIPTION("Vishay VCNL4000 proximity/ambient light sensor driver"); 43862a1efb9SPeter Meerwald MODULE_LICENSE("GPL"); 439