drivers/hwmon/pmbus/lx1308.c

// SPDX-License-Identifier: GPL-2.0-or-later

#include <linux/err.h>
#include <linux/i2c.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include "pmbus.h"

#define LX1308_MFR_IOUT_OCP3_FAULT	0xBE
#define LX1308_MFR_IOUT_OCP3_WARN	0xBF

/*
 * Decode a Linear11-encoded word to an integer value.
 * Linear11 format: bits[15:11] = signed 5-bit exponent,
 * bits[10:0] = signed 11-bit mantissa. Result = mant * 2^exp.
 */
static inline int linear11_to_int(u16 word)
{
	s16 exp = ((s16)word) >> 11;
	s16 mant = ((s16)((word & 0x7ff) << 5)) >> 5;

	return (exp >= 0) ? (int)((u32)mant << exp) : (mant >> -exp);
}

static int lx1308_read_word_data(struct i2c_client *client, int page,
				 int phase, int reg)
{
	int ret;

	if (page > 0)
		return -ENXIO;

	switch (reg) {
	/*
	 * The LX1308 OCP3 registers (slow OCP, 60ms delay) use a
	 * manufacturer-specific U8.0 format. Read the byte value N and present
	 * it as a Linear11 word with exponent 0.
	 */
	case PMBUS_IOUT_OC_FAULT_LIMIT:
		ret = i2c_smbus_read_byte_data(client, LX1308_MFR_IOUT_OCP3_FAULT);
		if (ret < 0)
			break;
		ret &= 0x7FF;
		break;

	case PMBUS_IOUT_OC_WARN_LIMIT:
		ret = i2c_smbus_read_byte_data(client, LX1308_MFR_IOUT_OCP3_WARN);
		if (ret < 0)
			break;
		ret &= 0x7FF;
		break;

	/*
	 * The following registers are not implemented by the LX1308. Return
	 * -ENXIO to suppress the corresponding sysfs attributes.
	 */
	case PMBUS_IIN_OC_WARN_LIMIT:
	case PMBUS_IIN_OC_FAULT_LIMIT:
	case PMBUS_IOUT_UC_FAULT_LIMIT:
	case PMBUS_PIN_OP_WARN_LIMIT:
	case PMBUS_POUT_OP_WARN_LIMIT:
	case PMBUS_UT_WARN_LIMIT:
	case PMBUS_UT_FAULT_LIMIT:
	case PMBUS_MFR_IIN_MAX:
	case PMBUS_MFR_IOUT_MAX:
	case PMBUS_MFR_VIN_MIN:
	case PMBUS_MFR_VIN_MAX:
	case PMBUS_MFR_VOUT_MIN:
	case PMBUS_MFR_VOUT_MAX:
	case PMBUS_MFR_PIN_MAX:
	case PMBUS_MFR_POUT_MAX:
	case PMBUS_MFR_MAX_TEMP_1:
		ret = -ENXIO;
		break;

	default:
		ret = -ENODATA;
		break;
	}

	return ret;
}

static int lx1308_write_word_data(struct i2c_client *client, int page,
				  int reg, u16 word)
{
	int ret;

	if (page > 0)
		return -ENXIO;

	switch (reg) {
	case PMBUS_IOUT_OC_FAULT_LIMIT:
		/*
		 * Decode Linear11 word from pmbus_core back to a plain integer
		 * and write as the U8.0 byte the device expects.
		 */
		ret = i2c_smbus_write_byte_data(client, LX1308_MFR_IOUT_OCP3_FAULT,
						clamp_val(linear11_to_int(word), 0, 255));
		break;

	case PMBUS_IOUT_OC_WARN_LIMIT:
		ret = i2c_smbus_write_byte_data(client, LX1308_MFR_IOUT_OCP3_WARN,
						clamp_val(linear11_to_int(word), 0, 255));
		break;

	default:
		ret = -ENODATA;
		break;
	}

	return ret;
}

static struct pmbus_driver_info lx1308_info = {
	.pages = 1,
	.format[PSC_VOLTAGE_IN] = linear,
	.format[PSC_VOLTAGE_OUT] = linear,
	.format[PSC_CURRENT_IN] = linear,
	.format[PSC_CURRENT_OUT] = linear,
	.format[PSC_POWER] = linear,
	.format[PSC_TEMPERATURE] = linear,

	.func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT
		| PMBUS_HAVE_IIN | PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT
		| PMBUS_HAVE_PIN | PMBUS_HAVE_POUT
		| PMBUS_HAVE_TEMP | PMBUS_HAVE_STATUS_TEMP
		| PMBUS_HAVE_STATUS_INPUT,

	.read_word_data  = lx1308_read_word_data,
	.write_word_data = lx1308_write_word_data,
};

static const struct of_device_id lx1308_of_match[] = {
	{ .compatible = "luxshare,lx1308" },
	{ }
};

MODULE_DEVICE_TABLE(of, lx1308_of_match);

static const struct i2c_device_id lx1308_id[] = {
	{ "lx1308" },
	{ }
};

MODULE_DEVICE_TABLE(i2c, lx1308_id);

static int lx1308_probe(struct i2c_client *client)
{
	u8 buf[I2C_SMBUS_BLOCK_MAX + 1];
	const struct i2c_device_id *mid;
	int ret;

	ret = i2c_smbus_read_block_data(client, PMBUS_MFR_ID, buf);
	if (ret < 0)
		return dev_err_probe(&client->dev, ret,
				     "Failed to read manufacturer id\n");
	buf[ret] = '\0';

	if (ret != 12 || strncmp(buf, "LUXSHARE", 8))
		return dev_err_probe(&client->dev, -ENODEV,
				     "Unsupported Manufacturer ID '%s'\n", buf);

	ret = i2c_smbus_read_block_data(client, PMBUS_MFR_MODEL, buf);
	if (ret < 0)
		return dev_err_probe(&client->dev, ret,
				     "Failed to read Manufacturer Model\n");
	buf[ret] = '\0';

	for (mid = lx1308_id; mid->name[0]; mid++) {
		if (!strncasecmp(mid->name, buf, strlen(mid->name)))
			break;
	}
	if (!mid->name[0])
		return dev_err_probe(&client->dev, -ENODEV,
				     "Unsupported Manufacturer Model '%s'\n", buf);

	ret = i2c_smbus_read_block_data(client, PMBUS_MFR_REVISION, buf);
	if (ret < 0)
		return dev_err_probe(&client->dev, ret,
				     "Failed to read Manufacturer Revision\n");
	buf[ret] = '\0';

	if (ret != 12 || buf[0] != 'V')
		return dev_err_probe(&client->dev, -ENODEV,
				     "Unsupported Manufacturer Revision '%s'\n", buf);
	return pmbus_do_probe(client, &lx1308_info);
}

static struct i2c_driver lx1308_driver = {
	.driver = {
		.name = "lx1308",
		.of_match_table = lx1308_of_match,
	},
	.probe = lx1308_probe,
	.id_table = lx1308_id,
};

module_i2c_driver(lx1308_driver);

MODULE_AUTHOR("Brian Chiang <chiang.brian@inventec.com>");
MODULE_DESCRIPTION("PMBus driver for Luxshare LX1308");
MODULE_LICENSE("GPL");
MODULE_IMPORT_NS("PMBUS");