1c87742abSCrt Mori // SPDX-License-Identifier: GPL-2.0 2c87742abSCrt Mori /* 3c87742abSCrt Mori * mlx90632.c - Melexis MLX90632 contactless IR temperature sensor 4c87742abSCrt Mori * 5c87742abSCrt Mori * Copyright (c) 2017 Melexis <cmo@melexis.com> 6c87742abSCrt Mori * 7c87742abSCrt Mori * Driver for the Melexis MLX90632 I2C 16-bit IR thermopile sensor 8c87742abSCrt Mori */ 9c87742abSCrt Mori #include <linux/delay.h> 10c87742abSCrt Mori #include <linux/err.h> 11c87742abSCrt Mori #include <linux/gpio/consumer.h> 12c87742abSCrt Mori #include <linux/i2c.h> 13e02472f7SCrt Mori #include <linux/iopoll.h> 14c87742abSCrt Mori #include <linux/kernel.h> 15e02472f7SCrt Mori #include <linux/limits.h> 16c87742abSCrt Mori #include <linux/module.h> 17c87742abSCrt Mori #include <linux/math64.h> 18c87742abSCrt Mori #include <linux/of.h> 19c87742abSCrt Mori #include <linux/pm_runtime.h> 20c87742abSCrt Mori #include <linux/regmap.h> 21c87742abSCrt Mori 22c87742abSCrt Mori #include <linux/iio/iio.h> 23c87742abSCrt Mori #include <linux/iio/sysfs.h> 24c87742abSCrt Mori 25c87742abSCrt Mori /* Memory sections addresses */ 26c87742abSCrt Mori #define MLX90632_ADDR_RAM 0x4000 /* Start address of ram */ 27c87742abSCrt Mori #define MLX90632_ADDR_EEPROM 0x2480 /* Start address of user eeprom */ 28c87742abSCrt Mori 29c87742abSCrt Mori /* EEPROM addresses - used at startup */ 30c87742abSCrt Mori #define MLX90632_EE_CTRL 0x24d4 /* Control register initial value */ 31c87742abSCrt Mori #define MLX90632_EE_I2C_ADDR 0x24d5 /* I2C address register initial value */ 32c87742abSCrt Mori #define MLX90632_EE_VERSION 0x240b /* EEPROM version reg address */ 33c87742abSCrt Mori #define MLX90632_EE_P_R 0x240c /* P_R calibration register 32bit */ 34c87742abSCrt Mori #define MLX90632_EE_P_G 0x240e /* P_G calibration register 32bit */ 35c87742abSCrt Mori #define MLX90632_EE_P_T 0x2410 /* P_T calibration register 32bit */ 36c87742abSCrt Mori #define MLX90632_EE_P_O 0x2412 /* P_O calibration register 32bit */ 37c87742abSCrt Mori #define MLX90632_EE_Aa 0x2414 /* Aa calibration register 32bit */ 38c87742abSCrt Mori #define MLX90632_EE_Ab 0x2416 /* Ab calibration register 32bit */ 39c87742abSCrt Mori #define MLX90632_EE_Ba 0x2418 /* Ba calibration register 32bit */ 40c87742abSCrt Mori #define MLX90632_EE_Bb 0x241a /* Bb calibration register 32bit */ 41c87742abSCrt Mori #define MLX90632_EE_Ca 0x241c /* Ca calibration register 32bit */ 42c87742abSCrt Mori #define MLX90632_EE_Cb 0x241e /* Cb calibration register 32bit */ 43c87742abSCrt Mori #define MLX90632_EE_Da 0x2420 /* Da calibration register 32bit */ 44c87742abSCrt Mori #define MLX90632_EE_Db 0x2422 /* Db calibration register 32bit */ 45c87742abSCrt Mori #define MLX90632_EE_Ea 0x2424 /* Ea calibration register 32bit */ 46c87742abSCrt Mori #define MLX90632_EE_Eb 0x2426 /* Eb calibration register 32bit */ 47c87742abSCrt Mori #define MLX90632_EE_Fa 0x2428 /* Fa calibration register 32bit */ 48c87742abSCrt Mori #define MLX90632_EE_Fb 0x242a /* Fb calibration register 32bit */ 49c87742abSCrt Mori #define MLX90632_EE_Ga 0x242c /* Ga calibration register 32bit */ 50c87742abSCrt Mori 51c87742abSCrt Mori #define MLX90632_EE_Gb 0x242e /* Gb calibration register 16bit */ 52c87742abSCrt Mori #define MLX90632_EE_Ka 0x242f /* Ka calibration register 16bit */ 53c87742abSCrt Mori 54c87742abSCrt Mori #define MLX90632_EE_Ha 0x2481 /* Ha customer calib value reg 16bit */ 55c87742abSCrt Mori #define MLX90632_EE_Hb 0x2482 /* Hb customer calib value reg 16bit */ 56c87742abSCrt Mori 57c87742abSCrt Mori /* Register addresses - volatile */ 58c87742abSCrt Mori #define MLX90632_REG_I2C_ADDR 0x3000 /* Chip I2C address register */ 59c87742abSCrt Mori 60c87742abSCrt Mori /* Control register address - volatile */ 61c87742abSCrt Mori #define MLX90632_REG_CONTROL 0x3001 /* Control Register address */ 62c87742abSCrt Mori #define MLX90632_CFG_PWR_MASK GENMASK(2, 1) /* PowerMode Mask */ 63e02472f7SCrt Mori #define MLX90632_CFG_MTYP_MASK GENMASK(8, 4) /* Meas select Mask */ 64e02472f7SCrt Mori 65c87742abSCrt Mori /* PowerModes statuses */ 66c87742abSCrt Mori #define MLX90632_PWR_STATUS(ctrl_val) (ctrl_val << 1) 67c87742abSCrt Mori #define MLX90632_PWR_STATUS_HALT MLX90632_PWR_STATUS(0) /* hold */ 68c87742abSCrt Mori #define MLX90632_PWR_STATUS_SLEEP_STEP MLX90632_PWR_STATUS(1) /* sleep step*/ 69c87742abSCrt Mori #define MLX90632_PWR_STATUS_STEP MLX90632_PWR_STATUS(2) /* step */ 70c87742abSCrt Mori #define MLX90632_PWR_STATUS_CONTINUOUS MLX90632_PWR_STATUS(3) /* continuous*/ 71c87742abSCrt Mori 72e02472f7SCrt Mori /* Measurement types */ 73e02472f7SCrt Mori #define MLX90632_MTYP_MEDICAL 0 74e02472f7SCrt Mori #define MLX90632_MTYP_EXTENDED 17 75e02472f7SCrt Mori 76e02472f7SCrt Mori /* Measurement type select*/ 77e02472f7SCrt Mori #define MLX90632_MTYP_STATUS(ctrl_val) (ctrl_val << 4) 78e02472f7SCrt Mori #define MLX90632_MTYP_STATUS_MEDICAL MLX90632_MTYP_STATUS(MLX90632_MTYP_MEDICAL) 79e02472f7SCrt Mori #define MLX90632_MTYP_STATUS_EXTENDED MLX90632_MTYP_STATUS(MLX90632_MTYP_EXTENDED) 80e02472f7SCrt Mori 81e02472f7SCrt Mori /* I2C command register - volatile */ 82e02472f7SCrt Mori #define MLX90632_REG_I2C_CMD 0x3005 /* I2C command Register address */ 83e02472f7SCrt Mori 84c87742abSCrt Mori /* Device status register - volatile */ 85c87742abSCrt Mori #define MLX90632_REG_STATUS 0x3fff /* Device status register */ 86c87742abSCrt Mori #define MLX90632_STAT_BUSY BIT(10) /* Device busy indicator */ 87c87742abSCrt Mori #define MLX90632_STAT_EE_BUSY BIT(9) /* EEPROM busy indicator */ 88c87742abSCrt Mori #define MLX90632_STAT_BRST BIT(8) /* Brown out reset indicator */ 89c87742abSCrt Mori #define MLX90632_STAT_CYCLE_POS GENMASK(6, 2) /* Data position */ 90c87742abSCrt Mori #define MLX90632_STAT_DATA_RDY BIT(0) /* Data ready indicator */ 91c87742abSCrt Mori 92c87742abSCrt Mori /* RAM_MEAS address-es for each channel */ 93c87742abSCrt Mori #define MLX90632_RAM_1(meas_num) (MLX90632_ADDR_RAM + 3 * meas_num) 94c87742abSCrt Mori #define MLX90632_RAM_2(meas_num) (MLX90632_ADDR_RAM + 3 * meas_num + 1) 95c87742abSCrt Mori #define MLX90632_RAM_3(meas_num) (MLX90632_ADDR_RAM + 3 * meas_num + 2) 96c87742abSCrt Mori 97e02472f7SCrt Mori /* Name important RAM_MEAS channels */ 98e02472f7SCrt Mori #define MLX90632_RAM_DSP5_EXTENDED_AMBIENT_1 MLX90632_RAM_3(17) 99e02472f7SCrt Mori #define MLX90632_RAM_DSP5_EXTENDED_AMBIENT_2 MLX90632_RAM_3(18) 100e02472f7SCrt Mori #define MLX90632_RAM_DSP5_EXTENDED_OBJECT_1 MLX90632_RAM_1(17) 101e02472f7SCrt Mori #define MLX90632_RAM_DSP5_EXTENDED_OBJECT_2 MLX90632_RAM_2(17) 102e02472f7SCrt Mori #define MLX90632_RAM_DSP5_EXTENDED_OBJECT_3 MLX90632_RAM_1(18) 103e02472f7SCrt Mori #define MLX90632_RAM_DSP5_EXTENDED_OBJECT_4 MLX90632_RAM_2(18) 104e02472f7SCrt Mori #define MLX90632_RAM_DSP5_EXTENDED_OBJECT_5 MLX90632_RAM_1(19) 105e02472f7SCrt Mori #define MLX90632_RAM_DSP5_EXTENDED_OBJECT_6 MLX90632_RAM_2(19) 106e02472f7SCrt Mori 107c87742abSCrt Mori /* Magic constants */ 108c87742abSCrt Mori #define MLX90632_ID_MEDICAL 0x0105 /* EEPROM DSPv5 Medical device id */ 109c87742abSCrt Mori #define MLX90632_ID_CONSUMER 0x0205 /* EEPROM DSPv5 Consumer device id */ 110e02472f7SCrt Mori #define MLX90632_ID_EXTENDED 0x0505 /* EEPROM DSPv5 Extended range device id */ 111e02472f7SCrt Mori #define MLX90632_ID_MASK GENMASK(14, 0) /* DSP version and device ID in EE_VERSION */ 112389fc70bSCrt Mori #define MLX90632_DSP_VERSION 5 /* DSP version */ 113389fc70bSCrt Mori #define MLX90632_DSP_MASK GENMASK(7, 0) /* DSP version in EE_VERSION */ 114c87742abSCrt Mori #define MLX90632_RESET_CMD 0x0006 /* Reset sensor (address or global) */ 115c87742abSCrt Mori #define MLX90632_REF_12 12LL /**< ResCtrlRef value of Ch 1 or Ch 2 */ 116c87742abSCrt Mori #define MLX90632_REF_3 12LL /**< ResCtrlRef value of Channel 3 */ 117c87742abSCrt Mori #define MLX90632_MAX_MEAS_NUM 31 /**< Maximum measurements in list */ 118c87742abSCrt Mori #define MLX90632_SLEEP_DELAY_MS 3000 /**< Autosleep delay */ 119e02472f7SCrt Mori #define MLX90632_EXTENDED_LIMIT 27000 /* Extended mode raw value limit */ 120c87742abSCrt Mori 121856437dbSCrt Mori /** 122856437dbSCrt Mori * struct mlx90632_data - private data for the MLX90632 device 123856437dbSCrt Mori * @client: I2C client of the device 124856437dbSCrt Mori * @lock: Internal mutex for multiple reads for single measurement 125856437dbSCrt Mori * @regmap: Regmap of the device 126856437dbSCrt Mori * @emissivity: Object emissivity from 0 to 1000 where 1000 = 1. 127e02472f7SCrt Mori * @mtyp: Measurement type physical sensor configuration for extended range 128e02472f7SCrt Mori * calculations 129e02472f7SCrt Mori * @object_ambient_temperature: Ambient temperature at object (might differ of 130e02472f7SCrt Mori * the ambient temperature of sensor. 131856437dbSCrt Mori */ 132c87742abSCrt Mori struct mlx90632_data { 133c87742abSCrt Mori struct i2c_client *client; 134856437dbSCrt Mori struct mutex lock; 135c87742abSCrt Mori struct regmap *regmap; 136c87742abSCrt Mori u16 emissivity; 137e02472f7SCrt Mori u8 mtyp; 138e02472f7SCrt Mori u32 object_ambient_temperature; 139c87742abSCrt Mori }; 140c87742abSCrt Mori 141c87742abSCrt Mori static const struct regmap_range mlx90632_volatile_reg_range[] = { 142c87742abSCrt Mori regmap_reg_range(MLX90632_REG_I2C_ADDR, MLX90632_REG_CONTROL), 143e02472f7SCrt Mori regmap_reg_range(MLX90632_REG_I2C_CMD, MLX90632_REG_I2C_CMD), 144c87742abSCrt Mori regmap_reg_range(MLX90632_REG_STATUS, MLX90632_REG_STATUS), 145c87742abSCrt Mori regmap_reg_range(MLX90632_RAM_1(0), 146c87742abSCrt Mori MLX90632_RAM_3(MLX90632_MAX_MEAS_NUM)), 147c87742abSCrt Mori }; 148c87742abSCrt Mori 149c87742abSCrt Mori static const struct regmap_access_table mlx90632_volatile_regs_tbl = { 150c87742abSCrt Mori .yes_ranges = mlx90632_volatile_reg_range, 151c87742abSCrt Mori .n_yes_ranges = ARRAY_SIZE(mlx90632_volatile_reg_range), 152c87742abSCrt Mori }; 153c87742abSCrt Mori 154c87742abSCrt Mori static const struct regmap_range mlx90632_read_reg_range[] = { 155c87742abSCrt Mori regmap_reg_range(MLX90632_EE_VERSION, MLX90632_EE_Ka), 156c87742abSCrt Mori regmap_reg_range(MLX90632_EE_CTRL, MLX90632_EE_I2C_ADDR), 157c87742abSCrt Mori regmap_reg_range(MLX90632_EE_Ha, MLX90632_EE_Hb), 158c87742abSCrt Mori regmap_reg_range(MLX90632_REG_I2C_ADDR, MLX90632_REG_CONTROL), 159e02472f7SCrt Mori regmap_reg_range(MLX90632_REG_I2C_CMD, MLX90632_REG_I2C_CMD), 160c87742abSCrt Mori regmap_reg_range(MLX90632_REG_STATUS, MLX90632_REG_STATUS), 161c87742abSCrt Mori regmap_reg_range(MLX90632_RAM_1(0), 162c87742abSCrt Mori MLX90632_RAM_3(MLX90632_MAX_MEAS_NUM)), 163c87742abSCrt Mori }; 164c87742abSCrt Mori 165c87742abSCrt Mori static const struct regmap_access_table mlx90632_readable_regs_tbl = { 166c87742abSCrt Mori .yes_ranges = mlx90632_read_reg_range, 167c87742abSCrt Mori .n_yes_ranges = ARRAY_SIZE(mlx90632_read_reg_range), 168c87742abSCrt Mori }; 169c87742abSCrt Mori 170c87742abSCrt Mori static const struct regmap_range mlx90632_no_write_reg_range[] = { 171c87742abSCrt Mori regmap_reg_range(MLX90632_EE_VERSION, MLX90632_EE_Ka), 172c87742abSCrt Mori regmap_reg_range(MLX90632_RAM_1(0), 173c87742abSCrt Mori MLX90632_RAM_3(MLX90632_MAX_MEAS_NUM)), 174c87742abSCrt Mori }; 175c87742abSCrt Mori 176c87742abSCrt Mori static const struct regmap_access_table mlx90632_writeable_regs_tbl = { 177c87742abSCrt Mori .no_ranges = mlx90632_no_write_reg_range, 178c87742abSCrt Mori .n_no_ranges = ARRAY_SIZE(mlx90632_no_write_reg_range), 179c87742abSCrt Mori }; 180c87742abSCrt Mori 181c87742abSCrt Mori static const struct regmap_config mlx90632_regmap = { 182c87742abSCrt Mori .reg_bits = 16, 183c87742abSCrt Mori .val_bits = 16, 184c87742abSCrt Mori 185c87742abSCrt Mori .volatile_table = &mlx90632_volatile_regs_tbl, 186c87742abSCrt Mori .rd_table = &mlx90632_readable_regs_tbl, 187c87742abSCrt Mori .wr_table = &mlx90632_writeable_regs_tbl, 188c87742abSCrt Mori 1891c96a2f6SDavid Frey .use_single_read = true, 1901c96a2f6SDavid Frey .use_single_write = true, 191c87742abSCrt Mori .reg_format_endian = REGMAP_ENDIAN_BIG, 192c87742abSCrt Mori .val_format_endian = REGMAP_ENDIAN_BIG, 193c87742abSCrt Mori .cache_type = REGCACHE_RBTREE, 194c87742abSCrt Mori }; 195c87742abSCrt Mori 196c87742abSCrt Mori static s32 mlx90632_pwr_set_sleep_step(struct regmap *regmap) 197c87742abSCrt Mori { 198c87742abSCrt Mori return regmap_update_bits(regmap, MLX90632_REG_CONTROL, 199c87742abSCrt Mori MLX90632_CFG_PWR_MASK, 200c87742abSCrt Mori MLX90632_PWR_STATUS_SLEEP_STEP); 201c87742abSCrt Mori } 202c87742abSCrt Mori 203c87742abSCrt Mori static s32 mlx90632_pwr_continuous(struct regmap *regmap) 204c87742abSCrt Mori { 205c87742abSCrt Mori return regmap_update_bits(regmap, MLX90632_REG_CONTROL, 206c87742abSCrt Mori MLX90632_CFG_PWR_MASK, 207c87742abSCrt Mori MLX90632_PWR_STATUS_CONTINUOUS); 208c87742abSCrt Mori } 209c87742abSCrt Mori 210c87742abSCrt Mori /** 2117390192bSLee Jones * mlx90632_perform_measurement() - Trigger and retrieve current measurement cycle 2127390192bSLee Jones * @data: pointer to mlx90632_data object containing regmap information 213c87742abSCrt Mori * 214c87742abSCrt Mori * Perform a measurement and return latest measurement cycle position reported 215c87742abSCrt Mori * by sensor. This is a blocking function for 500ms, as that is default sensor 216c87742abSCrt Mori * refresh rate. 217c87742abSCrt Mori */ 218c87742abSCrt Mori static int mlx90632_perform_measurement(struct mlx90632_data *data) 219c87742abSCrt Mori { 220c87742abSCrt Mori unsigned int reg_status; 221037697ddSCrt Mori int ret; 222c87742abSCrt Mori 223c87742abSCrt Mori ret = regmap_update_bits(data->regmap, MLX90632_REG_STATUS, 224c87742abSCrt Mori MLX90632_STAT_DATA_RDY, 0); 225c87742abSCrt Mori if (ret < 0) 226c87742abSCrt Mori return ret; 227c87742abSCrt Mori 228037697ddSCrt Mori ret = regmap_read_poll_timeout(data->regmap, MLX90632_REG_STATUS, reg_status, 229037697ddSCrt Mori !(reg_status & MLX90632_STAT_DATA_RDY), 10000, 230037697ddSCrt Mori 100 * 10000); 231c87742abSCrt Mori 232037697ddSCrt Mori if (ret < 0) { 233c87742abSCrt Mori dev_err(&data->client->dev, "data not ready"); 234c87742abSCrt Mori return -ETIMEDOUT; 235c87742abSCrt Mori } 236c87742abSCrt Mori 237c87742abSCrt Mori return (reg_status & MLX90632_STAT_CYCLE_POS) >> 2; 238c87742abSCrt Mori } 239c87742abSCrt Mori 240e02472f7SCrt Mori static int mlx90632_set_meas_type(struct regmap *regmap, u8 type) 241e02472f7SCrt Mori { 242e02472f7SCrt Mori int ret; 243e02472f7SCrt Mori 244e02472f7SCrt Mori if ((type != MLX90632_MTYP_MEDICAL) && (type != MLX90632_MTYP_EXTENDED)) 245e02472f7SCrt Mori return -EINVAL; 246e02472f7SCrt Mori 247e02472f7SCrt Mori ret = regmap_write(regmap, MLX90632_REG_I2C_CMD, MLX90632_RESET_CMD); 248e02472f7SCrt Mori if (ret < 0) 249e02472f7SCrt Mori return ret; 250e02472f7SCrt Mori 251e02472f7SCrt Mori ret = regmap_write_bits(regmap, MLX90632_REG_CONTROL, 252e02472f7SCrt Mori (MLX90632_CFG_MTYP_MASK | MLX90632_CFG_PWR_MASK), 253e02472f7SCrt Mori (MLX90632_MTYP_STATUS(type) | MLX90632_PWR_STATUS_HALT)); 254e02472f7SCrt Mori if (ret < 0) 255e02472f7SCrt Mori return ret; 256e02472f7SCrt Mori 257e02472f7SCrt Mori return mlx90632_pwr_continuous(regmap); 258e02472f7SCrt Mori } 259e02472f7SCrt Mori 260c87742abSCrt Mori static int mlx90632_channel_new_select(int perform_ret, uint8_t *channel_new, 261c87742abSCrt Mori uint8_t *channel_old) 262c87742abSCrt Mori { 263c87742abSCrt Mori switch (perform_ret) { 264c87742abSCrt Mori case 1: 265c87742abSCrt Mori *channel_new = 1; 266c87742abSCrt Mori *channel_old = 2; 267c87742abSCrt Mori break; 268c87742abSCrt Mori case 2: 269c87742abSCrt Mori *channel_new = 2; 270c87742abSCrt Mori *channel_old = 1; 271c87742abSCrt Mori break; 272c87742abSCrt Mori default: 273c87742abSCrt Mori return -EINVAL; 274c87742abSCrt Mori } 275c87742abSCrt Mori 276c87742abSCrt Mori return 0; 277c87742abSCrt Mori } 278c87742abSCrt Mori 279c87742abSCrt Mori static int mlx90632_read_ambient_raw(struct regmap *regmap, 280c87742abSCrt Mori s16 *ambient_new_raw, s16 *ambient_old_raw) 281c87742abSCrt Mori { 282c87742abSCrt Mori int ret; 283c87742abSCrt Mori unsigned int read_tmp; 284c87742abSCrt Mori 285c87742abSCrt Mori ret = regmap_read(regmap, MLX90632_RAM_3(1), &read_tmp); 286c87742abSCrt Mori if (ret < 0) 287c87742abSCrt Mori return ret; 288c87742abSCrt Mori *ambient_new_raw = (s16)read_tmp; 289c87742abSCrt Mori 290c87742abSCrt Mori ret = regmap_read(regmap, MLX90632_RAM_3(2), &read_tmp); 291c87742abSCrt Mori if (ret < 0) 292c87742abSCrt Mori return ret; 293c87742abSCrt Mori *ambient_old_raw = (s16)read_tmp; 294c87742abSCrt Mori 295c87742abSCrt Mori return ret; 296c87742abSCrt Mori } 297c87742abSCrt Mori 298c87742abSCrt Mori static int mlx90632_read_object_raw(struct regmap *regmap, 299c87742abSCrt Mori int perform_measurement_ret, 300c87742abSCrt Mori s16 *object_new_raw, s16 *object_old_raw) 301c87742abSCrt Mori { 302c87742abSCrt Mori int ret; 303c87742abSCrt Mori unsigned int read_tmp; 304c87742abSCrt Mori s16 read; 305c87742abSCrt Mori u8 channel = 0; 306c87742abSCrt Mori u8 channel_old = 0; 307c87742abSCrt Mori 308c87742abSCrt Mori ret = mlx90632_channel_new_select(perform_measurement_ret, &channel, 309c87742abSCrt Mori &channel_old); 310c87742abSCrt Mori if (ret != 0) 311c87742abSCrt Mori return ret; 312c87742abSCrt Mori 313c87742abSCrt Mori ret = regmap_read(regmap, MLX90632_RAM_2(channel), &read_tmp); 314c87742abSCrt Mori if (ret < 0) 315c87742abSCrt Mori return ret; 316c87742abSCrt Mori 317c87742abSCrt Mori read = (s16)read_tmp; 318c87742abSCrt Mori 319c87742abSCrt Mori ret = regmap_read(regmap, MLX90632_RAM_1(channel), &read_tmp); 320c87742abSCrt Mori if (ret < 0) 321c87742abSCrt Mori return ret; 322c87742abSCrt Mori *object_new_raw = (read + (s16)read_tmp) / 2; 323c87742abSCrt Mori 324c87742abSCrt Mori ret = regmap_read(regmap, MLX90632_RAM_2(channel_old), &read_tmp); 325c87742abSCrt Mori if (ret < 0) 326c87742abSCrt Mori return ret; 327c87742abSCrt Mori read = (s16)read_tmp; 328c87742abSCrt Mori 329c87742abSCrt Mori ret = regmap_read(regmap, MLX90632_RAM_1(channel_old), &read_tmp); 330c87742abSCrt Mori if (ret < 0) 331c87742abSCrt Mori return ret; 332c87742abSCrt Mori *object_old_raw = (read + (s16)read_tmp) / 2; 333c87742abSCrt Mori 334c87742abSCrt Mori return ret; 335c87742abSCrt Mori } 336c87742abSCrt Mori 337c87742abSCrt Mori static int mlx90632_read_all_channel(struct mlx90632_data *data, 338c87742abSCrt Mori s16 *ambient_new_raw, s16 *ambient_old_raw, 339c87742abSCrt Mori s16 *object_new_raw, s16 *object_old_raw) 340c87742abSCrt Mori { 341c87742abSCrt Mori s32 ret, measurement; 342c87742abSCrt Mori 343c87742abSCrt Mori mutex_lock(&data->lock); 344c87742abSCrt Mori measurement = mlx90632_perform_measurement(data); 345c87742abSCrt Mori if (measurement < 0) { 346c87742abSCrt Mori ret = measurement; 347c87742abSCrt Mori goto read_unlock; 348c87742abSCrt Mori } 349c87742abSCrt Mori ret = mlx90632_read_ambient_raw(data->regmap, ambient_new_raw, 350c87742abSCrt Mori ambient_old_raw); 351c87742abSCrt Mori if (ret < 0) 352c87742abSCrt Mori goto read_unlock; 353c87742abSCrt Mori 354c87742abSCrt Mori ret = mlx90632_read_object_raw(data->regmap, measurement, 355c87742abSCrt Mori object_new_raw, object_old_raw); 356c87742abSCrt Mori read_unlock: 357c87742abSCrt Mori mutex_unlock(&data->lock); 358c87742abSCrt Mori return ret; 359c87742abSCrt Mori } 360c87742abSCrt Mori 361e02472f7SCrt Mori static int mlx90632_read_ambient_raw_extended(struct regmap *regmap, 362e02472f7SCrt Mori s16 *ambient_new_raw, s16 *ambient_old_raw) 363e02472f7SCrt Mori { 364e02472f7SCrt Mori unsigned int read_tmp; 365e02472f7SCrt Mori int ret; 366e02472f7SCrt Mori 367e02472f7SCrt Mori ret = regmap_read(regmap, MLX90632_RAM_DSP5_EXTENDED_AMBIENT_1, &read_tmp); 368e02472f7SCrt Mori if (ret < 0) 369e02472f7SCrt Mori return ret; 370e02472f7SCrt Mori *ambient_new_raw = (s16)read_tmp; 371e02472f7SCrt Mori 372e02472f7SCrt Mori ret = regmap_read(regmap, MLX90632_RAM_DSP5_EXTENDED_AMBIENT_2, &read_tmp); 373e02472f7SCrt Mori if (ret < 0) 374e02472f7SCrt Mori return ret; 375e02472f7SCrt Mori *ambient_old_raw = (s16)read_tmp; 376e02472f7SCrt Mori 377e02472f7SCrt Mori return 0; 378e02472f7SCrt Mori } 379e02472f7SCrt Mori 380e02472f7SCrt Mori static int mlx90632_read_object_raw_extended(struct regmap *regmap, s16 *object_new_raw) 381e02472f7SCrt Mori { 382e02472f7SCrt Mori unsigned int read_tmp; 383e02472f7SCrt Mori s32 read; 384e02472f7SCrt Mori int ret; 385e02472f7SCrt Mori 386e02472f7SCrt Mori ret = regmap_read(regmap, MLX90632_RAM_DSP5_EXTENDED_OBJECT_1, &read_tmp); 387e02472f7SCrt Mori if (ret < 0) 388e02472f7SCrt Mori return ret; 389e02472f7SCrt Mori read = (s16)read_tmp; 390e02472f7SCrt Mori 391e02472f7SCrt Mori ret = regmap_read(regmap, MLX90632_RAM_DSP5_EXTENDED_OBJECT_2, &read_tmp); 392e02472f7SCrt Mori if (ret < 0) 393e02472f7SCrt Mori return ret; 394e02472f7SCrt Mori read = read - (s16)read_tmp; 395e02472f7SCrt Mori 396e02472f7SCrt Mori ret = regmap_read(regmap, MLX90632_RAM_DSP5_EXTENDED_OBJECT_3, &read_tmp); 397e02472f7SCrt Mori if (ret < 0) 398e02472f7SCrt Mori return ret; 399e02472f7SCrt Mori read = read - (s16)read_tmp; 400e02472f7SCrt Mori 401e02472f7SCrt Mori ret = regmap_read(regmap, MLX90632_RAM_DSP5_EXTENDED_OBJECT_4, &read_tmp); 402e02472f7SCrt Mori if (ret < 0) 403e02472f7SCrt Mori return ret; 404e02472f7SCrt Mori read = (read + (s16)read_tmp) / 2; 405e02472f7SCrt Mori 406e02472f7SCrt Mori ret = regmap_read(regmap, MLX90632_RAM_DSP5_EXTENDED_OBJECT_5, &read_tmp); 407e02472f7SCrt Mori if (ret < 0) 408e02472f7SCrt Mori return ret; 409e02472f7SCrt Mori read = read + (s16)read_tmp; 410e02472f7SCrt Mori 411e02472f7SCrt Mori ret = regmap_read(regmap, MLX90632_RAM_DSP5_EXTENDED_OBJECT_6, &read_tmp); 412e02472f7SCrt Mori if (ret < 0) 413e02472f7SCrt Mori return ret; 414e02472f7SCrt Mori read = read + (s16)read_tmp; 415e02472f7SCrt Mori 416e02472f7SCrt Mori if (read > S16_MAX || read < S16_MIN) 417e02472f7SCrt Mori return -ERANGE; 418e02472f7SCrt Mori 419e02472f7SCrt Mori *object_new_raw = read; 420e02472f7SCrt Mori 421e02472f7SCrt Mori return 0; 422e02472f7SCrt Mori } 423e02472f7SCrt Mori 424e02472f7SCrt Mori static int mlx90632_read_all_channel_extended(struct mlx90632_data *data, s16 *object_new_raw, 425e02472f7SCrt Mori s16 *ambient_new_raw, s16 *ambient_old_raw) 426e02472f7SCrt Mori { 427e02472f7SCrt Mori s32 ret, meas; 428e02472f7SCrt Mori 429e02472f7SCrt Mori mutex_lock(&data->lock); 430e02472f7SCrt Mori ret = mlx90632_set_meas_type(data->regmap, MLX90632_MTYP_EXTENDED); 431e02472f7SCrt Mori if (ret < 0) 432e02472f7SCrt Mori goto read_unlock; 433e02472f7SCrt Mori 434e02472f7SCrt Mori ret = read_poll_timeout(mlx90632_perform_measurement, meas, meas == 19, 435e02472f7SCrt Mori 50000, 800000, false, data); 436e02472f7SCrt Mori if (ret != 0) 437e02472f7SCrt Mori goto read_unlock; 438e02472f7SCrt Mori 439e02472f7SCrt Mori ret = mlx90632_read_object_raw_extended(data->regmap, object_new_raw); 440e02472f7SCrt Mori if (ret < 0) 441e02472f7SCrt Mori goto read_unlock; 442e02472f7SCrt Mori 443e02472f7SCrt Mori ret = mlx90632_read_ambient_raw_extended(data->regmap, ambient_new_raw, ambient_old_raw); 444e02472f7SCrt Mori 445e02472f7SCrt Mori read_unlock: 446e02472f7SCrt Mori (void) mlx90632_set_meas_type(data->regmap, MLX90632_MTYP_MEDICAL); 447e02472f7SCrt Mori 448e02472f7SCrt Mori mutex_unlock(&data->lock); 449e02472f7SCrt Mori return ret; 450e02472f7SCrt Mori } 451e02472f7SCrt Mori 452c87742abSCrt Mori static int mlx90632_read_ee_register(struct regmap *regmap, u16 reg_lsb, 453c87742abSCrt Mori s32 *reg_value) 454c87742abSCrt Mori { 455c87742abSCrt Mori s32 ret; 456c87742abSCrt Mori unsigned int read; 457c87742abSCrt Mori u32 value; 458c87742abSCrt Mori 459c87742abSCrt Mori ret = regmap_read(regmap, reg_lsb, &read); 460c87742abSCrt Mori if (ret < 0) 461c87742abSCrt Mori return ret; 462c87742abSCrt Mori 463c87742abSCrt Mori value = read; 464c87742abSCrt Mori 465c87742abSCrt Mori ret = regmap_read(regmap, reg_lsb + 1, &read); 466c87742abSCrt Mori if (ret < 0) 467c87742abSCrt Mori return ret; 468c87742abSCrt Mori 469c87742abSCrt Mori *reg_value = (read << 16) | (value & 0xffff); 470c87742abSCrt Mori 471c87742abSCrt Mori return 0; 472c87742abSCrt Mori } 473c87742abSCrt Mori 474c87742abSCrt Mori static s64 mlx90632_preprocess_temp_amb(s16 ambient_new_raw, 475c87742abSCrt Mori s16 ambient_old_raw, s16 Gb) 476c87742abSCrt Mori { 477c87742abSCrt Mori s64 VR_Ta, kGb, tmp; 478c87742abSCrt Mori 479c87742abSCrt Mori kGb = ((s64)Gb * 1000LL) >> 10ULL; 480c87742abSCrt Mori VR_Ta = (s64)ambient_old_raw * 1000000LL + 481c87742abSCrt Mori kGb * div64_s64(((s64)ambient_new_raw * 1000LL), 482c87742abSCrt Mori (MLX90632_REF_3)); 483c87742abSCrt Mori tmp = div64_s64( 484c87742abSCrt Mori div64_s64(((s64)ambient_new_raw * 1000000000000LL), 485c87742abSCrt Mori (MLX90632_REF_3)), VR_Ta); 486c87742abSCrt Mori return div64_s64(tmp << 19ULL, 1000LL); 487c87742abSCrt Mori } 488c87742abSCrt Mori 489c87742abSCrt Mori static s64 mlx90632_preprocess_temp_obj(s16 object_new_raw, s16 object_old_raw, 490c87742abSCrt Mori s16 ambient_new_raw, 491c87742abSCrt Mori s16 ambient_old_raw, s16 Ka) 492c87742abSCrt Mori { 493c87742abSCrt Mori s64 VR_IR, kKa, tmp; 494c87742abSCrt Mori 495c87742abSCrt Mori kKa = ((s64)Ka * 1000LL) >> 10ULL; 496c87742abSCrt Mori VR_IR = (s64)ambient_old_raw * 1000000LL + 497c87742abSCrt Mori kKa * div64_s64(((s64)ambient_new_raw * 1000LL), 498c87742abSCrt Mori (MLX90632_REF_3)); 499c87742abSCrt Mori tmp = div64_s64( 500c87742abSCrt Mori div64_s64(((s64)((object_new_raw + object_old_raw) / 2) 501c87742abSCrt Mori * 1000000000000LL), (MLX90632_REF_12)), 502c87742abSCrt Mori VR_IR); 503c87742abSCrt Mori return div64_s64((tmp << 19ULL), 1000LL); 504c87742abSCrt Mori } 505c87742abSCrt Mori 506e02472f7SCrt Mori static s64 mlx90632_preprocess_temp_obj_extended(s16 object_new_raw, s16 ambient_new_raw, 507e02472f7SCrt Mori s16 ambient_old_raw, s16 Ka) 508e02472f7SCrt Mori { 509e02472f7SCrt Mori s64 VR_IR, kKa, tmp; 510e02472f7SCrt Mori 511e02472f7SCrt Mori kKa = ((s64)Ka * 1000LL) >> 10ULL; 512e02472f7SCrt Mori VR_IR = (s64)ambient_old_raw * 1000000LL + 513e02472f7SCrt Mori kKa * div64_s64((s64)ambient_new_raw * 1000LL, 514e02472f7SCrt Mori MLX90632_REF_3); 515e02472f7SCrt Mori tmp = div64_s64( 516e02472f7SCrt Mori div64_s64((s64) object_new_raw * 1000000000000LL, MLX90632_REF_12), 517e02472f7SCrt Mori VR_IR); 518e02472f7SCrt Mori return div64_s64(tmp << 19ULL, 1000LL); 519e02472f7SCrt Mori } 520e02472f7SCrt Mori 521c87742abSCrt Mori static s32 mlx90632_calc_temp_ambient(s16 ambient_new_raw, s16 ambient_old_raw, 522e02472f7SCrt Mori s32 P_T, s32 P_R, s32 P_G, s32 P_O, s16 Gb) 523c87742abSCrt Mori { 524c87742abSCrt Mori s64 Asub, Bsub, Ablock, Bblock, Cblock, AMB, sum; 525c87742abSCrt Mori 526c87742abSCrt Mori AMB = mlx90632_preprocess_temp_amb(ambient_new_raw, ambient_old_raw, 527c87742abSCrt Mori Gb); 528c87742abSCrt Mori Asub = ((s64)P_T * 10000000000LL) >> 44ULL; 529c87742abSCrt Mori Bsub = AMB - (((s64)P_R * 1000LL) >> 8ULL); 530c87742abSCrt Mori Ablock = Asub * (Bsub * Bsub); 531c87742abSCrt Mori Bblock = (div64_s64(Bsub * 10000000LL, P_G)) << 20ULL; 532c87742abSCrt Mori Cblock = ((s64)P_O * 10000000000LL) >> 8ULL; 533c87742abSCrt Mori 534c87742abSCrt Mori sum = div64_s64(Ablock, 1000000LL) + Bblock + Cblock; 535c87742abSCrt Mori 536c87742abSCrt Mori return div64_s64(sum, 10000000LL); 537c87742abSCrt Mori } 538c87742abSCrt Mori 539c87742abSCrt Mori static s32 mlx90632_calc_temp_object_iteration(s32 prev_object_temp, s64 object, 540b99095e5SCrt Mori s64 TAdut, s64 TAdut4, s32 Fa, s32 Fb, 541c87742abSCrt Mori s32 Ga, s16 Ha, s16 Hb, 542c87742abSCrt Mori u16 emissivity) 543c87742abSCrt Mori { 544b99095e5SCrt Mori s64 calcedKsTO, calcedKsTA, ir_Alpha, Alpha_corr; 545c87742abSCrt Mori s64 Ha_customer, Hb_customer; 546c87742abSCrt Mori 547c87742abSCrt Mori Ha_customer = ((s64)Ha * 1000000LL) >> 14ULL; 548c87742abSCrt Mori Hb_customer = ((s64)Hb * 100) >> 10ULL; 549c87742abSCrt Mori 550c87742abSCrt Mori calcedKsTO = ((s64)((s64)Ga * (prev_object_temp - 25 * 1000LL) 551c87742abSCrt Mori * 1000LL)) >> 36LL; 552c87742abSCrt Mori calcedKsTA = ((s64)(Fb * (TAdut - 25 * 1000000LL))) >> 36LL; 553c87742abSCrt Mori Alpha_corr = div64_s64((((s64)(Fa * 10000000000LL) >> 46LL) 554c87742abSCrt Mori * Ha_customer), 1000LL); 555c87742abSCrt Mori Alpha_corr *= ((s64)(1 * 1000000LL + calcedKsTO + calcedKsTA)); 556c87742abSCrt Mori Alpha_corr = emissivity * div64_s64(Alpha_corr, 100000LL); 557c87742abSCrt Mori Alpha_corr = div64_s64(Alpha_corr, 1000LL); 558c87742abSCrt Mori ir_Alpha = div64_s64((s64)object * 10000000LL, Alpha_corr); 559c87742abSCrt Mori 560c87742abSCrt Mori return (int_sqrt64(int_sqrt64(ir_Alpha * 1000000000000LL + TAdut4)) 561c87742abSCrt Mori - 27315 - Hb_customer) * 10; 562c87742abSCrt Mori } 563c87742abSCrt Mori 564b99095e5SCrt Mori static s64 mlx90632_calc_ta4(s64 TAdut, s64 scale) 565b99095e5SCrt Mori { 566b99095e5SCrt Mori return (div64_s64(TAdut, scale) + 27315) * 567b99095e5SCrt Mori (div64_s64(TAdut, scale) + 27315) * 568b99095e5SCrt Mori (div64_s64(TAdut, scale) + 27315) * 569b99095e5SCrt Mori (div64_s64(TAdut, scale) + 27315); 570b99095e5SCrt Mori } 571b99095e5SCrt Mori 572c87742abSCrt Mori static s32 mlx90632_calc_temp_object(s64 object, s64 ambient, s32 Ea, s32 Eb, 573c87742abSCrt Mori s32 Fa, s32 Fb, s32 Ga, s16 Ha, s16 Hb, 574c87742abSCrt Mori u16 tmp_emi) 575c87742abSCrt Mori { 576b99095e5SCrt Mori s64 kTA, kTA0, TAdut, TAdut4; 577c87742abSCrt Mori s64 temp = 25000; 578c87742abSCrt Mori s8 i; 579c87742abSCrt Mori 580c87742abSCrt Mori kTA = (Ea * 1000LL) >> 16LL; 581c87742abSCrt Mori kTA0 = (Eb * 1000LL) >> 8LL; 582c87742abSCrt Mori TAdut = div64_s64(((ambient - kTA0) * 1000000LL), kTA) + 25 * 1000000LL; 583b99095e5SCrt Mori TAdut4 = mlx90632_calc_ta4(TAdut, 10000LL); 584c87742abSCrt Mori 585c87742abSCrt Mori /* Iterations of calculation as described in datasheet */ 586c87742abSCrt Mori for (i = 0; i < 5; ++i) { 587b99095e5SCrt Mori temp = mlx90632_calc_temp_object_iteration(temp, object, TAdut, TAdut4, 588c87742abSCrt Mori Fa, Fb, Ga, Ha, Hb, 589c87742abSCrt Mori tmp_emi); 590c87742abSCrt Mori } 591c87742abSCrt Mori return temp; 592c87742abSCrt Mori } 593c87742abSCrt Mori 594e02472f7SCrt Mori static s32 mlx90632_calc_temp_object_extended(s64 object, s64 ambient, s64 reflected, 595e02472f7SCrt Mori s32 Ea, s32 Eb, s32 Fa, s32 Fb, s32 Ga, 596e02472f7SCrt Mori s16 Ha, s16 Hb, u16 tmp_emi) 597e02472f7SCrt Mori { 598e02472f7SCrt Mori s64 kTA, kTA0, TAdut, TAdut4, Tr4, TaTr4; 599e02472f7SCrt Mori s64 temp = 25000; 600e02472f7SCrt Mori s8 i; 601e02472f7SCrt Mori 602e02472f7SCrt Mori kTA = (Ea * 1000LL) >> 16LL; 603e02472f7SCrt Mori kTA0 = (Eb * 1000LL) >> 8LL; 604e02472f7SCrt Mori TAdut = div64_s64((ambient - kTA0) * 1000000LL, kTA) + 25 * 1000000LL; 605e02472f7SCrt Mori Tr4 = mlx90632_calc_ta4(reflected, 10); 606e02472f7SCrt Mori TAdut4 = mlx90632_calc_ta4(TAdut, 10000LL); 607e02472f7SCrt Mori TaTr4 = Tr4 - div64_s64(Tr4 - TAdut4, tmp_emi) * 1000; 608e02472f7SCrt Mori 609e02472f7SCrt Mori /* Iterations of calculation as described in datasheet */ 610e02472f7SCrt Mori for (i = 0; i < 5; ++i) { 611e02472f7SCrt Mori temp = mlx90632_calc_temp_object_iteration(temp, object, TAdut, TaTr4, 612e02472f7SCrt Mori Fa / 2, Fb, Ga, Ha, Hb, 613e02472f7SCrt Mori tmp_emi); 614e02472f7SCrt Mori } 615e02472f7SCrt Mori 616e02472f7SCrt Mori return temp; 617e02472f7SCrt Mori } 618e02472f7SCrt Mori 619c87742abSCrt Mori static int mlx90632_calc_object_dsp105(struct mlx90632_data *data, int *val) 620c87742abSCrt Mori { 621c87742abSCrt Mori s32 ret; 622c87742abSCrt Mori s32 Ea, Eb, Fa, Fb, Ga; 623c87742abSCrt Mori unsigned int read_tmp; 624c87742abSCrt Mori s16 Ha, Hb, Gb, Ka; 625c87742abSCrt Mori s16 ambient_new_raw, ambient_old_raw, object_new_raw, object_old_raw; 626c87742abSCrt Mori s64 object, ambient; 627c87742abSCrt Mori 628c87742abSCrt Mori ret = mlx90632_read_ee_register(data->regmap, MLX90632_EE_Ea, &Ea); 629c87742abSCrt Mori if (ret < 0) 630c87742abSCrt Mori return ret; 631c87742abSCrt Mori ret = mlx90632_read_ee_register(data->regmap, MLX90632_EE_Eb, &Eb); 632c87742abSCrt Mori if (ret < 0) 633c87742abSCrt Mori return ret; 634c87742abSCrt Mori ret = mlx90632_read_ee_register(data->regmap, MLX90632_EE_Fa, &Fa); 635c87742abSCrt Mori if (ret < 0) 636c87742abSCrt Mori return ret; 637c87742abSCrt Mori ret = mlx90632_read_ee_register(data->regmap, MLX90632_EE_Fb, &Fb); 638c87742abSCrt Mori if (ret < 0) 639c87742abSCrt Mori return ret; 640c87742abSCrt Mori ret = mlx90632_read_ee_register(data->regmap, MLX90632_EE_Ga, &Ga); 641c87742abSCrt Mori if (ret < 0) 642c87742abSCrt Mori return ret; 643c87742abSCrt Mori ret = regmap_read(data->regmap, MLX90632_EE_Ha, &read_tmp); 644c87742abSCrt Mori if (ret < 0) 645c87742abSCrt Mori return ret; 646c87742abSCrt Mori Ha = (s16)read_tmp; 647c87742abSCrt Mori ret = regmap_read(data->regmap, MLX90632_EE_Hb, &read_tmp); 648c87742abSCrt Mori if (ret < 0) 649c87742abSCrt Mori return ret; 650c87742abSCrt Mori Hb = (s16)read_tmp; 651c87742abSCrt Mori ret = regmap_read(data->regmap, MLX90632_EE_Gb, &read_tmp); 652c87742abSCrt Mori if (ret < 0) 653c87742abSCrt Mori return ret; 654c87742abSCrt Mori Gb = (s16)read_tmp; 655c87742abSCrt Mori ret = regmap_read(data->regmap, MLX90632_EE_Ka, &read_tmp); 656c87742abSCrt Mori if (ret < 0) 657c87742abSCrt Mori return ret; 658c87742abSCrt Mori Ka = (s16)read_tmp; 659c87742abSCrt Mori 660c87742abSCrt Mori ret = mlx90632_read_all_channel(data, 661c87742abSCrt Mori &ambient_new_raw, &ambient_old_raw, 662c87742abSCrt Mori &object_new_raw, &object_old_raw); 663c87742abSCrt Mori if (ret < 0) 664c87742abSCrt Mori return ret; 665c87742abSCrt Mori 666e02472f7SCrt Mori if (object_new_raw > MLX90632_EXTENDED_LIMIT && 667e02472f7SCrt Mori data->mtyp == MLX90632_MTYP_EXTENDED) { 668e02472f7SCrt Mori ret = mlx90632_read_all_channel_extended(data, &object_new_raw, 669e02472f7SCrt Mori &ambient_new_raw, &ambient_old_raw); 670e02472f7SCrt Mori if (ret < 0) 671e02472f7SCrt Mori return ret; 672e02472f7SCrt Mori 673e02472f7SCrt Mori /* Use extended mode calculations */ 674e02472f7SCrt Mori ambient = mlx90632_preprocess_temp_amb(ambient_new_raw, 675e02472f7SCrt Mori ambient_old_raw, Gb); 676e02472f7SCrt Mori object = mlx90632_preprocess_temp_obj_extended(object_new_raw, 677e02472f7SCrt Mori ambient_new_raw, 678e02472f7SCrt Mori ambient_old_raw, Ka); 679e02472f7SCrt Mori *val = mlx90632_calc_temp_object_extended(object, ambient, 680e02472f7SCrt Mori data->object_ambient_temperature, 681e02472f7SCrt Mori Ea, Eb, Fa, Fb, Ga, 682e02472f7SCrt Mori Ha, Hb, data->emissivity); 683e02472f7SCrt Mori return 0; 684e02472f7SCrt Mori } 685e02472f7SCrt Mori 686c87742abSCrt Mori ambient = mlx90632_preprocess_temp_amb(ambient_new_raw, 687c87742abSCrt Mori ambient_old_raw, Gb); 688c87742abSCrt Mori object = mlx90632_preprocess_temp_obj(object_new_raw, 689c87742abSCrt Mori object_old_raw, 690c87742abSCrt Mori ambient_new_raw, 691c87742abSCrt Mori ambient_old_raw, Ka); 692c87742abSCrt Mori 693c87742abSCrt Mori *val = mlx90632_calc_temp_object(object, ambient, Ea, Eb, Fa, Fb, Ga, 694c87742abSCrt Mori Ha, Hb, data->emissivity); 695c87742abSCrt Mori return 0; 696c87742abSCrt Mori } 697c87742abSCrt Mori 698c87742abSCrt Mori static int mlx90632_calc_ambient_dsp105(struct mlx90632_data *data, int *val) 699c87742abSCrt Mori { 700c87742abSCrt Mori s32 ret; 701c87742abSCrt Mori unsigned int read_tmp; 702c87742abSCrt Mori s32 PT, PR, PG, PO; 703c87742abSCrt Mori s16 Gb; 704c87742abSCrt Mori s16 ambient_new_raw, ambient_old_raw; 705c87742abSCrt Mori 706c87742abSCrt Mori ret = mlx90632_read_ee_register(data->regmap, MLX90632_EE_P_R, &PR); 707c87742abSCrt Mori if (ret < 0) 708c87742abSCrt Mori return ret; 709c87742abSCrt Mori ret = mlx90632_read_ee_register(data->regmap, MLX90632_EE_P_G, &PG); 710c87742abSCrt Mori if (ret < 0) 711c87742abSCrt Mori return ret; 712c87742abSCrt Mori ret = mlx90632_read_ee_register(data->regmap, MLX90632_EE_P_T, &PT); 713c87742abSCrt Mori if (ret < 0) 714c87742abSCrt Mori return ret; 715c87742abSCrt Mori ret = mlx90632_read_ee_register(data->regmap, MLX90632_EE_P_O, &PO); 716c87742abSCrt Mori if (ret < 0) 717c87742abSCrt Mori return ret; 718c87742abSCrt Mori ret = regmap_read(data->regmap, MLX90632_EE_Gb, &read_tmp); 719c87742abSCrt Mori if (ret < 0) 720c87742abSCrt Mori return ret; 721c87742abSCrt Mori Gb = (s16)read_tmp; 722c87742abSCrt Mori 723c87742abSCrt Mori ret = mlx90632_read_ambient_raw(data->regmap, &ambient_new_raw, 724c87742abSCrt Mori &ambient_old_raw); 725c50fadefSDan Carpenter if (ret < 0) 726c50fadefSDan Carpenter return ret; 727c87742abSCrt Mori *val = mlx90632_calc_temp_ambient(ambient_new_raw, ambient_old_raw, 728c87742abSCrt Mori PT, PR, PG, PO, Gb); 729c87742abSCrt Mori return ret; 730c87742abSCrt Mori } 731c87742abSCrt Mori 732c87742abSCrt Mori static int mlx90632_read_raw(struct iio_dev *indio_dev, 733c87742abSCrt Mori struct iio_chan_spec const *channel, int *val, 734c87742abSCrt Mori int *val2, long mask) 735c87742abSCrt Mori { 736c87742abSCrt Mori struct mlx90632_data *data = iio_priv(indio_dev); 737c87742abSCrt Mori int ret; 738c87742abSCrt Mori 739c87742abSCrt Mori switch (mask) { 740c87742abSCrt Mori case IIO_CHAN_INFO_PROCESSED: 741c87742abSCrt Mori switch (channel->channel2) { 742c87742abSCrt Mori case IIO_MOD_TEMP_AMBIENT: 743c87742abSCrt Mori ret = mlx90632_calc_ambient_dsp105(data, val); 744c87742abSCrt Mori if (ret < 0) 745c87742abSCrt Mori return ret; 746c87742abSCrt Mori return IIO_VAL_INT; 747c87742abSCrt Mori case IIO_MOD_TEMP_OBJECT: 748c87742abSCrt Mori ret = mlx90632_calc_object_dsp105(data, val); 749c87742abSCrt Mori if (ret < 0) 750c87742abSCrt Mori return ret; 751c87742abSCrt Mori return IIO_VAL_INT; 752c87742abSCrt Mori default: 753c87742abSCrt Mori return -EINVAL; 754c87742abSCrt Mori } 755c87742abSCrt Mori case IIO_CHAN_INFO_CALIBEMISSIVITY: 756c87742abSCrt Mori if (data->emissivity == 1000) { 757c87742abSCrt Mori *val = 1; 758c87742abSCrt Mori *val2 = 0; 759c87742abSCrt Mori } else { 760c87742abSCrt Mori *val = 0; 761c87742abSCrt Mori *val2 = data->emissivity * 1000; 762c87742abSCrt Mori } 763c87742abSCrt Mori return IIO_VAL_INT_PLUS_MICRO; 764c87742abSCrt Mori 765c87742abSCrt Mori default: 766c87742abSCrt Mori return -EINVAL; 767c87742abSCrt Mori } 768c87742abSCrt Mori } 769c87742abSCrt Mori 770c87742abSCrt Mori static int mlx90632_write_raw(struct iio_dev *indio_dev, 771c87742abSCrt Mori struct iio_chan_spec const *channel, int val, 772c87742abSCrt Mori int val2, long mask) 773c87742abSCrt Mori { 774c87742abSCrt Mori struct mlx90632_data *data = iio_priv(indio_dev); 775c87742abSCrt Mori 776c87742abSCrt Mori switch (mask) { 777c87742abSCrt Mori case IIO_CHAN_INFO_CALIBEMISSIVITY: 778c87742abSCrt Mori /* Confirm we are within 0 and 1.0 */ 779c87742abSCrt Mori if (val < 0 || val2 < 0 || val > 1 || 780c87742abSCrt Mori (val == 1 && val2 != 0)) 781c87742abSCrt Mori return -EINVAL; 782c87742abSCrt Mori data->emissivity = val * 1000 + val2 / 1000; 783c87742abSCrt Mori return 0; 784c87742abSCrt Mori default: 785c87742abSCrt Mori return -EINVAL; 786c87742abSCrt Mori } 787c87742abSCrt Mori } 788c87742abSCrt Mori 789c87742abSCrt Mori static const struct iio_chan_spec mlx90632_channels[] = { 790c87742abSCrt Mori { 791c87742abSCrt Mori .type = IIO_TEMP, 792c87742abSCrt Mori .modified = 1, 793c87742abSCrt Mori .channel2 = IIO_MOD_TEMP_AMBIENT, 794c87742abSCrt Mori .info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED), 795c87742abSCrt Mori }, 796c87742abSCrt Mori { 797c87742abSCrt Mori .type = IIO_TEMP, 798c87742abSCrt Mori .modified = 1, 799c87742abSCrt Mori .channel2 = IIO_MOD_TEMP_OBJECT, 800c87742abSCrt Mori .info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED) | 801c87742abSCrt Mori BIT(IIO_CHAN_INFO_CALIBEMISSIVITY), 802c87742abSCrt Mori }, 803c87742abSCrt Mori }; 804c87742abSCrt Mori 805c87742abSCrt Mori static const struct iio_info mlx90632_info = { 806c87742abSCrt Mori .read_raw = mlx90632_read_raw, 807c87742abSCrt Mori .write_raw = mlx90632_write_raw, 808c87742abSCrt Mori }; 809c87742abSCrt Mori 810c87742abSCrt Mori static int mlx90632_sleep(struct mlx90632_data *data) 811c87742abSCrt Mori { 812c87742abSCrt Mori regcache_mark_dirty(data->regmap); 813c87742abSCrt Mori 814c87742abSCrt Mori dev_dbg(&data->client->dev, "Requesting sleep"); 815c87742abSCrt Mori return mlx90632_pwr_set_sleep_step(data->regmap); 816c87742abSCrt Mori } 817c87742abSCrt Mori 818c87742abSCrt Mori static int mlx90632_wakeup(struct mlx90632_data *data) 819c87742abSCrt Mori { 820c87742abSCrt Mori int ret; 821c87742abSCrt Mori 822c87742abSCrt Mori ret = regcache_sync(data->regmap); 823c87742abSCrt Mori if (ret < 0) { 824c87742abSCrt Mori dev_err(&data->client->dev, 825c87742abSCrt Mori "Failed to sync regmap registers: %d\n", ret); 826c87742abSCrt Mori return ret; 827c87742abSCrt Mori } 828c87742abSCrt Mori 829c87742abSCrt Mori dev_dbg(&data->client->dev, "Requesting wake-up\n"); 830c87742abSCrt Mori return mlx90632_pwr_continuous(data->regmap); 831c87742abSCrt Mori } 832c87742abSCrt Mori 833c87742abSCrt Mori static int mlx90632_probe(struct i2c_client *client, 834c87742abSCrt Mori const struct i2c_device_id *id) 835c87742abSCrt Mori { 836c87742abSCrt Mori struct iio_dev *indio_dev; 837c87742abSCrt Mori struct mlx90632_data *mlx90632; 838c87742abSCrt Mori struct regmap *regmap; 839c87742abSCrt Mori int ret; 840c87742abSCrt Mori unsigned int read; 841c87742abSCrt Mori 842c87742abSCrt Mori indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*mlx90632)); 843c87742abSCrt Mori if (!indio_dev) { 844c87742abSCrt Mori dev_err(&client->dev, "Failed to allocate device\n"); 845c87742abSCrt Mori return -ENOMEM; 846c87742abSCrt Mori } 847c87742abSCrt Mori 848c87742abSCrt Mori regmap = devm_regmap_init_i2c(client, &mlx90632_regmap); 849c87742abSCrt Mori if (IS_ERR(regmap)) { 850c87742abSCrt Mori ret = PTR_ERR(regmap); 851c87742abSCrt Mori dev_err(&client->dev, "Failed to allocate regmap: %d\n", ret); 852c87742abSCrt Mori return ret; 853c87742abSCrt Mori } 854c87742abSCrt Mori 855c87742abSCrt Mori mlx90632 = iio_priv(indio_dev); 856c87742abSCrt Mori i2c_set_clientdata(client, indio_dev); 857c87742abSCrt Mori mlx90632->client = client; 858c87742abSCrt Mori mlx90632->regmap = regmap; 859e02472f7SCrt Mori mlx90632->mtyp = MLX90632_MTYP_MEDICAL; 860c87742abSCrt Mori 861c87742abSCrt Mori mutex_init(&mlx90632->lock); 862c87742abSCrt Mori indio_dev->name = id->name; 863c87742abSCrt Mori indio_dev->modes = INDIO_DIRECT_MODE; 864c87742abSCrt Mori indio_dev->info = &mlx90632_info; 865c87742abSCrt Mori indio_dev->channels = mlx90632_channels; 866c87742abSCrt Mori indio_dev->num_channels = ARRAY_SIZE(mlx90632_channels); 867c87742abSCrt Mori 868c87742abSCrt Mori ret = mlx90632_wakeup(mlx90632); 869c87742abSCrt Mori if (ret < 0) { 870c87742abSCrt Mori dev_err(&client->dev, "Wakeup failed: %d\n", ret); 871c87742abSCrt Mori return ret; 872c87742abSCrt Mori } 873c87742abSCrt Mori 874c87742abSCrt Mori ret = regmap_read(mlx90632->regmap, MLX90632_EE_VERSION, &read); 875c87742abSCrt Mori if (ret < 0) { 876c87742abSCrt Mori dev_err(&client->dev, "read of version failed: %d\n", ret); 877c87742abSCrt Mori return ret; 878c87742abSCrt Mori } 879e02472f7SCrt Mori read = read & MLX90632_ID_MASK; 880c87742abSCrt Mori if (read == MLX90632_ID_MEDICAL) { 881c87742abSCrt Mori dev_dbg(&client->dev, 882c87742abSCrt Mori "Detected Medical EEPROM calibration %x\n", read); 883c87742abSCrt Mori } else if (read == MLX90632_ID_CONSUMER) { 884c87742abSCrt Mori dev_dbg(&client->dev, 885c87742abSCrt Mori "Detected Consumer EEPROM calibration %x\n", read); 886e02472f7SCrt Mori } else if (read == MLX90632_ID_EXTENDED) { 887e02472f7SCrt Mori dev_dbg(&client->dev, 888e02472f7SCrt Mori "Detected Extended range EEPROM calibration %x\n", read); 889e02472f7SCrt Mori mlx90632->mtyp = MLX90632_MTYP_EXTENDED; 890389fc70bSCrt Mori } else if ((read & MLX90632_DSP_MASK) == MLX90632_DSP_VERSION) { 891389fc70bSCrt Mori dev_dbg(&client->dev, 892389fc70bSCrt Mori "Detected Unknown EEPROM calibration %x\n", read); 893c87742abSCrt Mori } else { 894c87742abSCrt Mori dev_err(&client->dev, 895389fc70bSCrt Mori "Wrong DSP version %x (expected %x)\n", 896389fc70bSCrt Mori read, MLX90632_DSP_VERSION); 897c87742abSCrt Mori return -EPROTONOSUPPORT; 898c87742abSCrt Mori } 899c87742abSCrt Mori 900c87742abSCrt Mori mlx90632->emissivity = 1000; 901e02472f7SCrt Mori mlx90632->object_ambient_temperature = 25000; /* 25 degrees milliCelsius */ 902c87742abSCrt Mori 903c87742abSCrt Mori pm_runtime_disable(&client->dev); 904c87742abSCrt Mori ret = pm_runtime_set_active(&client->dev); 905c87742abSCrt Mori if (ret < 0) { 906c87742abSCrt Mori mlx90632_sleep(mlx90632); 907c87742abSCrt Mori return ret; 908c87742abSCrt Mori } 909c87742abSCrt Mori pm_runtime_enable(&client->dev); 910c87742abSCrt Mori pm_runtime_set_autosuspend_delay(&client->dev, MLX90632_SLEEP_DELAY_MS); 911c87742abSCrt Mori pm_runtime_use_autosuspend(&client->dev); 912c87742abSCrt Mori 913c87742abSCrt Mori return iio_device_register(indio_dev); 914c87742abSCrt Mori } 915c87742abSCrt Mori 916c87742abSCrt Mori static int mlx90632_remove(struct i2c_client *client) 917c87742abSCrt Mori { 918c87742abSCrt Mori struct iio_dev *indio_dev = i2c_get_clientdata(client); 919c87742abSCrt Mori struct mlx90632_data *data = iio_priv(indio_dev); 920c87742abSCrt Mori 921c87742abSCrt Mori iio_device_unregister(indio_dev); 922c87742abSCrt Mori 923c87742abSCrt Mori pm_runtime_disable(&client->dev); 924c87742abSCrt Mori pm_runtime_set_suspended(&client->dev); 925c87742abSCrt Mori pm_runtime_put_noidle(&client->dev); 926c87742abSCrt Mori 927c87742abSCrt Mori mlx90632_sleep(data); 928c87742abSCrt Mori 929c87742abSCrt Mori return 0; 930c87742abSCrt Mori } 931c87742abSCrt Mori 932c87742abSCrt Mori static const struct i2c_device_id mlx90632_id[] = { 933c87742abSCrt Mori { "mlx90632", 0 }, 934c87742abSCrt Mori { } 935c87742abSCrt Mori }; 936c87742abSCrt Mori MODULE_DEVICE_TABLE(i2c, mlx90632_id); 937c87742abSCrt Mori 938c87742abSCrt Mori static const struct of_device_id mlx90632_of_match[] = { 939c87742abSCrt Mori { .compatible = "melexis,mlx90632" }, 940c87742abSCrt Mori { } 941c87742abSCrt Mori }; 942c87742abSCrt Mori MODULE_DEVICE_TABLE(of, mlx90632_of_match); 943c87742abSCrt Mori 944c87742abSCrt Mori static int __maybe_unused mlx90632_pm_suspend(struct device *dev) 945c87742abSCrt Mori { 946c87742abSCrt Mori struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 947c87742abSCrt Mori struct mlx90632_data *data = iio_priv(indio_dev); 948c87742abSCrt Mori 949c87742abSCrt Mori return mlx90632_sleep(data); 950c87742abSCrt Mori } 951c87742abSCrt Mori 952c87742abSCrt Mori static int __maybe_unused mlx90632_pm_resume(struct device *dev) 953c87742abSCrt Mori { 954c87742abSCrt Mori struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 955c87742abSCrt Mori struct mlx90632_data *data = iio_priv(indio_dev); 956c87742abSCrt Mori 957c87742abSCrt Mori return mlx90632_wakeup(data); 958c87742abSCrt Mori } 959c87742abSCrt Mori 960c87742abSCrt Mori static UNIVERSAL_DEV_PM_OPS(mlx90632_pm_ops, mlx90632_pm_suspend, 961c87742abSCrt Mori mlx90632_pm_resume, NULL); 962c87742abSCrt Mori 963c87742abSCrt Mori static struct i2c_driver mlx90632_driver = { 964c87742abSCrt Mori .driver = { 965c87742abSCrt Mori .name = "mlx90632", 966c87742abSCrt Mori .of_match_table = mlx90632_of_match, 967c87742abSCrt Mori .pm = &mlx90632_pm_ops, 968c87742abSCrt Mori }, 969c87742abSCrt Mori .probe = mlx90632_probe, 970c87742abSCrt Mori .remove = mlx90632_remove, 971c87742abSCrt Mori .id_table = mlx90632_id, 972c87742abSCrt Mori }; 973c87742abSCrt Mori module_i2c_driver(mlx90632_driver); 974c87742abSCrt Mori 975c87742abSCrt Mori MODULE_AUTHOR("Crt Mori <cmo@melexis.com>"); 976c87742abSCrt Mori MODULE_DESCRIPTION("Melexis MLX90632 contactless Infra Red temperature sensor driver"); 977c87742abSCrt Mori MODULE_LICENSE("GPL v2"); 978