On Mon, Nov 23, 2020 at 10:56:57AM -0800, rentao.bupt@xxxxxxxxx wrote:
> From: Tao Ren <rentao.bupt@xxxxxxxxx>
>
> Add hardware monitoring driver for the Maxim MAX127 chip.
>
> MAX127 min/max range handling code is inspired by the max197 driver.
>
> Signed-off-by: Tao Ren <rentao.bupt@xxxxxxxxx>
Applied.
Thanks,
Guenter
> ---
> Changes in v5:
> - fix i2c_transfer() error handling.
> Changes in v4:
> - delete unnecessary "#include" lines.
> - simplify i2c_transfer() error handling.
> - add mutex to protect ctrl_byte in write_min|max() functions.
> Changes in v3:
> - no code change. xdp maintainers were removed from to/cc list.
> Changes in v2:
> - replace devm_hwmon_device_register_with_groups() with
> devm_hwmon_device_register_with_info() API.
> - divide min/max read and write methods to separate functions.
> - fix raw-to-vin conversion logic.
> - refine ctrl_byte handling so mutex is not needed to protect the
> byte.
> - improve i2c_transfer() error handling.
> - a few other improvements (comments, variable naming, and etc.).
>
> drivers/hwmon/Kconfig | 9 ++
> drivers/hwmon/Makefile | 1 +
> drivers/hwmon/max127.c | 352 +++++++++++++++++++++++++++++++++++++++++
> 3 files changed, 362 insertions(+)
> create mode 100644 drivers/hwmon/max127.c
>
> diff --git a/drivers/hwmon/Kconfig b/drivers/hwmon/Kconfig
> index 9d600e0c5584..716df51edc87 100644
> --- a/drivers/hwmon/Kconfig
> +++ b/drivers/hwmon/Kconfig
> @@ -950,6 +950,15 @@ config SENSORS_MAX1111
> This driver can also be built as a module. If so, the module
> will be called max1111.
>
> +config SENSORS_MAX127
> + tristate "Maxim MAX127 12-bit 8-channel Data Acquisition System"
> + depends on I2C
> + help
> + Say y here to support Maxim's MAX127 DAS chips.
> +
> + This driver can also be built as a module. If so, the module
> + will be called max127.
> +
> config SENSORS_MAX16065
> tristate "Maxim MAX16065 System Manager and compatibles"
> depends on I2C
> diff --git a/drivers/hwmon/Makefile b/drivers/hwmon/Makefile
> index 1083bbfac779..01ca5d3fbad4 100644
> --- a/drivers/hwmon/Makefile
> +++ b/drivers/hwmon/Makefile
> @@ -127,6 +127,7 @@ obj-$(CONFIG_SENSORS_LTC4260) += ltc4260.o
> obj-$(CONFIG_SENSORS_LTC4261) += ltc4261.o
> obj-$(CONFIG_SENSORS_LTQ_CPUTEMP) += ltq-cputemp.o
> obj-$(CONFIG_SENSORS_MAX1111) += max1111.o
> +obj-$(CONFIG_SENSORS_MAX127) += max127.o
> obj-$(CONFIG_SENSORS_MAX16065) += max16065.o
> obj-$(CONFIG_SENSORS_MAX1619) += max1619.o
> obj-$(CONFIG_SENSORS_MAX1668) += max1668.o
> diff --git a/drivers/hwmon/max127.c b/drivers/hwmon/max127.c
> new file mode 100644
> index 000000000000..402ffdc2f425
> --- /dev/null
> +++ b/drivers/hwmon/max127.c
> @@ -0,0 +1,352 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * Hardware monitoring driver for MAX127.
> + *
> + * Copyright (c) 2020 Facebook Inc.
> + */
> +
> +#include <linux/err.h>
> +#include <linux/hwmon.h>
> +#include <linux/i2c.h>
> +#include <linux/init.h>
> +#include <linux/module.h>
> +
> +/*
> + * MAX127 Control Byte. Refer to MAX127 datasheet, Table 1 "Control-Byte
> + * Format" for details.
> + */
> +#define MAX127_CTRL_START BIT(7)
> +#define MAX127_CTRL_SEL_SHIFT 4
> +#define MAX127_CTRL_RNG BIT(3)
> +#define MAX127_CTRL_BIP BIT(2)
> +#define MAX127_CTRL_PD1 BIT(1)
> +#define MAX127_CTRL_PD0 BIT(0)
> +
> +#define MAX127_NUM_CHANNELS 8
> +#define MAX127_SET_CHANNEL(ch) (((ch) & 7) << MAX127_CTRL_SEL_SHIFT)
> +
> +/*
> + * MAX127 channel input ranges. Refer to MAX127 datasheet, Table 3 "Range
> + * and Polarity Selection" for details.
> + */
> +#define MAX127_FULL_RANGE 10000 /* 10V */
> +#define MAX127_HALF_RANGE 5000 /* 5V */
> +
> +/*
> + * MAX127 returns 2 bytes at read:
> + * - the first byte contains data[11:4].
> + * - the second byte contains data[3:0] (MSB) and 4 dummy 0s (LSB).
> + * Refer to MAX127 datasheet, "Read a Conversion (Read Cycle)" section
> + * for details.
> + */
> +#define MAX127_DATA_LEN 2
> +#define MAX127_DATA_SHIFT 4
> +
> +#define MAX127_SIGN_BIT BIT(11)
> +
> +struct max127_data {
> + struct mutex lock;
> + struct i2c_client *client;
> + u8 ctrl_byte[MAX127_NUM_CHANNELS];
> +};
> +
> +static int max127_select_channel(struct i2c_client *client, u8 ctrl_byte)
> +{
> + int status;
> + struct i2c_msg msg = {
> + .addr = client->addr,
> + .flags = 0,
> + .len = sizeof(ctrl_byte),
> + .buf = &ctrl_byte,
> + };
> +
> + status = i2c_transfer(client->adapter, &msg, 1);
> + if (status < 0)
> + return status;
> + if (status != 1)
> + return -EIO;
> +
> + return 0;
> +}
> +
> +static int max127_read_channel(struct i2c_client *client, long *val)
> +{
> + int status;
> + u8 i2c_data[MAX127_DATA_LEN];
> + struct i2c_msg msg = {
> + .addr = client->addr,
> + .flags = I2C_M_RD,
> + .len = sizeof(i2c_data),
> + .buf = i2c_data,
> + };
> +
> + status = i2c_transfer(client->adapter, &msg, 1);
> + if (status < 0)
> + return status;
> + if (status != 1)
> + return -EIO;
> +
> + *val = (i2c_data[1] >> MAX127_DATA_SHIFT) |
> + ((u16)i2c_data[0] << MAX127_DATA_SHIFT);
> + return 0;
> +}
> +
> +static long max127_process_raw(u8 ctrl_byte, long raw)
> +{
> + long scale, weight;
> +
> + /*
> + * MAX127's data coding is binary in unipolar mode with 1 LSB =
> + * (Full-Scale/4096) and two’s complement binary in bipolar mode
> + * with 1 LSB = [(2 x |FS|)/4096].
> + * Refer to MAX127 datasheet, "Transfer Function" section for
> + * details.
> + */
> + scale = (ctrl_byte & MAX127_CTRL_RNG) ? MAX127_FULL_RANGE :
> + MAX127_HALF_RANGE;
> + if (ctrl_byte & MAX127_CTRL_BIP) {
> + weight = (raw & MAX127_SIGN_BIT);
> + raw &= ~MAX127_SIGN_BIT;
> + raw -= weight;
> + raw *= 2;
> + }
> +
> + return raw * scale / 4096;
> +}
> +
> +static int max127_read_input(struct max127_data *data, int channel, long *val)
> +{
> + long raw;
> + int status;
> + struct i2c_client *client = data->client;
> + u8 ctrl_byte = data->ctrl_byte[channel];
> +
> + mutex_lock(&data->lock);
> +
> + status = max127_select_channel(client, ctrl_byte);
> + if (status)
> + goto exit;
> +
> + status = max127_read_channel(client, &raw);
> + if (status)
> + goto exit;
> +
> + *val = max127_process_raw(ctrl_byte, raw);
> +
> +exit:
> + mutex_unlock(&data->lock);
> + return status;
> +}
> +
> +static int max127_read_min(struct max127_data *data, int channel, long *val)
> +{
> + u8 rng_bip = (data->ctrl_byte[channel] >> 2) & 3;
> + static const int min_input_map[4] = {
> + 0, /* RNG=0, BIP=0 */
> + -MAX127_HALF_RANGE, /* RNG=0, BIP=1 */
> + 0, /* RNG=1, BIP=0 */
> + -MAX127_FULL_RANGE, /* RNG=1, BIP=1 */
> + };
> +
> + *val = min_input_map[rng_bip];
> + return 0;
> +}
> +
> +static int max127_read_max(struct max127_data *data, int channel, long *val)
> +{
> + u8 rng_bip = (data->ctrl_byte[channel] >> 2) & 3;
> + static const int max_input_map[4] = {
> + MAX127_HALF_RANGE, /* RNG=0, BIP=0 */
> + MAX127_HALF_RANGE, /* RNG=0, BIP=1 */
> + MAX127_FULL_RANGE, /* RNG=1, BIP=0 */
> + MAX127_FULL_RANGE, /* RNG=1, BIP=1 */
> + };
> +
> + *val = max_input_map[rng_bip];
> + return 0;
> +}
> +
> +static int max127_write_min(struct max127_data *data, int channel, long val)
> +{
> + u8 ctrl;
> +
> + mutex_lock(&data->lock);
> +
> + ctrl = data->ctrl_byte[channel];
> + if (val <= -MAX127_FULL_RANGE) {
> + ctrl |= (MAX127_CTRL_RNG | MAX127_CTRL_BIP);
> + } else if (val < 0) {
> + ctrl |= MAX127_CTRL_BIP;
> + ctrl &= ~MAX127_CTRL_RNG;
> + } else {
> + ctrl &= ~MAX127_CTRL_BIP;
> + }
> + data->ctrl_byte[channel] = ctrl;
> +
> + mutex_unlock(&data->lock);
> +
> + return 0;
> +}
> +
> +static int max127_write_max(struct max127_data *data, int channel, long val)
> +{
> + mutex_lock(&data->lock);
> +
> + if (val >= MAX127_FULL_RANGE)
> + data->ctrl_byte[channel] |= MAX127_CTRL_RNG;
> + else
> + data->ctrl_byte[channel] &= ~MAX127_CTRL_RNG;
> +
> + mutex_unlock(&data->lock);
> +
> + return 0;
> +}
> +
> +static umode_t max127_is_visible(const void *_data,
> + enum hwmon_sensor_types type,
> + u32 attr, int channel)
> +{
> + if (type == hwmon_in) {
> + switch (attr) {
> + case hwmon_in_input:
> + return 0444;
> +
> + case hwmon_in_min:
> + case hwmon_in_max:
> + return 0644;
> +
> + default:
> + break;
> + }
> + }
> +
> + return 0;
> +}
> +
> +static int max127_read(struct device *dev, enum hwmon_sensor_types type,
> + u32 attr, int channel, long *val)
> +{
> + int status;
> + struct max127_data *data = dev_get_drvdata(dev);
> +
> + if (type != hwmon_in)
> + return -EOPNOTSUPP;
> +
> + switch (attr) {
> + case hwmon_in_input:
> + status = max127_read_input(data, channel, val);
> + break;
> +
> + case hwmon_in_min:
> + status = max127_read_min(data, channel, val);
> + break;
> +
> + case hwmon_in_max:
> + status = max127_read_max(data, channel, val);
> + break;
> +
> + default:
> + status = -EOPNOTSUPP;
> + break;
> + }
> +
> + return status;
> +}
> +
> +static int max127_write(struct device *dev, enum hwmon_sensor_types type,
> + u32 attr, int channel, long val)
> +{
> + int status;
> + struct max127_data *data = dev_get_drvdata(dev);
> +
> + if (type != hwmon_in)
> + return -EOPNOTSUPP;
> +
> + switch (attr) {
> + case hwmon_in_min:
> + status = max127_write_min(data, channel, val);
> + break;
> +
> + case hwmon_in_max:
> + status = max127_write_max(data, channel, val);
> + break;
> +
> + default:
> + status = -EOPNOTSUPP;
> + break;
> + }
> +
> + return status;
> +}
> +
> +static const struct hwmon_ops max127_hwmon_ops = {
> + .is_visible = max127_is_visible,
> + .read = max127_read,
> + .write = max127_write,
> +};
> +
> +static const struct hwmon_channel_info *max127_info[] = {
> + HWMON_CHANNEL_INFO(in,
> + HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,
> + HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,
> + HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,
> + HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,
> + HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,
> + HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,
> + HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,
> + HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX),
> + NULL,
> +};
> +
> +static const struct hwmon_chip_info max127_chip_info = {
> + .ops = &max127_hwmon_ops,
> + .info = max127_info,
> +};
> +
> +static int max127_probe(struct i2c_client *client,
> + const struct i2c_device_id *id)
> +{
> + int i;
> + struct device *hwmon_dev;
> + struct max127_data *data;
> + struct device *dev = &client->dev;
> +
> + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
> + if (!data)
> + return -ENOMEM;
> +
> + data->client = client;
> + mutex_init(&data->lock);
> + for (i = 0; i < ARRAY_SIZE(data->ctrl_byte); i++)
> + data->ctrl_byte[i] = (MAX127_CTRL_START |
> + MAX127_SET_CHANNEL(i));
> +
> + hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name,
> + data,
> + &max127_chip_info,
> + NULL);
> +
> + return PTR_ERR_OR_ZERO(hwmon_dev);
> +}
> +
> +static const struct i2c_device_id max127_id[] = {
> + { "max127", 0 },
> + { }
> +};
> +MODULE_DEVICE_TABLE(i2c, max127_id);
> +
> +static struct i2c_driver max127_driver = {
> + .class = I2C_CLASS_HWMON,
> + .driver = {
> + .name = "max127",
> + },
> + .probe = max127_probe,
> + .id_table = max127_id,
> +};
> +
> +module_i2c_driver(max127_driver);
> +
> +MODULE_LICENSE("GPL");
> +MODULE_AUTHOR("Mike Choi <mikechoi@xxxxxx>");
> +MODULE_AUTHOR("Tao Ren <rentao.bupt@xxxxxxxxx>");
> +MODULE_DESCRIPTION("MAX127 Hardware Monitoring driver");
