On 10/08/15 12:07, Crt Mori wrote: > On 10 August 2015 at 09:43, Crt Mori <cmo@xxxxxxxxxxx> wrote: >> On 8 August 2015 at 18:58, Jonathan Cameron <jic23@xxxxxxxxxx> wrote: >>> On 30/07/15 10:25, Ludovic Tancerel wrote: >>>> Signed-off-by: Ludovic Tancerel <ludovic.tancerel@xxxxxxxxxxxxxxxxx> >>> A few bits inline. >>> Also, would prefer some basic description of the patch up here... >>>> --- >>>> drivers/iio/common/Kconfig | 1 + >>>> drivers/iio/common/Makefile | 1 + >>>> drivers/iio/common/ms_sensors/Kconfig | 6 + >>>> drivers/iio/common/ms_sensors/Makefile | 5 + >>>> drivers/iio/common/ms_sensors/ms_sensors_i2c.c | 634 +++++++++++++++++++++++++ >>>> drivers/iio/common/ms_sensors/ms_sensors_i2c.h | 54 +++ >>>> 6 files changed, 701 insertions(+) >>>> create mode 100644 drivers/iio/common/ms_sensors/Kconfig >>>> create mode 100644 drivers/iio/common/ms_sensors/Makefile >>>> create mode 100644 drivers/iio/common/ms_sensors/ms_sensors_i2c.c >>>> create mode 100644 drivers/iio/common/ms_sensors/ms_sensors_i2c.h >>>> >>>> diff --git a/drivers/iio/common/Kconfig b/drivers/iio/common/Kconfig >>>> index 790f106..26a6026 100644 >>>> --- a/drivers/iio/common/Kconfig >>>> +++ b/drivers/iio/common/Kconfig >>>> @@ -3,5 +3,6 @@ >>>> # >>>> >>>> source "drivers/iio/common/hid-sensors/Kconfig" >>>> +source "drivers/iio/common/ms_sensors/Kconfig" >>>> source "drivers/iio/common/ssp_sensors/Kconfig" >>>> source "drivers/iio/common/st_sensors/Kconfig" >>>> diff --git a/drivers/iio/common/Makefile b/drivers/iio/common/Makefile >>>> index b1e4d9c..585da6a 100644 >>>> --- a/drivers/iio/common/Makefile >>>> +++ b/drivers/iio/common/Makefile >>>> @@ -8,5 +8,6 @@ >>>> >>>> # When adding new entries keep the list in alphabetical order >>>> obj-y += hid-sensors/ >>>> +obj-y += ms_sensors/ >>>> obj-y += ssp_sensors/ >>>> obj-y += st_sensors/ >>>> diff --git a/drivers/iio/common/ms_sensors/Kconfig b/drivers/iio/common/ms_sensors/Kconfig >>>> new file mode 100644 >>>> index 0000000..b28a92b >>>> --- /dev/null >>>> +++ b/drivers/iio/common/ms_sensors/Kconfig >>>> @@ -0,0 +1,6 @@ >>>> +# >>>> +# Measurements Specialties sensors common library >>>> +# >>>> + >>>> +config IIO_MS_SENSORS_I2C >>>> + tristate >>>> diff --git a/drivers/iio/common/ms_sensors/Makefile b/drivers/iio/common/ms_sensors/Makefile >>>> new file mode 100644 >>>> index 0000000..7846428 >>>> --- /dev/null >>>> +++ b/drivers/iio/common/ms_sensors/Makefile >>>> @@ -0,0 +1,5 @@ >>>> +# >>>> +# Makefile for the Measurement Specialties sensor common modules. >>>> +# >>>> + >>>> +obj-$(CONFIG_IIO_MS_SENSORS_I2C) += ms_sensors_i2c.o >>>> diff --git a/drivers/iio/common/ms_sensors/ms_sensors_i2c.c b/drivers/iio/common/ms_sensors/ms_sensors_i2c.c >>>> new file mode 100644 >>>> index 0000000..f5d27b6 >>>> --- /dev/null >>>> +++ b/drivers/iio/common/ms_sensors/ms_sensors_i2c.c >>>> @@ -0,0 +1,634 @@ >>>> +/* >>>> + * Measurements Specialties driver common i2c functions >>>> + * >>>> + * Copyright (c) 2015 Measurement-Specialties >>>> + * >>>> + * Licensed under the GPL-2. >>>> + * >>>> + */ >>>> + >>>> +#include <linux/module.h> >>>> +#include <linux/iio/iio.h> >>>> +#include <linux/device.h> >>>> +#include <linux/delay.h> >>>> + >>>> +#include "ms_sensors_i2c.h" >>>> + >>>> +/* Conversion times in us */ >>>> +static const u16 ms_sensors_ht_t_conversion_time[] = { 50000, 25000, >>>> + 13000, 7000 }; >>>> +static const u16 ms_sensors_ht_h_conversion_time[] = { 16000, 3000, >>>> + 5000, 8000 }; >>>> +static const u16 ms_sensors_tp_conversion_time[] = { 500, 1100, 2100, >>>> + 4100, 8220, 16440 }; >>>> + >>>> +#define MS_SENSORS_SERIAL_READ_MSB 0xFA0F >>>> +#define MS_SENSORS_SERIAL_READ_LSB 0xFCC9 >>>> +#define MS_SENSORS_USER_REG_WRITE 0xE6 >>>> +#define MS_SENSORS_USER_REG_READ 0xE7 >>>> +#define MS_SENSORS_HT_T_CONVERSION_START 0xF3 >>>> +#define MS_SENSORS_HT_H_CONVERSION_START 0xF5 >>>> + >>>> +#define MS_SENSORS_TP_PROM_READ 0xA0 >>>> +#define MS_SENSORS_TP_T_CONVERSION_START 0x50 >>>> +#define MS_SENSORS_TP_P_CONVERSION_START 0x40 >>>> +#define MS_SENSORS_TP_ADC_READ 0x00 >>>> + >>>> +#define MS_SENSORS_NO_READ_CMD 0xFF >>>> + >>>> +/** >>>> + * ms_sensors_i2c_reset() - i2c reset function >>>> + * @cli: pointer on i2c client >>>> + * @cmd: reset cmd. Depends on device in use >>>> + * @delay: usleep minimal delay after reset command is issued >>>> + * >>>> + * Generic I2C reset function for Measurement Specialties devices >>>> + * >>>> + * Return: 0 on success, negative errno otherwise. >>>> + */ >>>> +int ms_sensors_i2c_reset(void *cli, u8 cmd, unsigned int delay) >>>> +{ >>>> + int ret; >>>> + struct i2c_client *client = cli; >>>> + >>>> + ret = i2c_smbus_write_byte(client, cmd); >>>> + if (ret) { >>>> + dev_err(&client->dev, "Failed to reset device\n"); >>>> + return ret; >>>> + } >>>> + usleep_range(delay, delay + 1000); >>>> + >>>> + return 0; >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_reset); >>>> + >>>> +/** >>>> + * ms_sensors_i2c_read_prom_word() - i2c prom word read function >>>> + * @cli: pointer on i2c client >>>> + * @cmd: PROM read cmd. Depends on device and prom id >>>> + * @word: pointer on word destination value >>>> + * >>>> + * Generic i2c prom word read function for Measurement Specialties devices >>>> + * >>>> + * Return: 0 on success, negative errno otherwise. >>>> + */ >>>> +int ms_sensors_i2c_read_prom_word(void *cli, int cmd, u16 *word) >>>> +{ >>>> + int ret; >>>> + struct i2c_client *client = (struct i2c_client *)cli; >>>> + >>>> + ret = i2c_smbus_read_word_swapped(client, cmd); >>>> + if (ret < 0) { >>>> + dev_err(&client->dev, "Failed to read prom word\n"); >>>> + return ret; >>>> + } >>>> + *word = ret; >>>> + >>>> + return 0; >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_read_prom_word); >>>> + >>>> +/** >>>> + * ms_sensors_i2c_convert_and_read() - i2c ADC conversion & read function >>>> + * @cli: pointer on i2c client >>>> + * @conv: ADC conversion command. Depends on device in use >>>> + * @rd: ADC read command. Depends on device in use >>>> + * @delay: usleep minimal delay after conversion command is issued >>>> + * @adc: pointer on ADC destination value >>>> + * >>>> + * Generic i2c ADC conversion & read function for Measurement Specialties >>>> + * devices. >>>> + * The function will issue conversion command, sleep appopriate delay, and >>>> + * issue command to read ADC >>>> + * >>>> + * Return: 0 on success, negative errno otherwise. >>>> + */ >>>> +int ms_sensors_i2c_convert_and_read(void *cli, u8 conv, u8 rd, >>>> + unsigned int delay, u32 *adc) >>>> +{ >>>> + int ret; >>>> + u32 buf = 0; >>>> + struct i2c_client *client = (struct i2c_client *)cli; >>>> + >>>> + /* Trigger conversion */ >>>> + ret = i2c_smbus_write_byte(client, conv); >>>> + if (ret) >>>> + goto err; >>>> + usleep_range(delay, delay + 1000); >>>> + >>>> + /* Retrieve ADC value */ >>>> + if (rd != MS_SENSORS_NO_READ_CMD) >>>> + ret = i2c_smbus_read_i2c_block_data(client, rd, 3, (u8 *)&buf); >>>> + else >>>> + ret = i2c_master_recv(client, (u8 *)&buf, 3); >>>> + if (ret < 0) >>>> + goto err; >>>> + >>>> + dev_dbg(&client->dev, "ADC raw value : %x\n", be32_to_cpu(buf) >> 8); >>>> + *adc = be32_to_cpu(buf) >> 8; >>>> + >>>> + return 0; >>>> +err: >>>> + dev_err(&client->dev, "Unable to make sensor adc conversion\n"); >>>> + return ret; >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_convert_and_read); >>>> + >>>> +/** >>>> + * ms_sensors_crc_valid() - CRC check function >>>> + * @value: input and CRC compare value >>>> + * >>>> + * Cyclic Redundancy Check function used in TSYS02D, HTU21, MS8607. >>>> + * This function performs a x^8 + x^5 + x^4 + 1 polynomial CRC. >>>> + * The argument contains CRC value in LSB byte while the bytes 1 and 2 >>>> + * are used for CRC computation >>>> + * >>>> + * Return: 1 if CRC is valid, 0 otherwise. >>>> + */ >>>> +static bool ms_sensors_crc_valid(u32 value) >>>> +{ >>>> + u32 polynom = 0x988000; /* x^8 + x^5 + x^4 + 1 */ >>>> + u32 msb = 0x800000; >>>> + u32 mask = 0xFF8000; >>>> + u32 result = value & 0xFFFF00; >>>> + u8 crc = value & 0xFF; >>>> + >>>> + while (msb != 0x80) { >>>> + if (result & msb) >>>> + result = ((result ^ polynom) & mask) >>>> + | (result & ~mask); >>>> + msb >>= 1; >>>> + mask >>= 1; >>>> + polynom >>= 1; >>>> + } >>>> + >>>> + return result == crc; >>>> +} >>>> + >>>> +/** >>>> + * ms_sensors_i2c_read_serial() - i2c serial number read function >>>> + * @cli: pointer on i2c client >>>> + * @sn: pointer on 64-bits destination value >>>> + * >>>> + * Generic i2c serial number read function for Measurement Specialties devices. >>>> + * This function is used for TSYS02d, HTU21, MS8607 chipset. >>>> + * Refer to datasheet: >>>> + * http://www.meas-spec.com/downloads/HTU2X_Serial_Number_Reading.pdf >>>> + * >>>> + * Return: 0 on success, negative errno otherwise. >>>> + */ >>>> +int ms_sensors_i2c_read_serial(struct i2c_client *client, u64 *sn) >>>> +{ >>>> + u8 i; >>>> + u64 rcv_buf = 0; >>>> + u16 send_buf; >>>> + int ret; >>>> + >>>> + struct i2c_msg msg[2] = { >>>> + { >>>> + .addr = client->addr, >>>> + .flags = client->flags, >>>> + .len = 2, >>>> + .buf = (char *)&send_buf, >>> If you are going to type cast, please match the (__u8 *) from >>> include/uapi/linux/i2c.h >> I am trying to push similar function (i2c_addressed_read) to i2c interface and >> since this driver has created its own instance of it, I would prefer >> we put it into >> i2c-core.c . Could you please support that debate [1] ? I think there are quite >> many drivers out there using the same function in a various way and it is >> about time to have it included in i2c to have more uniform control. > > You should use: regmap_i2c_read (#include <linux/regmap.h>) Whilst I'd be in favour of this driver switching over to regmap and hence making this available, it is worth noting that is a much bigger change than a simple function call! Jonathan > >>>> + }, >>>> + { >>>> + .addr = client->addr, >>>> + .flags = client->flags | I2C_M_RD, >>>> + .buf = (char *)&rcv_buf, >>>> + }, >>>> + }; >>>> + >>>> + /* Read MSB part of serial number */ >>>> + send_buf = cpu_to_be16(MS_SENSORS_SERIAL_READ_MSB); >>>> + msg[1].len = 8; >>>> + ret = i2c_transfer(client->adapter, msg, 2); >>>> + if (ret < 0) >>>> + goto err; >>>> + >>>> + rcv_buf = be64_to_cpu(rcv_buf); >>>> + dev_dbg(&client->dev, "Serial MSB raw : %llx\n", rcv_buf); >>>> + >>>> + for (i = 0; i < 64; i += 16) { >>>> + if (!ms_sensors_crc_valid((rcv_buf >> i) & 0xFFFF)) >>>> + return -ENODEV; >>>> + } >>>> + >>>> + *sn = (((rcv_buf >> 32) & 0xFF000000) | >>>> + ((rcv_buf >> 24) & 0x00FF0000) | >>>> + ((rcv_buf >> 16) & 0x0000FF00) | >>>> + ((rcv_buf >> 8) & 0x000000FF)) << 16; >>>> + >>>> + /* Read LSB part of serial number */ >>>> + send_buf = cpu_to_be16(MS_SENSORS_SERIAL_READ_LSB); >>>> + msg[1].len = 6; >>>> + rcv_buf = 0; >>>> + ret = i2c_transfer(client->adapter, msg, 2); >>>> + if (ret < 0) >>>> + goto err; >>>> + >>>> + rcv_buf = be64_to_cpu(rcv_buf) >> 16; >>>> + dev_dbg(&client->dev, "Serial MSB raw : %llx\n", rcv_buf); >>>> + >>>> + for (i = 0; i < 48; i += 24) { >>>> + if (!ms_sensors_crc_valid((rcv_buf >> i) & 0xFFFFFF)) >>>> + return -ENODEV; >>>> + } >>>> + >>>> + *sn |= (rcv_buf & 0xFFFF00) << 40 | (rcv_buf >> 32); >>>> + >>>> + return 0; >>>> + >>>> +err: >>> Put this inline and drop the goto >>>> + dev_err(&client->dev, "Unable to read device serial number"); >>>> + return ret; >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_read_serial); >>>> + >>> What is meant by a user_reg as opposed to other regs? >>>> +static int ms_sensors_i2c_read_user_reg(struct i2c_client *client, >>>> + u8 *user_reg) >>>> +{ >>>> + int ret; >>>> + >>>> + ret = i2c_smbus_write_byte(client, MS_SENSORS_USER_REG_READ); >>>> + if (ret) >>>> + goto err; >>>> + >>>> + ret = i2c_master_recv(client, user_reg, 1); >>>> + if (ret < 0) >>>> + goto err; >>>> + dev_dbg(&client->dev, "User register :%x\n", *user_reg); >>>> + >>>> + return 0; >>>> +err: >>>> + dev_err(&client->dev, "Unable to read user reg"); >>>> + return ret; >>>> +} >>>> + >>>> +/** >>>> + * ms_sensors_i2c_write_resolution() - set resolution i2c function >>>> + * @dev_data: pointer on temperature/humidity device data >>>> + * @i: resolution index to set >>>> + * >>>> + * That function will program the appropriate resolution based on the index >>>> + * provided when user space will set samp_freq channel. >>>> + * That function is used for TSYS02D, HTU21 and MS8607 chipsets >>>> + * >>>> + * Return: 0 on success, negative errno otherwise. >>>> + */ >>>> +ssize_t ms_sensors_i2c_write_resolution(struct ms_ht_dev *dev_data, >>>> + u8 i) >>>> +{ >>>> + u8 user_reg; >>>> + int ret; >>>> + >>>> + ret = ms_sensors_i2c_read_user_reg(dev_data->client, &user_reg); >>>> + if (ret) >>>> + return ret; >>>> + >>>> + user_reg &= 0x7E; >>>> + user_reg |= ((i & 1) << 7) + ((i & 2) >> 1); >>>> + >>>> + return i2c_smbus_write_byte_data(dev_data->client, >>>> + MS_SENSORS_USER_REG_WRITE, >>>> + user_reg); >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_write_resolution); >>>> + >>>> +/** >>>> + * ms_sensors_i2c_show_battery_low() - show device battery low indicator >>>> + * @dev_data: pointer on temperature/humidity device data >>>> + * @buf: pointer on char buffer to write result >>>> + * >>>> + * That function will read battery indicator value in the device and >>>> + * return 1 if the device voltage is below 2.25V. >>>> + * That function is used for TSYS02D, HTU21 and MS8607 chipsets >>>> + * >>>> + * Return: length of sprintf on success, negative errno otherwise. >>>> + */ >>>> +ssize_t ms_sensors_i2c_show_battery_low(struct ms_ht_dev *dev_data, >>>> + char *buf) >>>> +{ >>>> + int ret; >>>> + u8 user_reg; >>>> + >>>> + mutex_lock(&dev_data->lock); >>>> + ret = ms_sensors_i2c_read_user_reg(dev_data->client, &user_reg); >>>> + mutex_unlock(&dev_data->lock); >>>> + if (ret) >>>> + return ret; >>>> + >>>> + return sprintf(buf, "%d\n", (user_reg & 0x40) >> 6); >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_show_battery_low); >>>> + >>>> +/** >>>> + * ms_sensors_i2c_show_heater() - show device heater >>>> + * @dev_data: pointer on temperature/humidity device data >>>> + * @buf: pointer on char buffer to write result >>>> + * >>>> + * That function will read heater enable value in the device and >>>> + * return 1 if the heater is enabled >>>> + * That function is used for HTU21 and MS8607 chipsets >>>> + * >>>> + * Return: length of sprintf on success, negative errno otherwise. >>>> + */ >>>> +ssize_t ms_sensors_i2c_show_heater(struct ms_ht_dev *dev_data, >>>> + char *buf) >>>> +{ >>>> + u8 user_reg; >>>> + int ret; >>>> + >>>> + mutex_lock(&dev_data->lock); >>>> + ret = ms_sensors_i2c_read_user_reg(dev_data->client, &user_reg); >>>> + mutex_unlock(&dev_data->lock); >>>> + if (ret) >>>> + return ret; >>>> + >>>> + return sprintf(buf, "%d\n", (user_reg & 0x4) >> 2); >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_show_heater); >>>> + >>>> +/** >>>> + * ms_sensors_i2c_write_heater() - write device heater >>> I'm not sure the _i2c_ bit is important in this function name... >>> >>>> + * @dev_data: pointer on temperature/humidity device data >>>> + * @buf: pointer on char buffer from user space >>>> + * @len: length of buf >>>> + * >>>> + * That function will write 1 or 0 value in the device >>>> + * to enable or disable heater >>>> + * That function is used for HTU21 and MS8607 chipsets >>> That->This >>>> + * >>>> + * Return: length of buffer, negative errno otherwise. >>>> + */ >>>> +ssize_t ms_sensors_i2c_write_heater(struct ms_ht_dev *dev_data, >>>> + const char *buf, size_t len) >>>> +{ >>>> + u8 val, user_reg; >>>> + int ret; >>>> + >>>> + ret = kstrtou8(buf, 10, &val); >>>> + if (ret) >>>> + return ret; >>>> + >>>> + if (val > 1) >>>> + return -EINVAL; >>>> + >>>> + mutex_lock(&dev_data->lock); >>>> + ret = ms_sensors_i2c_read_user_reg(dev_data->client, &user_reg); >>>> + if (ret) { >>>> + mutex_unlock(&dev_data->lock); >>>> + return ret; >>>> + } >>>> + >>>> + user_reg &= 0xFB; >>>> + user_reg |= val << 2; >>>> + >>>> + ret = i2c_smbus_write_byte_data(dev_data->client, >>>> + MS_SENSORS_USER_REG_WRITE, >>>> + user_reg); >>>> + mutex_unlock(&dev_data->lock); >>>> + if (ret) { >>>> + dev_err(&dev_data->client->dev, "Unable to write user reg\n"); >>>> + return ret; >>>> + } >>>> + >>>> + return len; >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_write_heater); >>>> + >>>> +/** >>>> + * ms_sensors_i2c_ht_read_temperature() - i2c read temperature >>>> + * @dev_data: pointer on temperature/humidity device data >>>> + * @temperature:pointer on temperature destination value >>>> + * >>>> + * That function will get temperature ADC value from the device, >>>> + * check the CRC and compute the temperature value. >>>> + * That function is used for TSYS02D, HTU21 and MS8607 chipsets >>>> + * >>>> + * Return: 0 on success, negative errno otherwise. >>>> + */ >>>> +int ms_sensors_i2c_ht_read_temperature(struct ms_ht_dev *dev_data, >>>> + s32 *temperature) >>>> +{ >>>> + int ret; >>>> + u32 adc; >>>> + u16 delay; >>>> + >>>> + mutex_lock(&dev_data->lock); >>>> + delay = ms_sensors_ht_t_conversion_time[dev_data->res_index]; >>>> + ret = ms_sensors_i2c_convert_and_read(dev_data->client, >>>> + MS_SENSORS_HT_T_CONVERSION_START, >>>> + MS_SENSORS_NO_READ_CMD, >>>> + delay, &adc); >>>> + mutex_unlock(&dev_data->lock); >>>> + if (ret) >>>> + return ret; >>>> + >>>> + if (!ms_sensors_crc_valid(adc)) { >>>> + dev_err(&dev_data->client->dev, >>>> + "Temperature read crc check error\n"); >>>> + return -ENODEV; >>>> + } >>>> + >>>> + /* Temperature algorithm */ >>>> + *temperature = (((s64)(adc >> 8) * 175720) >> 16) - 46850; >>>> + >>>> + return 0; >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_ht_read_temperature); >>>> + >>>> +/** >>>> + * ms_sensors_i2c_ht_read_humidity() - i2c read humidity >>>> + * @dev_data: pointer on temperature/humidity device data >>>> + * @humidity: pointer on humidity destination value >>>> + * >>>> + * That function will get humidity ADC value from the device, >>>> + * check the CRC and compute the temperature value. >>>> + * That function is used for HTU21 and MS8607 chipsets >>>> + * >>>> + * Return: 0 on success, negative errno otherwise. >>>> + */ >>>> +int ms_sensors_i2c_ht_read_humidity(struct ms_ht_dev *dev_data, >>>> + u32 *humidity) >>>> +{ >>>> + int ret; >>>> + u32 adc; >>>> + u16 delay; >>>> + >>>> + mutex_lock(&dev_data->lock); >>>> + delay = ms_sensors_ht_h_conversion_time[dev_data->res_index]; >>>> + ret = ms_sensors_i2c_convert_and_read(dev_data->client, >>>> + MS_SENSORS_HT_H_CONVERSION_START, >>>> + MS_SENSORS_NO_READ_CMD, >>>> + delay, &adc); >>>> + mutex_unlock(&dev_data->lock); >>>> + if (ret) >>>> + return ret; >>>> + >>>> + if (!ms_sensors_crc_valid(adc)) { >>>> + dev_err(&dev_data->client->dev, >>>> + "Humidity read crc check error\n"); >>>> + return -ENODEV; >>>> + } >>>> + >>>> + /* Humidity algorithm */ >>>> + *humidity = (((s32)(adc >> 8) * 12500) >> 16) * 10 - 6000; >>>> + if (*humidity >= 100000) >>>> + *humidity = 100000; >>>> + >>>> + return 0; >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_i2c_ht_read_humidity); >>>> + >>> Multiline comment syntax is >>> /* >>> * CRC... >>> */ >>> Or ideally use kernel-doc as you have for other functions below >>> (not required as not exported) >>> >>>> +/* CRC check function for Temperature and pressure devices >>>> + * That function is only used when reading PROM coefficients */ >>>> +static bool ms_sensors_tp_crc_valid(u16 *prom, u8 len) >>>> +{ >>>> + unsigned int cnt, n_bit; >>>> + u16 n_rem = 0x0000, crc_read = prom[0], crc = (*prom & 0xF000) >> 12; >>>> + >>>> + prom[len - 1] = 0; >>>> + prom[0] &= 0x0FFF; /* Clear the CRC computation part */ >>>> + >>>> + for (cnt = 0; cnt < len * 2; cnt++) { >>>> + if (cnt % 2 == 1) >>>> + n_rem ^= prom[cnt >> 1] & 0x00FF; >>>> + else >>>> + n_rem ^= prom[cnt >> 1] >> 8; >>>> + >>>> + for (n_bit = 8; n_bit > 0; n_bit--) { >>>> + if (n_rem & 0x8000) >>>> + n_rem = (n_rem << 1) ^ 0x3000; >>>> + else >>>> + n_rem <<= 1; >>>> + } >>>> + } >>>> + n_rem >>= 12; >>>> + prom[0] = crc_read; >>>> + >>>> + return n_rem == crc; >>>> +} >>>> + >>>> +/** >>>> + * ms_sensors_tp_read_prom() - prom coeff read function >>>> + * @dev_data: pointer on temperature/pressure device data >>> pointer to temperature/... (fix throughout driver please) >>>> + * >>>> + * That function will read prom coefficients and check CRC >>> That -> This (and add a full stop at the end of the sentence. >>>> + * That function is used for MS5637 and MS8607 chipsets >>>> + * >>>> + * Return: 0 on success, negative errno otherwise. >>>> + */ >>>> +int ms_sensors_tp_read_prom(struct ms_tp_dev *dev_data) >>>> +{ >>>> + int i, ret; >>>> + >>>> + for (i = 0; i < MS_SENSORS_TP_PROM_WORDS_NB; i++) { >>>> + ret = ms_sensors_i2c_read_prom_word( >>>> + dev_data->client, >>>> + MS_SENSORS_TP_PROM_READ + (i << 1), >>>> + &dev_data->prom[i]); >>>> + >>>> + if (ret) >>>> + return ret; >>>> + } >>>> + >>>> + if (!ms_sensors_tp_crc_valid(dev_data->prom, >>>> + MS_SENSORS_TP_PROM_WORDS_NB + 1)) { >>>> + dev_err(&dev_data->client->dev, >>>> + "Calibration coefficients crc check error\n"); >>>> + return -ENODEV; >>>> + } >>>> + >>>> + return 0; >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_tp_read_prom); >>>> + >>>> +/** >>>> + * ms_sensors_read_temp_and_pressure() - read temp and pressure >>>> + * @dev_data: pointer on temperature/pressure device data >>> pointer to >>>> + * @temperature:pointer on temperature destination value >>> pointer to (also missing tab?) >>>> + * @pressure: pointer on pressure destination value >>>> + * >>>> + * That function will read ADC and compute pressure and temperature value >>> That->This and full stop at end of sentence. >>> >>>> + * That function is used for MS5637 and MS8607 chipsets >>>> + * >>>> + * Return: 0 on success, negative errno otherwise. >>>> + */ >>>> +int ms_sensors_read_temp_and_pressure(struct ms_tp_dev *dev_data, >>>> + int *temperature, >>>> + unsigned int *pressure) >>>> +{ >>>> + int ret; >>>> + u32 t_adc, p_adc; >>>> + s32 dt, temp; >>>> + s64 off, sens, t2, off2, sens2; >>>> + u16 *prom = dev_data->prom, delay; >>>> + u8 i; >>>> + >>>> + mutex_lock(&dev_data->lock); >>>> + i = dev_data->res_index * 2; >>>> + delay = ms_sensors_tp_conversion_time[dev_data->res_index]; >>> Blank line here would improve readability. >>>> + ret = ms_sensors_i2c_convert_and_read( >>>> + dev_data->client, >>>> + MS_SENSORS_TP_T_CONVERSION_START + i, >>>> + MS_SENSORS_TP_ADC_READ, >>>> + delay, &t_adc); >>>> + if (ret) { >>>> + mutex_unlock(&dev_data->lock); >>>> + return ret; >>>> + } >>> blank line here. >>>> + ret = ms_sensors_i2c_convert_and_read( >>>> + dev_data->client, >>>> + MS_SENSORS_TP_P_CONVERSION_START + i, >>>> + MS_SENSORS_TP_ADC_READ, >>>> + delay, &p_adc); >>>> + mutex_unlock(&dev_data->lock); >>>> + if (ret) >>>> + return ret; >>>> + >>>> + dt = (s32)t_adc - (prom[5] << 8); >>>> + >>>> + /* Actual temperature = 2000 + dT * TEMPSENS */ >>>> + temp = 2000 + (((s64)dt * prom[6]) >> 23); >>>> + >>>> + /* Second order temperature compensation */ >>>> + if (temp < 2000) { >>>> + s64 tmp = (s64)temp - 2000; >>>> + >>>> + t2 = (3 * ((s64)dt * (s64)dt)) >> 33; >>>> + off2 = (61 * tmp * tmp) >> 4; >>>> + sens2 = (29 * tmp * tmp) >> 4; >>>> + >>>> + if (temp < -1500) { >>>> + s64 tmp = (s64)temp + 1500; >>>> + >>>> + off2 += 17 * tmp * tmp; >>>> + sens2 += 9 * tmp * tmp; >>>> + } >>>> + } else { >>>> + t2 = (5 * ((s64)dt * (s64)dt)) >> 38; >>>> + off2 = 0; >>>> + sens2 = 0; >>>> + } >>>> + >>>> + /* OFF = OFF_T1 + TCO * dT */ >>>> + off = (((s64)prom[2]) << 17) + ((((s64)prom[4]) * (s64)dt) >> 6); >>>> + off -= off2; >>>> + >>>> + /* Sensitivity at actual temperature = SENS_T1 + TCS * dT */ >>>> + sens = (((s64)prom[1]) << 16) + (((s64)prom[3] * dt) >> 7); >>>> + sens -= sens2; >>>> + >>>> + /* Temperature compensated pressure = D1 * SENS - OFF */ >>>> + *temperature = (temp - t2) * 10; >>>> + *pressure = (u32)(((((s64)p_adc * sens) >> 21) - off) >> 15); >>>> + >>>> + return 0; >>>> +} >>>> +EXPORT_SYMBOL(ms_sensors_read_temp_and_pressure); >>>> + >>>> +MODULE_DESCRIPTION("Measurement-Specialties common i2c driver"); >>>> +MODULE_AUTHOR("William Markezana <william.markezana@xxxxxxxxxxxxx>"); >>>> +MODULE_AUTHOR("Ludovic Tancerel <ludovic.tancerel@xxxxxxxxxxxxxxxxx>"); >>>> +MODULE_LICENSE("GPL v2"); >>>> + >>>> diff --git a/drivers/iio/common/ms_sensors/ms_sensors_i2c.h b/drivers/iio/common/ms_sensors/ms_sensors_i2c.h >>>> new file mode 100644 >>>> index 0000000..a521428 >>>> --- /dev/null >>>> +++ b/drivers/iio/common/ms_sensors/ms_sensors_i2c.h >>>> @@ -0,0 +1,54 @@ >>>> +/* >>>> + * Measurements Specialties common sensor driver >>>> + * >>>> + * Copyright (c) 2015 Measurement-Specialties >>>> + * >>>> + * 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. >>>> + * >>> Unnecesary blank line here. >>>> + */ >>>> + >>>> +#ifndef _MS_SENSORS_I2C_H >>>> +#define _MS_SENSORS_I2C_H >>>> + >>>> +#include <linux/i2c.h> >>>> +#include <linux/mutex.h> >>>> + >>>> +#define MS_SENSORS_TP_PROM_WORDS_NB 7 >>>> + >>>> +struct ms_ht_dev { >>>> + struct i2c_client *client; >>>> + struct mutex lock; /* mutex protecting data structure */ >>>> + u8 res_index; >>>> +}; >>>> + >>>> +struct ms_tp_dev { >>>> + struct i2c_client *client; >>>> + struct mutex lock; /* mutex protecting data structure */ >>>> + /* Added element for CRC computation */ >>>> + u16 prom[MS_SENSORS_TP_PROM_WORDS_NB + 1]; >>>> + u8 res_index; >>>> +}; >>>> + >>>> +int ms_sensors_i2c_reset(void *cli, u8 cmd, unsigned int delay); >>>> +int ms_sensors_i2c_read_prom_word(void *cli, int cmd, u16 *word); >>>> +int ms_sensors_i2c_convert_and_read(void *cli, u8 conv, u8 rd, >>>> + unsigned int delay, u32 *adc); >>>> +int ms_sensors_i2c_read_serial(struct i2c_client *client, u64 *sn); >>>> +ssize_t ms_sensors_i2c_show_serial(struct ms_ht_dev *dev_data, char *buf); >>>> +ssize_t ms_sensors_i2c_write_resolution(struct ms_ht_dev *dev_data, u8 i); >>>> +ssize_t ms_sensors_i2c_show_battery_low(struct ms_ht_dev *dev_data, char *buf); >>>> +ssize_t ms_sensors_i2c_show_heater(struct ms_ht_dev *dev_data, char *buf); >>>> +ssize_t ms_sensors_i2c_write_heater(struct ms_ht_dev *dev_data, >>>> + const char *buf, size_t len); >>>> +int ms_sensors_i2c_ht_read_temperature(struct ms_ht_dev *dev_data, >>>> + s32 *temperature); >>>> +int ms_sensors_i2c_ht_read_humidity(struct ms_ht_dev *dev_data, >>>> + u32 *humidity); >>>> +int ms_sensors_tp_read_prom(struct ms_tp_dev *dev_data); >>>> +int ms_sensors_read_temp_and_pressure(struct ms_tp_dev *dev_data, >>>> + int *temperature, >>>> + unsigned int *pressure); >>>> + >>>> +#endif /* _MS_SENSORS_I2C_H */ >>>> >>> >>> -- >>> To unsubscribe from this list: send the line "unsubscribe linux-iio" in >>> the body of a message to majordomo@xxxxxxxxxxxxxxx >>> More majordomo info at http://vger.kernel.org/majordomo-info.html >> >> [1] http://comments.gmane.org/gmane.linux.drivers.i2c/23906 -- To unsubscribe from this list: send the line "unsubscribe linux-iio" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html