diff mbox series

[v2,2/2] hwmon: add MP2891 driver

Message ID SEYPR04MB6482956A833D60133EE47765FAF42@SEYPR04MB6482.apcprd04.prod.outlook.com (mailing list archive)
State Superseded
Headers show
Series [v2,1/2] dt-bindings: hwmon: Add mps mp2891 driver bindings | expand

Commit Message

Noah Wang May 23, 2024, 9:33 a.m. UTC
This driver is designed for MPS VR controller mp2891. This driver
exposes telemetry and limit value readings.

Signed-off-by: Noah Wang <noahwang.wang@outlook.com>

V1 -> V2:
    1. add limit register readings
    2. add status register readings
    3. change PSC_CURRENT_OUT format from linear to direct
    4. add more detailed explanation for special processing
    5. remove useless code
    6. move identify vout_scale, iout_scale function to
        identify() callback
    7. update MP2891 datasheet
---
 Documentation/hwmon/index.rst  |   1 +
 Documentation/hwmon/mp2891.rst | 179 +++++++++++++
 drivers/hwmon/pmbus/Kconfig    |   9 +
 drivers/hwmon/pmbus/Makefile   |   1 +
 drivers/hwmon/pmbus/mp2891.c   | 462 +++++++++++++++++++++++++++++++++
 5 files changed, 652 insertions(+)
 create mode 100644 Documentation/hwmon/mp2891.rst
 create mode 100644 drivers/hwmon/pmbus/mp2891.c

Comments

Guenter Roeck May 23, 2024, 4:17 p.m. UTC | #1
On Thu, May 23, 2024 at 05:33:48PM +0800, Noah Wang wrote:
> This driver is designed for MPS VR controller mp2891. This driver
> exposes telemetry and limit value readings.
> 
> Signed-off-by: Noah Wang <noahwang.wang@outlook.com>
> 
> V1 -> V2:
>     1. add limit register readings
>     2. add status register readings
>     3. change PSC_CURRENT_OUT format from linear to direct
>     4. add more detailed explanation for special processing
>     5. remove useless code
>     6. move identify vout_scale, iout_scale function to
>         identify() callback
>     7. update MP2891 datasheet

Couple of general comments:

It looks like the chip isn't really using linear11 format (at least not
for the most part); while some of the values have an exponent, the scale
always seems to be the same. I wonder if it would make sense to convert
all values into direct format and use r/m/b scale, or in other words
drop the exponent bits where needed.

There are no write functions for limit registers/commands, meaning
that values would be written directly into registers. I can only
imagine that this would cause a lot of trouble if anyone ever tries
to write a limit, especially for those registers where the upper bits
are not values but configuration (?) bits such as VOUT_UV_FAULT_LIMIT.

Checkpatch reports several "CHECK: Alignment should match open
parenthesis". Please fix.

Additional comments inline.

> ---
>  Documentation/hwmon/index.rst  |   1 +
>  Documentation/hwmon/mp2891.rst | 179 +++++++++++++
>  drivers/hwmon/pmbus/Kconfig    |   9 +
>  drivers/hwmon/pmbus/Makefile   |   1 +
>  drivers/hwmon/pmbus/mp2891.c   | 462 +++++++++++++++++++++++++++++++++
>  5 files changed, 652 insertions(+)
>  create mode 100644 Documentation/hwmon/mp2891.rst
>  create mode 100644 drivers/hwmon/pmbus/mp2891.c
> 
> diff --git a/Documentation/hwmon/index.rst b/Documentation/hwmon/index.rst
> index 03d313af4..88f70ef60 100644
> --- a/Documentation/hwmon/index.rst
> +++ b/Documentation/hwmon/index.rst
> @@ -168,6 +168,7 @@ Hardware Monitoring Kernel Drivers
>     mp2975
>     mp5023
>     mp5990
> +   mp2891
>     mpq8785
>     nct6683
>     nct6775
> diff --git a/Documentation/hwmon/mp2891.rst b/Documentation/hwmon/mp2891.rst
> new file mode 100644
> index 000000000..a487d5ee8
> --- /dev/null
> +++ b/Documentation/hwmon/mp2891.rst
> @@ -0,0 +1,179 @@
> +.. SPDX-License-Identifier: GPL-2.0
> +
> +Kernel driver mp2891
> +====================
> +
> +Supported chips:
> +
> +  * MPS mp2891
> +
> +    Prefix: 'mp2891'
> +
> +  * Datasheet
> +
> +    Publicly available at the MPS website : https://www.monolithicpower.com/en/mp2891.html
> +
The datasheet is not "publically available". It is only available
if one has an account.

> +Author:
> +
> +	Noah Wang <noahwang.wang@outlook.com>
> +
> +Description
> +-----------
> +
> +This driver implements support for Monolithic Power Systems, Inc. (MPS)
> +MP2891 Multi-phase Digital VR Controller.
> +
> +Device compliant with:
> +
> +- PMBus rev 1.3 interface.
> +
> +Device supports direct and linear format for reading input voltage,
> +output voltage, input currect, output current, input power, output
> +power, and temperature.
> +
> +The driver exports the following attributes via the 'sysfs' files
> +for input voltage:
> +
> +**in1_input**
> +
> +**in1_label**
> +
> +**in1_crit**
> +
> +**in1_crit_alarm**
> +
> +**in1_lcrit**
> +
> +**in1_lcrit_alarm**
> +
> +**in1_min**
> +
> +**in1_min_alarm**
> +
> +The driver provides the following attributes for output voltage:
> +
> +**in2_input**
> +
> +**in2_label**
> +
> +**in2_crit**
> +
> +**in2_crit_alarm**
> +
> +**in2_lcrit**
> +
> +**in2_lcrit_alarm**
> +
> +**in2_min**
> +
> +**in2_min_alarm**
> +
> +**in3_input**
> +
> +**in3_label**
> +
> +**in3_crit**
> +
> +**in3_crit_alarm**
> +
> +**in3_lcrit**
> +
> +**in3_lcrit_alarm**
> +
> +**in3_min**
> +
> +**in3_min_alarm**
> +
> +The driver provides the following attributes for input current:
> +
> +**curr1_input**
> +
> +**curr1_label**
> +
> +**curr1_max**
> +
> +**curr1_max_alarm**
> +
> +**curr2_input**
> +
> +**curr2_label**
> +
> +**curr2_max**
> +
> +**curr2_max_alarm**
> +
> +The driver provides the following attributes for output current:
> +
> +**curr3_input**
> +
> +**curr3_label**
> +
> +**curr3_crit**
> +
> +**curr3_crit_alarm**
> +
> +**curr3_max**
> +
> +**curr3_max_alarm**
> +
> +**curr4_input**
> +
> +**curr4_label**
> +
> +**curr4_crit**
> +
> +**curr4_crit_alarm**
> +
> +**curr4_max**
> +
> +**curr4_max_alarm**
> +
> +The driver provides the following attributes for input power:
> +
> +**power1_input**
> +
> +**power1_label**
> +
> +**power1_max**
> +
> +**power1_alarm**
> +
> +**power2_input**
> +
> +**power2_label**
> +
> +**power2_max**
> +
> +**power2_alarm**
> +
> +The driver provides the following attributes for output power:
> +
> +**power3_input**
> +
> +**power3_label**
> +
> +**power4_input**
> +
> +**power4_label**
> +
> +The driver provides the following attributes for temperature:
> +
> +**temp1_input**
> +
> +**temp1_crit**
> +
> +**temp1_crit_alarm**
> +
> +**temp1_max**
> +
> +**temp1_max_alarm**
> +
> +**temp2_input**
> +
> +**temp2_crit**
> +
> +**temp2_crit_alarm**
> +
> +**temp2_max**
> +
> +**temp2_max_alarm**
> diff --git a/drivers/hwmon/pmbus/Kconfig b/drivers/hwmon/pmbus/Kconfig
> index 08e82c457..c0cc673a6 100644
> --- a/drivers/hwmon/pmbus/Kconfig
> +++ b/drivers/hwmon/pmbus/Kconfig
> @@ -371,6 +371,15 @@ config SENSORS_MP5990
>  	  This driver can also be built as a module. If so, the module will
>  	  be called mp5990.
>  
> +config SENSORS_MP2891
> +    tristate "MPS MP2891"
> +    help
> +      If you say yes here you get hardware monitoring support for MPS
> +      MP2891 Dual Loop Digital Multi-Phase Controller.
> +
> +      This driver can also be built as a module. If so, the module will
> +      be called mp2891.
> +
>  config SENSORS_MPQ7932_REGULATOR
>  	bool "Regulator support for MPQ7932"
>  	depends on SENSORS_MPQ7932 && REGULATOR
> diff --git a/drivers/hwmon/pmbus/Makefile b/drivers/hwmon/pmbus/Makefile
> index 2279b3327..4f680bf06 100644
> --- a/drivers/hwmon/pmbus/Makefile
> +++ b/drivers/hwmon/pmbus/Makefile
> @@ -39,6 +39,7 @@ obj-$(CONFIG_SENSORS_MP2888)	+= mp2888.o
>  obj-$(CONFIG_SENSORS_MP2975)	+= mp2975.o
>  obj-$(CONFIG_SENSORS_MP5023)	+= mp5023.o
>  obj-$(CONFIG_SENSORS_MP5990)	+= mp5990.o
> +obj-$(CONFIG_SENSORS_MP2891)	+= mp2891.o
>  obj-$(CONFIG_SENSORS_MPQ7932)	+= mpq7932.o
>  obj-$(CONFIG_SENSORS_MPQ8785)	+= mpq8785.o
>  obj-$(CONFIG_SENSORS_PLI1209BC)	+= pli1209bc.o
> diff --git a/drivers/hwmon/pmbus/mp2891.c b/drivers/hwmon/pmbus/mp2891.c
> new file mode 100644
> index 000000000..afe49fcb3
> --- /dev/null
> +++ b/drivers/hwmon/pmbus/mp2891.c
> @@ -0,0 +1,462 @@
> +// SPDX-License-Identifier: GPL-2.0-or-later
> +/*
> + * Hardware monitoring driver for MPS Multi-phase Digital VR Controllers(MP2891)
> + */
> +
> +#include <linux/err.h>
> +#include <linux/i2c.h>
> +#include <linux/init.h>
> +#include <linux/kernel.h>
> +#include <linux/module.h>
> +#include "pmbus.h"
> +
> +/*
> + * Vender specific registers, the register MFR_SVI3_IOUT_PRT(0x65),
> + * MFR_VOUT_LOOP_CTRL(0xBD), READ_PIN_EST(0x94)and READ_IIN_EST(0x95)
> + * redefine the standard PMBUS register. The MFR_SVI3_IOUT_PRT(0x65)
> + * is used to identify the iout scale and the MFR_VOUT_LOOP_CTRL(0xBD)
> + * is used to identify the vout scale. The READ_PIN_EST(0x94) is used
> + * to read input power of per rail. The MP2891 does not have standard
> + * READ_IIN register(0x89), the iin telemetry can be obtained through
> + * the vendor redefined register READ_IIN_EST(0x95).
> + */
> +#define MFR_VOUT_LOOP_CTRL      0xBD
> +#define READ_PIN_EST            0x94
> +#define READ_IIN_EST            0x95
> +#define MFR_SVI3_IOUT_PRT	    0x65
> +
> +#define MP2891_TEMP_LIMIT_OFFSET	40
> +#define MP2891_PIN_LIMIT_UINT		2
> +#define MP2891_IOUT_LIMIT_UINT	    8
> +#define MP2891_IOUT_SCALE_DIV       32
> +#define MP2891_VOUT_SCALE_DIV       100
> +#define MP2891_OVUV_DELTA_SCALE     50
> +#define MP2891_OV_LIMIT_SCALE       20
> +#define MP2891_UV_LIMIT_SCALE       5
> +
> +#define MP2891_PAGE_NUM			2
> +

Please watch out for tab alignment. Defines should be 

#define<space>NAME<tab>value

> +#define MP2891_RAIL1_FUNC	(PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | \
> +							PMBUS_HAVE_IOUT | PMBUS_HAVE_TEMP | \
> +							PMBUS_HAVE_POUT | PMBUS_HAVE_PIN | \
> +							PMBUS_HAVE_IIN | PMBUS_HAVE_STATUS_VOUT | \
> +							PMBUS_HAVE_STATUS_IOUT | \
> +							PMBUS_HAVE_STATUS_INPUT | \
> +							PMBUS_HAVE_STATUS_TEMP)
> +
> +#define MP2891_RAIL2_FUNC	(PMBUS_HAVE_VOUT | PMBUS_HAVE_IOUT | \
> +							PMBUS_HAVE_TEMP | PMBUS_HAVE_POUT | \
> +							PMBUS_HAVE_PIN | PMBUS_HAVE_IIN | \
> +							PMBUS_HAVE_STATUS_VOUT | \
> +							PMBUS_HAVE_STATUS_IOUT | \
> +							PMBUS_HAVE_STATUS_INPUT | \
> +							PMBUS_HAVE_STATUS_TEMP)
> +
> +struct mp2891_data {
> +	struct pmbus_driver_info info;
> +	int vout_scale[MP2891_PAGE_NUM];
> +	int iout_scale[MP2891_PAGE_NUM];
> +};
> +
> +#define to_mp2891_data(x) container_of(x, struct mp2891_data, info)
> +
> +#define MAX_LIN_MANTISSA	(1023 * 1000)
> +#define MIN_LIN_MANTISSA	(511 * 1000)
> +
> +/* Converts a milli-unit DIRECT value to LINEAR11 format */
> +static u16 mp2891_data2reg_linear11(s64 val)
> +{
> +	s16 exponent = 0, mantissa;
> +	bool negative = false;
> +
> +	/* simple case */
> +	if (val == 0)
> +		return 0;
> +
> +	/* Reduce large mantissa until it fits into 10 bit */
> +	while (val >= MAX_LIN_MANTISSA && exponent < 15) {
> +		exponent++;
> +		val >>= 1;
> +	}

I don't think any of the data registers provides more than 10 bits
of range, so most of this complexity is unnecessary.

> +	/* Increase small mantissa to improve precision */
> +	while (val < MIN_LIN_MANTISSA && exponent > -15) {
> +		exponent--;
> +		val <<= 1;
> +	}
> +
> +	/* Convert mantissa from milli-units to units */
> +	mantissa = clamp_val(DIV_ROUND_CLOSEST_ULL(val, 1000), 0, 0x3ff);
> +
> +	/* restore sign */
> +	if (negative)
> +		mantissa = -mantissa;
> +
> +	/* Convert to 5 bit exponent, 11 bit mantissa */
> +	return (mantissa & 0x7ff) | ((exponent << 11) & 0xf800);
> +}
> +
> +static int
> +mp2891_identify_vout_scale(struct i2c_client *client, struct pmbus_driver_info *info,
> +										int page)
> +{
> +	struct mp2891_data *data = to_mp2891_data(info);
> +	int ret;
> +
> +	ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, page);
> +	if (ret < 0)
> +		return ret;
> +
> +	ret = i2c_smbus_read_word_data(client, MFR_VOUT_LOOP_CTRL);
> +	if (ret < 0)
> +		return ret;
> +
> +	/*
> +	 * The output voltage is equal to the READ_VOUT(0x8B) register value multiply
> +	 * by vout_scale.
> +	 * Obtain vout scale from the register MFR_VOUT_LOOP_CTRL, bits 15-14,bit 13.
> +	 * If MFR_VOUT_LOOP_CTRL[13] = 1, the vout scale is below:
> +	 * 2.5mV/LSB
> +	 * If MFR_VOUT_LOOP_CTRL[13] = 0, the vout scale is decided by
> +	 * MFR_VOUT_LOOP_CTRL[15:14]:
> +	 * 00b - 6.25mV/LSB, 01b - 5mV/LSB, 10b - 2mV/LSB, 11b - 1mV
> +	 */
> +	if (ret & GENMASK(13, 13)) {
> +		data->vout_scale[page] = 250;
> +	} else {
> +		ret = FIELD_GET(GENMASK(15, 14), ret);
> +		if (ret == 0)
> +			data->vout_scale[page] = 625;
> +		else if (ret == 1)
> +			data->vout_scale[page] = 500;
> +		else if (ret == 2)
> +			data->vout_scale[page] = 200;
> +		else
> +			data->vout_scale[page] = 100;
> +	}
> +
> +	return 0;
> +}
> +
> +static int
> +mp2891_identify_iout_scale(struct i2c_client *client, struct pmbus_driver_info *info,
> +										int page)
> +{
> +	struct mp2891_data *data = to_mp2891_data(info);
> +	int ret;
> +
> +	ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, page);
> +	if (ret < 0)
> +		return ret;
> +
> +	ret = i2c_smbus_read_word_data(client, MFR_SVI3_IOUT_PRT);
> +	if (ret < 0)
> +		return ret;
> +
> +	/*
> +	 * The output current is equal to the READ_IOUT(0x8C) register value
> +	 * multiply by iout_scale.
> +	 * Obtain iout_scale from the register MFR_SVI3_IOUT_PRT[2:0].
> +	 * The value is selected as below:
> +	 * 000b - 1A/LSB, 001b - (1/32)A/LSB, 010b - (1/16)A/LSB,
> +	 * 011b - (1/8)A/LSB, 100b - (1/4)A/LSB, 101b - (1/2)A/LSB
> +	 * 110b - 1A/LSB, 111b - 2A/LSB
> +	 */
> +	switch (ret & GENMASK(2, 0)) {
> +	case 0:
> +	case 6:
> +		data->iout_scale[page] = 32;
> +		break;
> +	case 1:
> +		data->iout_scale[page] = 1;
> +		break;
> +	case 2:
> +		data->iout_scale[page] = 2;
> +		break;
> +	case 3:
> +		data->iout_scale[page] = 4;
> +		break;
> +	case 4:
> +		data->iout_scale[page] = 8;
> +		break;
> +	case 5:
> +		data->iout_scale[page] = 16;
> +		break;
> +	default:
> +		data->iout_scale[page] = 64;
> +		break;
> +	}
> +
> +	return 0;
> +}
> +
> +static int mp2891_identify(struct i2c_client *client, struct pmbus_driver_info *info)
> +{
> +	int ret;
> +
> +	/* Identify vout scale for rail 1. */
> +	ret = mp2891_identify_vout_scale(client, info, 0);
> +	if (ret < 0)
> +		return ret;
> +
> +	/* Identify vout scale for rail 2. */
> +	ret = mp2891_identify_vout_scale(client, info, 1);
> +	if (ret < 0)
> +		return ret;
> +
> +	/* Identify iout scale for rail 1. */
> +	ret = mp2891_identify_iout_scale(client, info, 0);
> +	if (ret < 0)
> +		return ret;
> +
> +	/* Identify iout scale for rail 2. */
> +	ret = mp2891_identify_iout_scale(client, info, 1);
> +	if (ret < 0)
> +		return ret;
> +
> +	return ret;
> +}
> +
> +static int mp2891_read_byte_data(struct i2c_client *client, int page, int reg)
> +{
> +	int ret;
> +
> +	switch (reg) {
> +	case PMBUS_VOUT_MODE:
> +		/*
> +		 * The MP2891 does not follow standard PMBus protocol completely, the
> +		 * PMBUS_VOUT_MODE(0x20) in MP2891 is reserved and 0x00 is always be
> +		 * returned when the register is read. But the calculation of vout in
> +		 * this driver is based on direct format. As a result, the format of
> +		 * vout is enforced to direct.
> +		 */
> +		ret = PB_VOUT_MODE_DIRECT;
> +		break;
> +	default:
> +		ret = -ENODATA;
> +		break;
> +	}
> +
> +	return ret;
> +}
> +
> +static int mp2891_read_word_data(struct i2c_client *client, int page,
> +				 int phase, int reg)
> +{
> +	const struct pmbus_driver_info *info = pmbus_get_driver_info(client);
> +	struct mp2891_data *data = to_mp2891_data(info);
> +	int ret;
> +
> +	switch (reg) {
> +	case PMBUS_READ_IIN:
> +		/*
> +		 * The MP2891 does not have standard PMBUS_READ_IIN register(0x89),
> +		 * the iin telemetry can be obtained through the vender redefined
> +		 * register READ_IIN_EST(0x95).
> +		 */
> +		ret = pmbus_read_word_data(client, page, phase, READ_IIN_EST);
> +		break;
> +	case PMBUS_READ_PIN:
> +		/*
> +		 * The MP2891 has standard PMBUS_READ_PIN register(0x97), but this
> +		 * is not used to read the input power of per rail. The input power
> +		 * of per rail is read through the vender redefined register
> +		 * READ_PIN_EST(0x94).
> +		 */
> +		ret = pmbus_read_word_data(client, page, phase, READ_PIN_EST);
> +		break;
> +	case PMBUS_READ_VOUT:
> +	case PMBUS_VOUT_UV_WARN_LIMIT:
> +		ret = pmbus_read_word_data(client, page, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		ret = DIV_ROUND_CLOSEST(ret * data->vout_scale[page], MP2891_VOUT_SCALE_DIV);
> +		break;
> +	case PMBUS_READ_IOUT:
> +		ret = pmbus_read_word_data(client, page, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		ret = DIV_ROUND_CLOSEST((ret & GENMASK(10, 0)) * data->iout_scale[page],
> +								MP2891_IOUT_SCALE_DIV);
> +		break;
> +	case PMBUS_OT_FAULT_LIMIT:
> +	case PMBUS_OT_WARN_LIMIT:
> +		/*
> +		 * The MP2891 PMBUS_OT_FAULT_LIMIT and PMBUS_OT_WARN_LIMIT are not
> +		 * linear11 format, the scale is 1°C/LSB and they have 40°C offset.
> +		 * As a result, the limit value is calculated to m°C first, then
> +		 * it is converted to linear11 format.
> +		 */
> +		ret = pmbus_read_word_data(client, page, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		ret = mp2891_data2reg_linear11(((ret & GENMASK(7, 0)) -
> +								MP2891_TEMP_LIMIT_OFFSET) * 1000);
> +		break;
> +	case PMBUS_VIN_UV_FAULT_LIMIT:
> +	case PMBUS_VIN_UV_WARN_LIMIT:
> +		/*
> +		 * The MP2891 PMBUS_VIN_UV_FAULT_LIMIT and PMBUS_VIN_UV_WARN_LIMIT
> +		 * are not linear11 format, the scale is 31.25mV/LSB. As a result,
> +		 * the limit value is calculated to mV first, then it is converted
> +		 * to linear11 format.
> +		 */
> +		ret = pmbus_read_word_data(client, page, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		ret = mp2891_data2reg_linear11(DIV_ROUND_CLOSEST((ret & GENMASK(9, 0)) * 3125,
> +										100));
> +		break;
> +	case PMBUS_VIN_OV_FAULT_LIMIT:
> +		/*
> +		 * The MP2891 PMBUS_VIN_OV_FAULT_LIMIT are not linear11 format,
> +		 * the scale is 125mV/LSB. As a result, the limit value is
> +		 * calculated to mV first, then it is converted to linear11
> +		 * format.
> +		 */
> +		ret = pmbus_read_word_data(client, page, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		ret = mp2891_data2reg_linear11((ret & GENMASK(7, 0)) * 125);
> +		break;
> +	case PMBUS_VOUT_UV_FAULT_LIMIT:
> +		ret = pmbus_read_word_data(client, page, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		if (FIELD_GET(GENMASK(11, 8), ret))
> +			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_UV_LIMIT_SCALE -
> +				(FIELD_GET(GENMASK(11, 8), ret) + 1) * MP2891_OVUV_DELTA_SCALE;
> +		else
> +			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_UV_LIMIT_SCALE;
> +
> +		ret = ret < 0 ? 0 : ret;
> +		break;
> +	case PMBUS_VOUT_OV_FAULT_LIMIT:
> +		ret = pmbus_read_word_data(client, page, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		if (FIELD_GET(GENMASK(11, 8), ret))
> +			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_OV_LIMIT_SCALE +
> +				(FIELD_GET(GENMASK(11, 8), ret) + 1) * MP2891_OVUV_DELTA_SCALE;
> +		else
> +			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_OV_LIMIT_SCALE;
> +		break;
> +	case PMBUS_IOUT_OC_WARN_LIMIT:
> +	case PMBUS_IOUT_OC_FAULT_LIMIT:
> +		ret = pmbus_read_word_data(client, page, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		ret = DIV_ROUND_CLOSEST((ret & GENMASK(7, 0)) * data->iout_scale[page] *
> +						MP2891_IOUT_LIMIT_UINT, MP2891_IOUT_SCALE_DIV);
> +		break;
> +	case PMBUS_IIN_OC_WARN_LIMIT:
> +		/*
> +		 * The MP2891 PMBUS_IIN_OC_WARN_LIMIT are not linear11 format, the
> +		 * scale is 0.5V/LSB. As a result, the limit value is calculated to
> +		 * mA first, then it is converted to linear11 format.
> +		 */
> +		ret = pmbus_read_word_data(client, 0, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		ret = mp2891_data2reg_linear11((ret & GENMASK(9, 0)) * 1000 / 2);
> +		break;
> +	case PMBUS_PIN_OP_WARN_LIMIT:
> +		/*
> +		 * The MP2891 PMBUS_PIN_OP_WARN_LIMIT are not linear11 format, the
> +		 * scale is 2W/LSB. As a result, the limit value is calculated to
> +		 * mW first, then it is converted to linear11 format.
> +		 */
> +		ret = pmbus_read_word_data(client, 0, phase, reg);
> +		if (ret < 0)
> +			return ret;
> +
> +		ret = mp2891_data2reg_linear11((ret & GENMASK(9, 0)) * MP2891_PIN_LIMIT_UINT *
> +										1000);
> +		break;
> +	case PMBUS_READ_VIN:
> +	case PMBUS_READ_POUT:
> +	case PMBUS_READ_TEMPERATURE_1:
> +		ret = -ENODATA;
> +		break;
> +	default:
> +		ret = -EINVAL;
> +		break;
> +	}
> +
> +	return ret;
> +}
> +
> +static struct pmbus_driver_info mp2891_info = {
> +	.pages = MP2891_PAGE_NUM,
> +	.format[PSC_VOLTAGE_IN] = linear,
> +	.format[PSC_CURRENT_IN] = linear,
> +	.format[PSC_CURRENT_OUT] = direct,
> +	.format[PSC_TEMPERATURE] = linear,
> +	.format[PSC_POWER] = linear,
> +	.format[PSC_VOLTAGE_OUT] = direct,
> +
> +	.m[PSC_VOLTAGE_OUT] = 1,
> +	.R[PSC_VOLTAGE_OUT] = 3,
> +	.b[PSC_VOLTAGE_OUT] = 0,
> +
> +	.m[PSC_CURRENT_OUT] = 1,
> +	.R[PSC_CURRENT_OUT] = 0,
> +	.b[PSC_CURRENT_OUT] = 0,
> +
> +	.func[0] = MP2891_RAIL1_FUNC,
> +	.func[1] = MP2891_RAIL2_FUNC,
> +	.read_word_data = mp2891_read_word_data,
> +	.read_byte_data = mp2891_read_byte_data,
> +	.identify = mp2891_identify,
> +};
> +
> +static int mp2891_probe(struct i2c_client *client)
> +{
> +	struct pmbus_driver_info *info;
> +	struct mp2891_data *data;
> +
> +	data = devm_kzalloc(&client->dev, sizeof(struct mp2891_data), GFP_KERNEL);
> +	if (!data)
> +		return -ENOMEM;
> +
> +	memcpy(&data->info, &mp2891_info, sizeof(*info));
> +	info = &data->info;
> +
> +	return pmbus_do_probe(client, info);
> +}
> +
> +static const struct i2c_device_id mp2891_id[] = {
> +	{"mp2891", 0},
> +	{}
> +};
> +MODULE_DEVICE_TABLE(i2c, mp2891_id);
> +
> +static const struct of_device_id __maybe_unused mp2891_of_match[] = {
> +	{.compatible = "mps,mp2891"},
> +	{}
> +};
> +MODULE_DEVICE_TABLE(of, mp2891_of_match);
> +
> +static struct i2c_driver mp2891_driver = {
> +	.driver = {
> +		.name = "mp2891",
> +		.of_match_table = mp2891_of_match,
> +	},
> +	.probe = mp2891_probe,
> +	.id_table = mp2891_id,
> +};
> +
> +module_i2c_driver(mp2891_driver);
> +
> +MODULE_AUTHOR("Noah Wang <noahwang.wang@outlook.com>");
> +MODULE_DESCRIPTION("PMBus driver for MPS MP2891");
> +MODULE_LICENSE("GPL");
> +MODULE_IMPORT_NS(PMBUS);
> -- 
> 2.25.1
>
Noah Wang May 24, 2024, 12:16 p.m. UTC | #2
> > This driver is designed for MPS VR controller mp2891. This driver
> > exposes telemetry and limit value readings.
> > 
> > Signed-off-by: Noah Wang <noahwang.wang@outlook.com>
> > 
> > V1 -> V2:
> >     1. add limit register readings
> >     2. add status register readings
> >     3. change PSC_CURRENT_OUT format from linear to direct
> >     4. add more detailed explanation for special processing
> >     5. remove useless code
> >     6. move identify vout_scale, iout_scale function to
> >         identify() callback
> >     7. update MP2891 datasheet
> 
> Couple of general comments:
>  
> It looks like the chip isn't really using linear11 format (at least not
> for the most part); while some of the values have an exponent, the scale
> always seems to be the same. I wonder if it would make sense to convert
> all values into direct format and use r/m/b scale, or in other words
> drop the exponent bits where needed.
> 

Thanks for your comment. I think it is a good way. The PMBUS_READ_VIN, 
PMBUS_VIN_UV_FAULT_LIMIT and PMBUS_VIN_UV_WARN_LIMIT have the same 
scale(31.25mV/Lsb), the PMBUS_READ_TEMPERATURE_1, PMBUS_OT_FAULT_LIMIT 
and PMBUS_OT_WARN_LIMIT have the same scale(1°C/Lsb),  so the PSC_VOLTAGE_IN, 
PSC_TEMPERATURE can be changed from linear to direct and use r/m/b scale. But 
the exponent vaue of the PMBUS_READ_IIN, PMBUS_READ_POUT and PMBUS_READ_PIN 
is not constant, it maybe change. But the PMBUS_PIN_OP_WARN_LIMIT scale(2w/Lsb) 
and the PMBUS_IIN_OC_WARN_LIMIT scale (0.5A/Lsb) is constant. So I think the 
PSC_CURRENT_IN and PSC_POWER format should keep linear11. Here is only my view, 
it is pleasure to hear your advice. 

> There are no write functions for limit registers/commands, meaning
> that values would be written directly into registers. I can only
> imagine that this would cause a lot of trouble if anyone ever tries
> to write a limit, especially for those registers where the upper bits
> are not values but configuration (?) bits such as VOUT_UV_FAULT_LIMIT.
> 

Thanks for your comment.For mp2891, the limit register is configed through a
config file(the config file is sent to MP2891 by a GUI that mps provide), not
the pmbus. The reason for this is due to security verification and avoid
malicious attacks. So the limit register should not be configed by the driver.
I think I also need to add below function for write_word_data callback in next
version.
int mp2891_write_word_data(struct i2c_client *client, int page, int reg, u16 word)
{
	return -EINVAL;
}
It is pleasure to hear your advice.

> Checkpatch reports several "CHECK: Alignment should match open
> parenthesis". Please fix.
> 
> Additional comments inline.
> 

I am sorry for this. I will fix this issue in next version.

> > ---
> >  Documentation/hwmon/index.rst  |   1 +
> >  Documentation/hwmon/mp2891.rst | 179 +++++++++++++
> >  drivers/hwmon/pmbus/Kconfig    |   9 +
> >  drivers/hwmon/pmbus/Makefile   |   1 +
> >  drivers/hwmon/pmbus/mp2891.c   | 462 +++++++++++++++++++++++++++++++++
> >  5 files changed, 652 insertions(+)
> >  create mode 100644 Documentation/hwmon/mp2891.rst
> >  create mode 100644 drivers/hwmon/pmbus/mp2891.c
> > 
> > diff --git a/Documentation/hwmon/index.rst b/Documentation/hwmon/index.rst
> > index 03d313af4..88f70ef60 100644
> > --- a/Documentation/hwmon/index.rst
> > +++ b/Documentation/hwmon/index.rst
> > @@ -168,6 +168,7 @@ Hardware Monitoring Kernel Drivers
> >     mp2975
> >     mp5023
> >     mp5990
> > +   mp2891
> >     mpq8785
> >     nct6683
> >     nct6775
> > diff --git a/Documentation/hwmon/mp2891.rst b/Documentation/hwmon/mp2891.rst
> > new file mode 100644
> > index 000000000..a487d5ee8
> > --- /dev/null
> > +++ b/Documentation/hwmon/mp2891.rst
> > @@ -0,0 +1,179 @@
> > +.. SPDX-License-Identifier: GPL-2.0
> > +
> > +Kernel driver mp2891
> > +====================
> > +
> > +Supported chips:
> > +
> > +  * MPS mp2891
> > +
> > +    Prefix: 'mp2891'
> > +
> > +  * Datasheet
> > +
> > +    Publicly available at the MPS website : https://www.monolithicpower.com/en/mp2891.html
> > +
> The datasheet is not "publically available". It is only available
> if one has an account.
> 

Sorry for this, but mps only update the datasheet on their website. And guests should 
sign up an account for the datasheet.

> > +Author:
> > +
> > +	Noah Wang <noahwang.wang@outlook.com>
> > +
> > +Description
> > +-----------
> > +
> > +This driver implements support for Monolithic Power Systems, Inc. (MPS)
> > +MP2891 Multi-phase Digital VR Controller.
> > +
> > +Device compliant with:
> > +
> > +- PMBus rev 1.3 interface.
> > +
> > +Device supports direct and linear format for reading input voltage,
> > +output voltage, input currect, output current, input power, output
> > +power, and temperature.
> > +
> > +The driver exports the following attributes via the 'sysfs' files
> > +for input voltage:
> > +
> > +**in1_input**
> > +
> > +**in1_label**
> > +
> > +**in1_crit**
> > +
> > +**in1_crit_alarm**
> > +
> > +**in1_lcrit**
> > +
> > +**in1_lcrit_alarm**
> > +
> > +**in1_min**
> > +
> > +**in1_min_alarm**
> > +
> > +The driver provides the following attributes for output voltage:
> > +
> > +**in2_input**
> > +
> > +**in2_label**
> > +
> > +**in2_crit**
> > +
> > +**in2_crit_alarm**
> > +
> > +**in2_lcrit**
> > +
> > +**in2_lcrit_alarm**
> > +
> > +**in2_min**
> > +
> > +**in2_min_alarm**
> > +
> > +**in3_input**
> > +
> > +**in3_label**
> > +
> > +**in3_crit**
> > +
> > +**in3_crit_alarm**
> > +
> > +**in3_lcrit**
> > +
> > +**in3_lcrit_alarm**
> > +
> > +**in3_min**
> > +
> > +**in3_min_alarm**
> > +
> > +The driver provides the following attributes for input current:
> > +
> > +**curr1_input**
> > +
> > +**curr1_label**
> > +
> > +**curr1_max**
> > +
> > +**curr1_max_alarm**
> > +
> > +**curr2_input**
> > +
> > +**curr2_label**
> > +
> > +**curr2_max**
> > +
> > +**curr2_max_alarm**
> > +
> > +The driver provides the following attributes for output current:
> > +
> > +**curr3_input**
> > +
> > +**curr3_label**
> > +
> > +**curr3_crit**
> > +
> > +**curr3_crit_alarm**
> > +
> > +**curr3_max**
> > +
> > +**curr3_max_alarm**
> > +
> > +**curr4_input**
> > +
> > +**curr4_label**
> > +
> > +**curr4_crit**
> > +
> > +**curr4_crit_alarm**
> > +
> > +**curr4_max**
> > +
> > +**curr4_max_alarm**
> > +
> > +The driver provides the following attributes for input power:
> > +
> > +**power1_input**
> > +
> > +**power1_label**
> > +
> > +**power1_max**
> > +
> > +**power1_alarm**
> > +
> > +**power2_input**
> > +
> > +**power2_label**
> > +
> > +**power2_max**
> > +
> > +**power2_alarm**
> > +
> > +The driver provides the following attributes for output power:
> > +
> > +**power3_input**
> > +
> > +**power3_label**
> > +
> > +**power4_input**
> > +
> > +**power4_label**
> > +
> > +The driver provides the following attributes for temperature:
> > +
> > +**temp1_input**
> > +
> > +**temp1_crit**
> > +
> > +**temp1_crit_alarm**
> > +
> > +**temp1_max**
> > +
> > +**temp1_max_alarm**
> > +
> > +**temp2_input**
> > +
> > +**temp2_crit**
> > +
> > +**temp2_crit_alarm**
> > +
> > +**temp2_max**
> > +
> > +**temp2_max_alarm**
> > diff --git a/drivers/hwmon/pmbus/Kconfig b/drivers/hwmon/pmbus/Kconfig
> > index 08e82c457..c0cc673a6 100644
> > --- a/drivers/hwmon/pmbus/Kconfig
> > +++ b/drivers/hwmon/pmbus/Kconfig
> > @@ -371,6 +371,15 @@ config SENSORS_MP5990
> >  	  This driver can also be built as a module. If so, the module will
> >  	  be called mp5990.
> >  
> > +config SENSORS_MP2891
> > +    tristate "MPS MP2891"
> > +    help
> > +      If you say yes here you get hardware monitoring support for MPS
> > +      MP2891 Dual Loop Digital Multi-Phase Controller.
> > +
> > +      This driver can also be built as a module. If so, the module will
> > +      be called mp2891.
> > +
> >  config SENSORS_MPQ7932_REGULATOR
> >  	bool "Regulator support for MPQ7932"
> >  	depends on SENSORS_MPQ7932 && REGULATOR
> > diff --git a/drivers/hwmon/pmbus/Makefile b/drivers/hwmon/pmbus/Makefile
> > index 2279b3327..4f680bf06 100644
> > --- a/drivers/hwmon/pmbus/Makefile
> > +++ b/drivers/hwmon/pmbus/Makefile
> > @@ -39,6 +39,7 @@ obj-$(CONFIG_SENSORS_MP2888)	+= mp2888.o
> >  obj-$(CONFIG_SENSORS_MP2975)	+= mp2975.o
> >  obj-$(CONFIG_SENSORS_MP5023)	+= mp5023.o
> >  obj-$(CONFIG_SENSORS_MP5990)	+= mp5990.o
> > +obj-$(CONFIG_SENSORS_MP2891)	+= mp2891.o
> >  obj-$(CONFIG_SENSORS_MPQ7932)	+= mpq7932.o
> >  obj-$(CONFIG_SENSORS_MPQ8785)	+= mpq8785.o
> >  obj-$(CONFIG_SENSORS_PLI1209BC)	+= pli1209bc.o
> > diff --git a/drivers/hwmon/pmbus/mp2891.c b/drivers/hwmon/pmbus/mp2891.c
> > new file mode 100644
> > index 000000000..afe49fcb3
> > --- /dev/null
> > +++ b/drivers/hwmon/pmbus/mp2891.c
> > @@ -0,0 +1,462 @@
> > +// SPDX-License-Identifier: GPL-2.0-or-later
> > +/*
> > + * Hardware monitoring driver for MPS Multi-phase Digital VR Controllers(MP2891)
> > + */
> > +
> > +#include <linux/err.h>
> > +#include <linux/i2c.h>
> > +#include <linux/init.h>
> > +#include <linux/kernel.h>
> > +#include <linux/module.h>
> > +#include "pmbus.h"
> > +
> > +/*
> > + * Vender specific registers, the register MFR_SVI3_IOUT_PRT(0x65),
> > + * MFR_VOUT_LOOP_CTRL(0xBD), READ_PIN_EST(0x94)and READ_IIN_EST(0x95)
> > + * redefine the standard PMBUS register. The MFR_SVI3_IOUT_PRT(0x65)
> > + * is used to identify the iout scale and the MFR_VOUT_LOOP_CTRL(0xBD)
> > + * is used to identify the vout scale. The READ_PIN_EST(0x94) is used
> > + * to read input power of per rail. The MP2891 does not have standard
> > + * READ_IIN register(0x89), the iin telemetry can be obtained through
> > + * the vendor redefined register READ_IIN_EST(0x95).
> > + */
> > +#define MFR_VOUT_LOOP_CTRL      0xBD
> > +#define READ_PIN_EST            0x94
> > +#define READ_IIN_EST            0x95
> > +#define MFR_SVI3_IOUT_PRT	    0x65
> > +
> > +#define MP2891_TEMP_LIMIT_OFFSET	40
> > +#define MP2891_PIN_LIMIT_UINT		2
> > +#define MP2891_IOUT_LIMIT_UINT	    8
> > +#define MP2891_IOUT_SCALE_DIV       32
> > +#define MP2891_VOUT_SCALE_DIV       100
> > +#define MP2891_OVUV_DELTA_SCALE     50
> > +#define MP2891_OV_LIMIT_SCALE       20
> > +#define MP2891_UV_LIMIT_SCALE       5
> > +
> > +#define MP2891_PAGE_NUM			2
> > +
> 
> Please watch out for tab alignment. Defines should be
> 
> #define<space>NAME<tab>value
> 

I am sorry for this. I will fix this issue in next version.

> > +#define MP2891_RAIL1_FUNC	(PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | \
> > +							PMBUS_HAVE_IOUT | PMBUS_HAVE_TEMP | \
> > +							PMBUS_HAVE_POUT | PMBUS_HAVE_PIN | \
> > +							PMBUS_HAVE_IIN | PMBUS_HAVE_STATUS_VOUT | \
> > +							PMBUS_HAVE_STATUS_IOUT | \
> > +							PMBUS_HAVE_STATUS_INPUT | \
> > +							PMBUS_HAVE_STATUS_TEMP)
> > +
> > +#define MP2891_RAIL2_FUNC	(PMBUS_HAVE_VOUT | PMBUS_HAVE_IOUT | \
> > +							PMBUS_HAVE_TEMP | PMBUS_HAVE_POUT | \
> > +							PMBUS_HAVE_PIN | PMBUS_HAVE_IIN | \
> > +							PMBUS_HAVE_STATUS_VOUT | \
> > +							PMBUS_HAVE_STATUS_IOUT | \
> > +							PMBUS_HAVE_STATUS_INPUT | \
> > +							PMBUS_HAVE_STATUS_TEMP)
> > +
> > +struct mp2891_data {
> > +	struct pmbus_driver_info info;
> > +	int vout_scale[MP2891_PAGE_NUM];
> > +	int iout_scale[MP2891_PAGE_NUM];
> > +};
> > +
> > +#define to_mp2891_data(x) container_of(x, struct mp2891_data, info)
> > +
> > +#define MAX_LIN_MANTISSA	(1023 * 1000)
> > +#define MIN_LIN_MANTISSA	(511 * 1000)
> > +
> > +/* Converts a milli-unit DIRECT value to LINEAR11 format */
> > +static u16 mp2891_data2reg_linear11(s64 val)
> > +{
> > +	s16 exponent = 0, mantissa;
> > +	bool negative = false;
> > +
> > +	/* simple case */
> > +	if (val == 0)
> > +		return 0;
> > +
> > +	/* Reduce large mantissa until it fits into 10 bit */
> > +	while (val >= MAX_LIN_MANTISSA && exponent < 15) {
> > +		exponent++;
> > +		val >>= 1;
> > +	}
> 
> I don't think any of the data registers provides more than 10 bits
> of range, so most of this complexity is unnecessary.
> 

Thanks for your comment. For example, the PIN_OP_WARN_LIMIT(0x6B)(bit0-bit9)
register of MP2891 contains the limit value. And the scale is 2W/Lsb, so the
max limit value is 2046W, maybe this will not happen, but I think it is better
to keep this process to avoid data read error. Here is only my view, it is
pleasure to hear your advice.

> > +	/* Increase small mantissa to improve precision */
> > +	while (val < MIN_LIN_MANTISSA && exponent > -15) {
> > +		exponent--;
> > +		val <<= 1;
> > +	}
> > +
> > +	/* Convert mantissa from milli-units to units */
> > +	mantissa = clamp_val(DIV_ROUND_CLOSEST_ULL(val, 1000), 0, 0x3ff);
> > +
> > +	/* restore sign */
> > +	if (negative)
> > +		mantissa = -mantissa;
> > +
> > +	/* Convert to 5 bit exponent, 11 bit mantissa */
> > +	return (mantissa & 0x7ff) | ((exponent << 11) & 0xf800);
> > +}
> > +
> > +static int
> > +mp2891_identify_vout_scale(struct i2c_client *client, struct pmbus_driver_info *info,
> > +										int page)
> > +{
> > +	struct mp2891_data *data = to_mp2891_data(info);
> > +	int ret;
> > +
> > +	ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, page);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	ret = i2c_smbus_read_word_data(client, MFR_VOUT_LOOP_CTRL);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	/*
> > +	 * The output voltage is equal to the READ_VOUT(0x8B) register value multiply
> > +	 * by vout_scale.
> > +	 * Obtain vout scale from the register MFR_VOUT_LOOP_CTRL, bits 15-14,bit 13.
> > +	 * If MFR_VOUT_LOOP_CTRL[13] = 1, the vout scale is below:
> > +	 * 2.5mV/LSB
> > +	 * If MFR_VOUT_LOOP_CTRL[13] = 0, the vout scale is decided by
> > +	 * MFR_VOUT_LOOP_CTRL[15:14]:
> > +	 * 00b - 6.25mV/LSB, 01b - 5mV/LSB, 10b - 2mV/LSB, 11b - 1mV
> > +	 */
> > +	if (ret & GENMASK(13, 13)) {
> > +		data->vout_scale[page] = 250;
> > +	} else {
> > +		ret = FIELD_GET(GENMASK(15, 14), ret);
> > +		if (ret == 0)
> > +			data->vout_scale[page] = 625;
> > +		else if (ret == 1)
> > +			data->vout_scale[page] = 500;
> > +		else if (ret == 2)
> > +			data->vout_scale[page] = 200;
> > +		else
> > +			data->vout_scale[page] = 100;
> > +	}
> > +
> > +	return 0;
> > +}
> > +
> > +static int
> > +mp2891_identify_iout_scale(struct i2c_client *client, struct pmbus_driver_info *info,
> > +										int page)
> > +{
> > +	struct mp2891_data *data = to_mp2891_data(info);
> > +	int ret;
> > +
> > +	ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, page);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	ret = i2c_smbus_read_word_data(client, MFR_SVI3_IOUT_PRT);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	/*
> > +	 * The output current is equal to the READ_IOUT(0x8C) register value
> > +	 * multiply by iout_scale.
> > +	 * Obtain iout_scale from the register MFR_SVI3_IOUT_PRT[2:0].
> > +	 * The value is selected as below:
> > +	 * 000b - 1A/LSB, 001b - (1/32)A/LSB, 010b - (1/16)A/LSB,
> > +	 * 011b - (1/8)A/LSB, 100b - (1/4)A/LSB, 101b - (1/2)A/LSB
> > +	 * 110b - 1A/LSB, 111b - 2A/LSB
> > +	 */
> > +	switch (ret & GENMASK(2, 0)) {
> > +	case 0:
> > +	case 6:
> > +		data->iout_scale[page] = 32;
> > +		break;
> > +	case 1:
> > +		data->iout_scale[page] = 1;
> > +		break;
> > +	case 2:
> > +		data->iout_scale[page] = 2;
> > +		break;
> > +	case 3:
> > +		data->iout_scale[page] = 4;
> > +		break;
> > +	case 4:
> > +		data->iout_scale[page] = 8;
> > +		break;
> > +	case 5:
> > +		data->iout_scale[page] = 16;
> > +		break;
> > +	default:
> > +		data->iout_scale[page] = 64;
> > +		break;
> > +	}
> > +
> > +	return 0;
> > +}
> > +
> > +static int mp2891_identify(struct i2c_client *client, struct pmbus_driver_info *info)
> > +{
> > +	int ret;
> > +
> > +	/* Identify vout scale for rail 1. */
> > +	ret = mp2891_identify_vout_scale(client, info, 0);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	/* Identify vout scale for rail 2. */
> > +	ret = mp2891_identify_vout_scale(client, info, 1);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	/* Identify iout scale for rail 1. */
> > +	ret = mp2891_identify_iout_scale(client, info, 0);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	/* Identify iout scale for rail 2. */
> > +	ret = mp2891_identify_iout_scale(client, info, 1);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	return ret;
> > +}
> > +
> > +static int mp2891_read_byte_data(struct i2c_client *client, int page, int reg)
> > +{
> > +	int ret;
> > +
> > +	switch (reg) {
> > +	case PMBUS_VOUT_MODE:
> > +		/*
> > +		 * The MP2891 does not follow standard PMBus protocol completely, the
> > +		 * PMBUS_VOUT_MODE(0x20) in MP2891 is reserved and 0x00 is always be
> > +		 * returned when the register is read. But the calculation of vout in
> > +		 * this driver is based on direct format. As a result, the format of
> > +		 * vout is enforced to direct.
> > +		 */
> > +		ret = PB_VOUT_MODE_DIRECT;
> > +		break;
> > +	default:
> > +		ret = -ENODATA;
> > +		break;
> > +	}
> > +
> > +	return ret;
> > +}
> > +
> > +static int mp2891_read_word_data(struct i2c_client *client, int page,
> > +				 int phase, int reg)
> > +{
> > +	const struct pmbus_driver_info *info = pmbus_get_driver_info(client);
> > +	struct mp2891_data *data = to_mp2891_data(info);
> > +	int ret;
> > +
> > +	switch (reg) {
> > +	case PMBUS_READ_IIN:
> > +		/*
> > +		 * The MP2891 does not have standard PMBUS_READ_IIN register(0x89),
> > +		 * the iin telemetry can be obtained through the vender redefined
> > +		 * register READ_IIN_EST(0x95).
> > +		 */
> > +		ret = pmbus_read_word_data(client, page, phase, READ_IIN_EST);
> > +		break;
> > +	case PMBUS_READ_PIN:
> > +		/*
> > +		 * The MP2891 has standard PMBUS_READ_PIN register(0x97), but this
> > +		 * is not used to read the input power of per rail. The input power
> > +		 * of per rail is read through the vender redefined register
> > +		 * READ_PIN_EST(0x94).
> > +		 */
> > +		ret = pmbus_read_word_data(client, page, phase, READ_PIN_EST);
> > +		break;
> > +	case PMBUS_READ_VOUT:
> > +	case PMBUS_VOUT_UV_WARN_LIMIT:
> > +		ret = pmbus_read_word_data(client, page, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = DIV_ROUND_CLOSEST(ret * data->vout_scale[page], MP2891_VOUT_SCALE_DIV);
> > +		break;
> > +	case PMBUS_READ_IOUT:
> > +		ret = pmbus_read_word_data(client, page, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = DIV_ROUND_CLOSEST((ret & GENMASK(10, 0)) * data->iout_scale[page],
> > +								MP2891_IOUT_SCALE_DIV);
> > +		break;
> > +	case PMBUS_OT_FAULT_LIMIT:
> > +	case PMBUS_OT_WARN_LIMIT:
> > +		/*
> > +		 * The MP2891 PMBUS_OT_FAULT_LIMIT and PMBUS_OT_WARN_LIMIT are not
> > +		 * linear11 format, the scale is 1°C/LSB and they have 40°C offset.
> > +		 * As a result, the limit value is calculated to m°C first, then
> > +		 * it is converted to linear11 format.
> > +		 */
> > +		ret = pmbus_read_word_data(client, page, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = mp2891_data2reg_linear11(((ret & GENMASK(7, 0)) -
> > +								MP2891_TEMP_LIMIT_OFFSET) * 1000);
> > +		break;
> > +	case PMBUS_VIN_UV_FAULT_LIMIT:
> > +	case PMBUS_VIN_UV_WARN_LIMIT:
> > +		/*
> > +		 * The MP2891 PMBUS_VIN_UV_FAULT_LIMIT and PMBUS_VIN_UV_WARN_LIMIT
> > +		 * are not linear11 format, the scale is 31.25mV/LSB. As a result,
> > +		 * the limit value is calculated to mV first, then it is converted
> > +		 * to linear11 format.
> > +		 */
> > +		ret = pmbus_read_word_data(client, page, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = mp2891_data2reg_linear11(DIV_ROUND_CLOSEST((ret & GENMASK(9, 0)) * 3125,
> > +										100));
> > +		break;
> > +	case PMBUS_VIN_OV_FAULT_LIMIT:
> > +		/*
> > +		 * The MP2891 PMBUS_VIN_OV_FAULT_LIMIT are not linear11 format,
> > +		 * the scale is 125mV/LSB. As a result, the limit value is
> > +		 * calculated to mV first, then it is converted to linear11
> > +		 * format.
> > +		 */
> > +		ret = pmbus_read_word_data(client, page, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = mp2891_data2reg_linear11((ret & GENMASK(7, 0)) * 125);
> > +		break;
> > +	case PMBUS_VOUT_UV_FAULT_LIMIT:
> > +		ret = pmbus_read_word_data(client, page, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		if (FIELD_GET(GENMASK(11, 8), ret))
> > +			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_UV_LIMIT_SCALE -
> > +				(FIELD_GET(GENMASK(11, 8), ret) + 1) * MP2891_OVUV_DELTA_SCALE;
> > +		else
> > +			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_UV_LIMIT_SCALE;
> > +
> > +		ret = ret < 0 ? 0 : ret;
> > +		break;
> > +	case PMBUS_VOUT_OV_FAULT_LIMIT:
> > +		ret = pmbus_read_word_data(client, page, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		if (FIELD_GET(GENMASK(11, 8), ret))
> > +			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_OV_LIMIT_SCALE +
> > +				(FIELD_GET(GENMASK(11, 8), ret) + 1) * MP2891_OVUV_DELTA_SCALE;
> > +		else
> > +			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_OV_LIMIT_SCALE;
> > +		break;
> > +	case PMBUS_IOUT_OC_WARN_LIMIT:
> > +	case PMBUS_IOUT_OC_FAULT_LIMIT:
> > +		ret = pmbus_read_word_data(client, page, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = DIV_ROUND_CLOSEST((ret & GENMASK(7, 0)) * data->iout_scale[page] *
> > +						MP2891_IOUT_LIMIT_UINT, MP2891_IOUT_SCALE_DIV);
> > +		break;
> > +	case PMBUS_IIN_OC_WARN_LIMIT:
> > +		/*
> > +		 * The MP2891 PMBUS_IIN_OC_WARN_LIMIT are not linear11 format, the
> > +		 * scale is 0.5V/LSB. As a result, the limit value is calculated to
> > +		 * mA first, then it is converted to linear11 format.
> > +		 */
> > +		ret = pmbus_read_word_data(client, 0, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = mp2891_data2reg_linear11((ret & GENMASK(9, 0)) * 1000 / 2);
> > +		break;
> > +	case PMBUS_PIN_OP_WARN_LIMIT:
> > +		/*
> > +		 * The MP2891 PMBUS_PIN_OP_WARN_LIMIT are not linear11 format, the
> > +		 * scale is 2W/LSB. As a result, the limit value is calculated to
> > +		 * mW first, then it is converted to linear11 format.
> > +		 */
> > +		ret = pmbus_read_word_data(client, 0, phase, reg);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = mp2891_data2reg_linear11((ret & GENMASK(9, 0)) * MP2891_PIN_LIMIT_UINT *
> > +										1000);
> > +		break;
> > +	case PMBUS_READ_VIN:
> > +	case PMBUS_READ_POUT:
> > +	case PMBUS_READ_TEMPERATURE_1:
> > +		ret = -ENODATA;
> > +		break;
> > +	default:
> > +		ret = -EINVAL;
> > +		break;
> > +	}
> > +
> > +	return ret;
> > +}
> > +
> > +static struct pmbus_driver_info mp2891_info = {
> > +	.pages = MP2891_PAGE_NUM,
> > +	.format[PSC_VOLTAGE_IN] = linear,
> > +	.format[PSC_CURRENT_IN] = linear,
> > +	.format[PSC_CURRENT_OUT] = direct,
> > +	.format[PSC_TEMPERATURE] = linear,
> > +	.format[PSC_POWER] = linear,
> > +	.format[PSC_VOLTAGE_OUT] = direct,
> > +
> > +	.m[PSC_VOLTAGE_OUT] = 1,
> > +	.R[PSC_VOLTAGE_OUT] = 3,
> > +	.b[PSC_VOLTAGE_OUT] = 0,
> > +
> > +	.m[PSC_CURRENT_OUT] = 1,
> > +	.R[PSC_CURRENT_OUT] = 0,
> > +	.b[PSC_CURRENT_OUT] = 0,
> > +
> > +	.func[0] = MP2891_RAIL1_FUNC,
> > +	.func[1] = MP2891_RAIL2_FUNC,
> > +	.read_word_data = mp2891_read_word_data,
> > +	.read_byte_data = mp2891_read_byte_data,
> > +	.identify = mp2891_identify,
> > +};
> > +
> > +static int mp2891_probe(struct i2c_client *client)
> > +{
> > +	struct pmbus_driver_info *info;
> > +	struct mp2891_data *data;
> > +
> > +	data = devm_kzalloc(&client->dev, sizeof(struct mp2891_data), GFP_KERNEL);
> > +	if (!data)
> > +		return -ENOMEM;
> > +
> > +	memcpy(&data->info, &mp2891_info, sizeof(*info));
> > +	info = &data->info;
> > +
> > +	return pmbus_do_probe(client, info);
> > +}
> > +
> > +static const struct i2c_device_id mp2891_id[] = {
> > +	{"mp2891", 0},
> > +	{}
> > +};
> > +MODULE_DEVICE_TABLE(i2c, mp2891_id);
> > +
> > +static const struct of_device_id __maybe_unused mp2891_of_match[] = {
> > +	{.compatible = "mps,mp2891"},
> > +	{}
> > +};
> > +MODULE_DEVICE_TABLE(of, mp2891_of_match);
> > +
> > +static struct i2c_driver mp2891_driver = {
> > +	.driver = {
> > +		.name = "mp2891",
> > +		.of_match_table = mp2891_of_match,
> > +	},
> > +	.probe = mp2891_probe,
> > +	.id_table = mp2891_id,
> > +};
> > +
> > +module_i2c_driver(mp2891_driver);
> > +
> > +MODULE_AUTHOR("Noah Wang <noahwang.wang@outlook.com>");
> > +MODULE_DESCRIPTION("PMBus driver for MPS MP2891");
> > +MODULE_LICENSE("GPL");
> > +MODULE_IMPORT_NS(PMBUS);
> > -- 
> > 2.25.1
> >
diff mbox series

Patch

diff --git a/Documentation/hwmon/index.rst b/Documentation/hwmon/index.rst
index 03d313af4..88f70ef60 100644
--- a/Documentation/hwmon/index.rst
+++ b/Documentation/hwmon/index.rst
@@ -168,6 +168,7 @@  Hardware Monitoring Kernel Drivers
    mp2975
    mp5023
    mp5990
+   mp2891
    mpq8785
    nct6683
    nct6775
diff --git a/Documentation/hwmon/mp2891.rst b/Documentation/hwmon/mp2891.rst
new file mode 100644
index 000000000..a487d5ee8
--- /dev/null
+++ b/Documentation/hwmon/mp2891.rst
@@ -0,0 +1,179 @@ 
+.. SPDX-License-Identifier: GPL-2.0
+
+Kernel driver mp2891
+====================
+
+Supported chips:
+
+  * MPS mp2891
+
+    Prefix: 'mp2891'
+
+  * Datasheet
+
+    Publicly available at the MPS website : https://www.monolithicpower.com/en/mp2891.html
+
+Author:
+
+	Noah Wang <noahwang.wang@outlook.com>
+
+Description
+-----------
+
+This driver implements support for Monolithic Power Systems, Inc. (MPS)
+MP2891 Multi-phase Digital VR Controller.
+
+Device compliant with:
+
+- PMBus rev 1.3 interface.
+
+Device supports direct and linear format for reading input voltage,
+output voltage, input currect, output current, input power, output
+power, and temperature.
+
+The driver exports the following attributes via the 'sysfs' files
+for input voltage:
+
+**in1_input**
+
+**in1_label**
+
+**in1_crit**
+
+**in1_crit_alarm**
+
+**in1_lcrit**
+
+**in1_lcrit_alarm**
+
+**in1_min**
+
+**in1_min_alarm**
+
+The driver provides the following attributes for output voltage:
+
+**in2_input**
+
+**in2_label**
+
+**in2_crit**
+
+**in2_crit_alarm**
+
+**in2_lcrit**
+
+**in2_lcrit_alarm**
+
+**in2_min**
+
+**in2_min_alarm**
+
+**in3_input**
+
+**in3_label**
+
+**in3_crit**
+
+**in3_crit_alarm**
+
+**in3_lcrit**
+
+**in3_lcrit_alarm**
+
+**in3_min**
+
+**in3_min_alarm**
+
+The driver provides the following attributes for input current:
+
+**curr1_input**
+
+**curr1_label**
+
+**curr1_max**
+
+**curr1_max_alarm**
+
+**curr2_input**
+
+**curr2_label**
+
+**curr2_max**
+
+**curr2_max_alarm**
+
+The driver provides the following attributes for output current:
+
+**curr3_input**
+
+**curr3_label**
+
+**curr3_crit**
+
+**curr3_crit_alarm**
+
+**curr3_max**
+
+**curr3_max_alarm**
+
+**curr4_input**
+
+**curr4_label**
+
+**curr4_crit**
+
+**curr4_crit_alarm**
+
+**curr4_max**
+
+**curr4_max_alarm**
+
+The driver provides the following attributes for input power:
+
+**power1_input**
+
+**power1_label**
+
+**power1_max**
+
+**power1_alarm**
+
+**power2_input**
+
+**power2_label**
+
+**power2_max**
+
+**power2_alarm**
+
+The driver provides the following attributes for output power:
+
+**power3_input**
+
+**power3_label**
+
+**power4_input**
+
+**power4_label**
+
+The driver provides the following attributes for temperature:
+
+**temp1_input**
+
+**temp1_crit**
+
+**temp1_crit_alarm**
+
+**temp1_max**
+
+**temp1_max_alarm**
+
+**temp2_input**
+
+**temp2_crit**
+
+**temp2_crit_alarm**
+
+**temp2_max**
+
+**temp2_max_alarm**
diff --git a/drivers/hwmon/pmbus/Kconfig b/drivers/hwmon/pmbus/Kconfig
index 08e82c457..c0cc673a6 100644
--- a/drivers/hwmon/pmbus/Kconfig
+++ b/drivers/hwmon/pmbus/Kconfig
@@ -371,6 +371,15 @@  config SENSORS_MP5990
 	  This driver can also be built as a module. If so, the module will
 	  be called mp5990.
 
+config SENSORS_MP2891
+    tristate "MPS MP2891"
+    help
+      If you say yes here you get hardware monitoring support for MPS
+      MP2891 Dual Loop Digital Multi-Phase Controller.
+
+      This driver can also be built as a module. If so, the module will
+      be called mp2891.
+
 config SENSORS_MPQ7932_REGULATOR
 	bool "Regulator support for MPQ7932"
 	depends on SENSORS_MPQ7932 && REGULATOR
diff --git a/drivers/hwmon/pmbus/Makefile b/drivers/hwmon/pmbus/Makefile
index 2279b3327..4f680bf06 100644
--- a/drivers/hwmon/pmbus/Makefile
+++ b/drivers/hwmon/pmbus/Makefile
@@ -39,6 +39,7 @@  obj-$(CONFIG_SENSORS_MP2888)	+= mp2888.o
 obj-$(CONFIG_SENSORS_MP2975)	+= mp2975.o
 obj-$(CONFIG_SENSORS_MP5023)	+= mp5023.o
 obj-$(CONFIG_SENSORS_MP5990)	+= mp5990.o
+obj-$(CONFIG_SENSORS_MP2891)	+= mp2891.o
 obj-$(CONFIG_SENSORS_MPQ7932)	+= mpq7932.o
 obj-$(CONFIG_SENSORS_MPQ8785)	+= mpq8785.o
 obj-$(CONFIG_SENSORS_PLI1209BC)	+= pli1209bc.o
diff --git a/drivers/hwmon/pmbus/mp2891.c b/drivers/hwmon/pmbus/mp2891.c
new file mode 100644
index 000000000..afe49fcb3
--- /dev/null
+++ b/drivers/hwmon/pmbus/mp2891.c
@@ -0,0 +1,462 @@ 
+// SPDX-License-Identifier: GPL-2.0-or-later
+/*
+ * Hardware monitoring driver for MPS Multi-phase Digital VR Controllers(MP2891)
+ */
+
+#include <linux/err.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include "pmbus.h"
+
+/*
+ * Vender specific registers, the register MFR_SVI3_IOUT_PRT(0x65),
+ * MFR_VOUT_LOOP_CTRL(0xBD), READ_PIN_EST(0x94)and READ_IIN_EST(0x95)
+ * redefine the standard PMBUS register. The MFR_SVI3_IOUT_PRT(0x65)
+ * is used to identify the iout scale and the MFR_VOUT_LOOP_CTRL(0xBD)
+ * is used to identify the vout scale. The READ_PIN_EST(0x94) is used
+ * to read input power of per rail. The MP2891 does not have standard
+ * READ_IIN register(0x89), the iin telemetry can be obtained through
+ * the vendor redefined register READ_IIN_EST(0x95).
+ */
+#define MFR_VOUT_LOOP_CTRL      0xBD
+#define READ_PIN_EST            0x94
+#define READ_IIN_EST            0x95
+#define MFR_SVI3_IOUT_PRT	    0x65
+
+#define MP2891_TEMP_LIMIT_OFFSET	40
+#define MP2891_PIN_LIMIT_UINT		2
+#define MP2891_IOUT_LIMIT_UINT	    8
+#define MP2891_IOUT_SCALE_DIV       32
+#define MP2891_VOUT_SCALE_DIV       100
+#define MP2891_OVUV_DELTA_SCALE     50
+#define MP2891_OV_LIMIT_SCALE       20
+#define MP2891_UV_LIMIT_SCALE       5
+
+#define MP2891_PAGE_NUM			2
+
+#define MP2891_RAIL1_FUNC	(PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | \
+							PMBUS_HAVE_IOUT | PMBUS_HAVE_TEMP | \
+							PMBUS_HAVE_POUT | PMBUS_HAVE_PIN | \
+							PMBUS_HAVE_IIN | PMBUS_HAVE_STATUS_VOUT | \
+							PMBUS_HAVE_STATUS_IOUT | \
+							PMBUS_HAVE_STATUS_INPUT | \
+							PMBUS_HAVE_STATUS_TEMP)
+
+#define MP2891_RAIL2_FUNC	(PMBUS_HAVE_VOUT | PMBUS_HAVE_IOUT | \
+							PMBUS_HAVE_TEMP | PMBUS_HAVE_POUT | \
+							PMBUS_HAVE_PIN | PMBUS_HAVE_IIN | \
+							PMBUS_HAVE_STATUS_VOUT | \
+							PMBUS_HAVE_STATUS_IOUT | \
+							PMBUS_HAVE_STATUS_INPUT | \
+							PMBUS_HAVE_STATUS_TEMP)
+
+struct mp2891_data {
+	struct pmbus_driver_info info;
+	int vout_scale[MP2891_PAGE_NUM];
+	int iout_scale[MP2891_PAGE_NUM];
+};
+
+#define to_mp2891_data(x) container_of(x, struct mp2891_data, info)
+
+#define MAX_LIN_MANTISSA	(1023 * 1000)
+#define MIN_LIN_MANTISSA	(511 * 1000)
+
+/* Converts a milli-unit DIRECT value to LINEAR11 format */
+static u16 mp2891_data2reg_linear11(s64 val)
+{
+	s16 exponent = 0, mantissa;
+	bool negative = false;
+
+	/* simple case */
+	if (val == 0)
+		return 0;
+
+	/* Reduce large mantissa until it fits into 10 bit */
+	while (val >= MAX_LIN_MANTISSA && exponent < 15) {
+		exponent++;
+		val >>= 1;
+	}
+	/* Increase small mantissa to improve precision */
+	while (val < MIN_LIN_MANTISSA && exponent > -15) {
+		exponent--;
+		val <<= 1;
+	}
+
+	/* Convert mantissa from milli-units to units */
+	mantissa = clamp_val(DIV_ROUND_CLOSEST_ULL(val, 1000), 0, 0x3ff);
+
+	/* restore sign */
+	if (negative)
+		mantissa = -mantissa;
+
+	/* Convert to 5 bit exponent, 11 bit mantissa */
+	return (mantissa & 0x7ff) | ((exponent << 11) & 0xf800);
+}
+
+static int
+mp2891_identify_vout_scale(struct i2c_client *client, struct pmbus_driver_info *info,
+										int page)
+{
+	struct mp2891_data *data = to_mp2891_data(info);
+	int ret;
+
+	ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, page);
+	if (ret < 0)
+		return ret;
+
+	ret = i2c_smbus_read_word_data(client, MFR_VOUT_LOOP_CTRL);
+	if (ret < 0)
+		return ret;
+
+	/*
+	 * The output voltage is equal to the READ_VOUT(0x8B) register value multiply
+	 * by vout_scale.
+	 * Obtain vout scale from the register MFR_VOUT_LOOP_CTRL, bits 15-14,bit 13.
+	 * If MFR_VOUT_LOOP_CTRL[13] = 1, the vout scale is below:
+	 * 2.5mV/LSB
+	 * If MFR_VOUT_LOOP_CTRL[13] = 0, the vout scale is decided by
+	 * MFR_VOUT_LOOP_CTRL[15:14]:
+	 * 00b - 6.25mV/LSB, 01b - 5mV/LSB, 10b - 2mV/LSB, 11b - 1mV
+	 */
+	if (ret & GENMASK(13, 13)) {
+		data->vout_scale[page] = 250;
+	} else {
+		ret = FIELD_GET(GENMASK(15, 14), ret);
+		if (ret == 0)
+			data->vout_scale[page] = 625;
+		else if (ret == 1)
+			data->vout_scale[page] = 500;
+		else if (ret == 2)
+			data->vout_scale[page] = 200;
+		else
+			data->vout_scale[page] = 100;
+	}
+
+	return 0;
+}
+
+static int
+mp2891_identify_iout_scale(struct i2c_client *client, struct pmbus_driver_info *info,
+										int page)
+{
+	struct mp2891_data *data = to_mp2891_data(info);
+	int ret;
+
+	ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, page);
+	if (ret < 0)
+		return ret;
+
+	ret = i2c_smbus_read_word_data(client, MFR_SVI3_IOUT_PRT);
+	if (ret < 0)
+		return ret;
+
+	/*
+	 * The output current is equal to the READ_IOUT(0x8C) register value
+	 * multiply by iout_scale.
+	 * Obtain iout_scale from the register MFR_SVI3_IOUT_PRT[2:0].
+	 * The value is selected as below:
+	 * 000b - 1A/LSB, 001b - (1/32)A/LSB, 010b - (1/16)A/LSB,
+	 * 011b - (1/8)A/LSB, 100b - (1/4)A/LSB, 101b - (1/2)A/LSB
+	 * 110b - 1A/LSB, 111b - 2A/LSB
+	 */
+	switch (ret & GENMASK(2, 0)) {
+	case 0:
+	case 6:
+		data->iout_scale[page] = 32;
+		break;
+	case 1:
+		data->iout_scale[page] = 1;
+		break;
+	case 2:
+		data->iout_scale[page] = 2;
+		break;
+	case 3:
+		data->iout_scale[page] = 4;
+		break;
+	case 4:
+		data->iout_scale[page] = 8;
+		break;
+	case 5:
+		data->iout_scale[page] = 16;
+		break;
+	default:
+		data->iout_scale[page] = 64;
+		break;
+	}
+
+	return 0;
+}
+
+static int mp2891_identify(struct i2c_client *client, struct pmbus_driver_info *info)
+{
+	int ret;
+
+	/* Identify vout scale for rail 1. */
+	ret = mp2891_identify_vout_scale(client, info, 0);
+	if (ret < 0)
+		return ret;
+
+	/* Identify vout scale for rail 2. */
+	ret = mp2891_identify_vout_scale(client, info, 1);
+	if (ret < 0)
+		return ret;
+
+	/* Identify iout scale for rail 1. */
+	ret = mp2891_identify_iout_scale(client, info, 0);
+	if (ret < 0)
+		return ret;
+
+	/* Identify iout scale for rail 2. */
+	ret = mp2891_identify_iout_scale(client, info, 1);
+	if (ret < 0)
+		return ret;
+
+	return ret;
+}
+
+static int mp2891_read_byte_data(struct i2c_client *client, int page, int reg)
+{
+	int ret;
+
+	switch (reg) {
+	case PMBUS_VOUT_MODE:
+		/*
+		 * The MP2891 does not follow standard PMBus protocol completely, the
+		 * PMBUS_VOUT_MODE(0x20) in MP2891 is reserved and 0x00 is always be
+		 * returned when the register is read. But the calculation of vout in
+		 * this driver is based on direct format. As a result, the format of
+		 * vout is enforced to direct.
+		 */
+		ret = PB_VOUT_MODE_DIRECT;
+		break;
+	default:
+		ret = -ENODATA;
+		break;
+	}
+
+	return ret;
+}
+
+static int mp2891_read_word_data(struct i2c_client *client, int page,
+				 int phase, int reg)
+{
+	const struct pmbus_driver_info *info = pmbus_get_driver_info(client);
+	struct mp2891_data *data = to_mp2891_data(info);
+	int ret;
+
+	switch (reg) {
+	case PMBUS_READ_IIN:
+		/*
+		 * The MP2891 does not have standard PMBUS_READ_IIN register(0x89),
+		 * the iin telemetry can be obtained through the vender redefined
+		 * register READ_IIN_EST(0x95).
+		 */
+		ret = pmbus_read_word_data(client, page, phase, READ_IIN_EST);
+		break;
+	case PMBUS_READ_PIN:
+		/*
+		 * The MP2891 has standard PMBUS_READ_PIN register(0x97), but this
+		 * is not used to read the input power of per rail. The input power
+		 * of per rail is read through the vender redefined register
+		 * READ_PIN_EST(0x94).
+		 */
+		ret = pmbus_read_word_data(client, page, phase, READ_PIN_EST);
+		break;
+	case PMBUS_READ_VOUT:
+	case PMBUS_VOUT_UV_WARN_LIMIT:
+		ret = pmbus_read_word_data(client, page, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		ret = DIV_ROUND_CLOSEST(ret * data->vout_scale[page], MP2891_VOUT_SCALE_DIV);
+		break;
+	case PMBUS_READ_IOUT:
+		ret = pmbus_read_word_data(client, page, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		ret = DIV_ROUND_CLOSEST((ret & GENMASK(10, 0)) * data->iout_scale[page],
+								MP2891_IOUT_SCALE_DIV);
+		break;
+	case PMBUS_OT_FAULT_LIMIT:
+	case PMBUS_OT_WARN_LIMIT:
+		/*
+		 * The MP2891 PMBUS_OT_FAULT_LIMIT and PMBUS_OT_WARN_LIMIT are not
+		 * linear11 format, the scale is 1°C/LSB and they have 40°C offset.
+		 * As a result, the limit value is calculated to m°C first, then
+		 * it is converted to linear11 format.
+		 */
+		ret = pmbus_read_word_data(client, page, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		ret = mp2891_data2reg_linear11(((ret & GENMASK(7, 0)) -
+								MP2891_TEMP_LIMIT_OFFSET) * 1000);
+		break;
+	case PMBUS_VIN_UV_FAULT_LIMIT:
+	case PMBUS_VIN_UV_WARN_LIMIT:
+		/*
+		 * The MP2891 PMBUS_VIN_UV_FAULT_LIMIT and PMBUS_VIN_UV_WARN_LIMIT
+		 * are not linear11 format, the scale is 31.25mV/LSB. As a result,
+		 * the limit value is calculated to mV first, then it is converted
+		 * to linear11 format.
+		 */
+		ret = pmbus_read_word_data(client, page, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		ret = mp2891_data2reg_linear11(DIV_ROUND_CLOSEST((ret & GENMASK(9, 0)) * 3125,
+										100));
+		break;
+	case PMBUS_VIN_OV_FAULT_LIMIT:
+		/*
+		 * The MP2891 PMBUS_VIN_OV_FAULT_LIMIT are not linear11 format,
+		 * the scale is 125mV/LSB. As a result, the limit value is
+		 * calculated to mV first, then it is converted to linear11
+		 * format.
+		 */
+		ret = pmbus_read_word_data(client, page, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		ret = mp2891_data2reg_linear11((ret & GENMASK(7, 0)) * 125);
+		break;
+	case PMBUS_VOUT_UV_FAULT_LIMIT:
+		ret = pmbus_read_word_data(client, page, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		if (FIELD_GET(GENMASK(11, 8), ret))
+			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_UV_LIMIT_SCALE -
+				(FIELD_GET(GENMASK(11, 8), ret) + 1) * MP2891_OVUV_DELTA_SCALE;
+		else
+			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_UV_LIMIT_SCALE;
+
+		ret = ret < 0 ? 0 : ret;
+		break;
+	case PMBUS_VOUT_OV_FAULT_LIMIT:
+		ret = pmbus_read_word_data(client, page, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		if (FIELD_GET(GENMASK(11, 8), ret))
+			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_OV_LIMIT_SCALE +
+				(FIELD_GET(GENMASK(11, 8), ret) + 1) * MP2891_OVUV_DELTA_SCALE;
+		else
+			ret = FIELD_GET(GENMASK(7, 0), ret) * MP2891_OV_LIMIT_SCALE;
+		break;
+	case PMBUS_IOUT_OC_WARN_LIMIT:
+	case PMBUS_IOUT_OC_FAULT_LIMIT:
+		ret = pmbus_read_word_data(client, page, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		ret = DIV_ROUND_CLOSEST((ret & GENMASK(7, 0)) * data->iout_scale[page] *
+						MP2891_IOUT_LIMIT_UINT, MP2891_IOUT_SCALE_DIV);
+		break;
+	case PMBUS_IIN_OC_WARN_LIMIT:
+		/*
+		 * The MP2891 PMBUS_IIN_OC_WARN_LIMIT are not linear11 format, the
+		 * scale is 0.5V/LSB. As a result, the limit value is calculated to
+		 * mA first, then it is converted to linear11 format.
+		 */
+		ret = pmbus_read_word_data(client, 0, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		ret = mp2891_data2reg_linear11((ret & GENMASK(9, 0)) * 1000 / 2);
+		break;
+	case PMBUS_PIN_OP_WARN_LIMIT:
+		/*
+		 * The MP2891 PMBUS_PIN_OP_WARN_LIMIT are not linear11 format, the
+		 * scale is 2W/LSB. As a result, the limit value is calculated to
+		 * mW first, then it is converted to linear11 format.
+		 */
+		ret = pmbus_read_word_data(client, 0, phase, reg);
+		if (ret < 0)
+			return ret;
+
+		ret = mp2891_data2reg_linear11((ret & GENMASK(9, 0)) * MP2891_PIN_LIMIT_UINT *
+										1000);
+		break;
+	case PMBUS_READ_VIN:
+	case PMBUS_READ_POUT:
+	case PMBUS_READ_TEMPERATURE_1:
+		ret = -ENODATA;
+		break;
+	default:
+		ret = -EINVAL;
+		break;
+	}
+
+	return ret;
+}
+
+static struct pmbus_driver_info mp2891_info = {
+	.pages = MP2891_PAGE_NUM,
+	.format[PSC_VOLTAGE_IN] = linear,
+	.format[PSC_CURRENT_IN] = linear,
+	.format[PSC_CURRENT_OUT] = direct,
+	.format[PSC_TEMPERATURE] = linear,
+	.format[PSC_POWER] = linear,
+	.format[PSC_VOLTAGE_OUT] = direct,
+
+	.m[PSC_VOLTAGE_OUT] = 1,
+	.R[PSC_VOLTAGE_OUT] = 3,
+	.b[PSC_VOLTAGE_OUT] = 0,
+
+	.m[PSC_CURRENT_OUT] = 1,
+	.R[PSC_CURRENT_OUT] = 0,
+	.b[PSC_CURRENT_OUT] = 0,
+
+	.func[0] = MP2891_RAIL1_FUNC,
+	.func[1] = MP2891_RAIL2_FUNC,
+	.read_word_data = mp2891_read_word_data,
+	.read_byte_data = mp2891_read_byte_data,
+	.identify = mp2891_identify,
+};
+
+static int mp2891_probe(struct i2c_client *client)
+{
+	struct pmbus_driver_info *info;
+	struct mp2891_data *data;
+
+	data = devm_kzalloc(&client->dev, sizeof(struct mp2891_data), GFP_KERNEL);
+	if (!data)
+		return -ENOMEM;
+
+	memcpy(&data->info, &mp2891_info, sizeof(*info));
+	info = &data->info;
+
+	return pmbus_do_probe(client, info);
+}
+
+static const struct i2c_device_id mp2891_id[] = {
+	{"mp2891", 0},
+	{}
+};
+MODULE_DEVICE_TABLE(i2c, mp2891_id);
+
+static const struct of_device_id __maybe_unused mp2891_of_match[] = {
+	{.compatible = "mps,mp2891"},
+	{}
+};
+MODULE_DEVICE_TABLE(of, mp2891_of_match);
+
+static struct i2c_driver mp2891_driver = {
+	.driver = {
+		.name = "mp2891",
+		.of_match_table = mp2891_of_match,
+	},
+	.probe = mp2891_probe,
+	.id_table = mp2891_id,
+};
+
+module_i2c_driver(mp2891_driver);
+
+MODULE_AUTHOR("Noah Wang <noahwang.wang@outlook.com>");
+MODULE_DESCRIPTION("PMBus driver for MPS MP2891");
+MODULE_LICENSE("GPL");
+MODULE_IMPORT_NS(PMBUS);