162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Hardware monitoring driver for Infineon Multi-phase Digital VR Controllers
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (c) 2020 Mellanox Technologies. All rights reserved.
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/err.h>
962306a36Sopenharmony_ci#include <linux/i2c.h>
1062306a36Sopenharmony_ci#include <linux/init.h>
1162306a36Sopenharmony_ci#include <linux/kernel.h>
1262306a36Sopenharmony_ci#include <linux/module.h>
1362306a36Sopenharmony_ci#include <linux/regulator/driver.h>
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#include "pmbus.h"
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#define XDPE122_PROT_VR12_5MV		0x01 /* VR12.0 mode, 5-mV DAC */
1862306a36Sopenharmony_ci#define XDPE122_PROT_VR12_5_10MV	0x02 /* VR12.5 mode, 10-mV DAC */
1962306a36Sopenharmony_ci#define XDPE122_PROT_IMVP9_10MV		0x03 /* IMVP9 mode, 10-mV DAC */
2062306a36Sopenharmony_ci#define XDPE122_AMD_625MV		0x10 /* AMD mode 6.25mV */
2162306a36Sopenharmony_ci#define XDPE122_PAGE_NUM		2
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_cistatic int xdpe122_read_word_data(struct i2c_client *client, int page,
2462306a36Sopenharmony_ci				  int phase, int reg)
2562306a36Sopenharmony_ci{
2662306a36Sopenharmony_ci	const struct pmbus_driver_info *info = pmbus_get_driver_info(client);
2762306a36Sopenharmony_ci	long val;
2862306a36Sopenharmony_ci	s16 exponent;
2962306a36Sopenharmony_ci	s32 mantissa;
3062306a36Sopenharmony_ci	int ret;
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ci	switch (reg) {
3362306a36Sopenharmony_ci	case PMBUS_VOUT_OV_FAULT_LIMIT:
3462306a36Sopenharmony_ci	case PMBUS_VOUT_UV_FAULT_LIMIT:
3562306a36Sopenharmony_ci		ret = pmbus_read_word_data(client, page, phase, reg);
3662306a36Sopenharmony_ci		if (ret < 0)
3762306a36Sopenharmony_ci			return ret;
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci		/* Convert register value to LINEAR11 data. */
4062306a36Sopenharmony_ci		exponent = ((s16)ret) >> 11;
4162306a36Sopenharmony_ci		mantissa = ((s16)((ret & GENMASK(10, 0)) << 5)) >> 5;
4262306a36Sopenharmony_ci		val = mantissa * 1000L;
4362306a36Sopenharmony_ci		if (exponent >= 0)
4462306a36Sopenharmony_ci			val <<= exponent;
4562306a36Sopenharmony_ci		else
4662306a36Sopenharmony_ci			val >>= -exponent;
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci		/* Convert data to VID register. */
4962306a36Sopenharmony_ci		switch (info->vrm_version[page]) {
5062306a36Sopenharmony_ci		case vr13:
5162306a36Sopenharmony_ci			if (val >= 500)
5262306a36Sopenharmony_ci				return 1 + DIV_ROUND_CLOSEST(val - 500, 10);
5362306a36Sopenharmony_ci			return 0;
5462306a36Sopenharmony_ci		case vr12:
5562306a36Sopenharmony_ci			if (val >= 250)
5662306a36Sopenharmony_ci				return 1 + DIV_ROUND_CLOSEST(val - 250, 5);
5762306a36Sopenharmony_ci			return 0;
5862306a36Sopenharmony_ci		case imvp9:
5962306a36Sopenharmony_ci			if (val >= 200)
6062306a36Sopenharmony_ci				return 1 + DIV_ROUND_CLOSEST(val - 200, 10);
6162306a36Sopenharmony_ci			return 0;
6262306a36Sopenharmony_ci		case amd625mv:
6362306a36Sopenharmony_ci			if (val >= 200 && val <= 1550)
6462306a36Sopenharmony_ci				return DIV_ROUND_CLOSEST((1550 - val) * 100,
6562306a36Sopenharmony_ci							 625);
6662306a36Sopenharmony_ci			return 0;
6762306a36Sopenharmony_ci		default:
6862306a36Sopenharmony_ci			return -EINVAL;
6962306a36Sopenharmony_ci		}
7062306a36Sopenharmony_ci	default:
7162306a36Sopenharmony_ci		return -ENODATA;
7262306a36Sopenharmony_ci	}
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_ci	return 0;
7562306a36Sopenharmony_ci}
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_cistatic int xdpe122_identify(struct i2c_client *client,
7862306a36Sopenharmony_ci			    struct pmbus_driver_info *info)
7962306a36Sopenharmony_ci{
8062306a36Sopenharmony_ci	u8 vout_params;
8162306a36Sopenharmony_ci	int i, ret, vout_mode;
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci	vout_mode = pmbus_read_byte_data(client, 0, PMBUS_VOUT_MODE);
8462306a36Sopenharmony_ci	if (vout_mode >= 0 && vout_mode != 0xff) {
8562306a36Sopenharmony_ci		switch (vout_mode >> 5) {
8662306a36Sopenharmony_ci		case 0:
8762306a36Sopenharmony_ci			info->format[PSC_VOLTAGE_OUT] = linear;
8862306a36Sopenharmony_ci			return 0;
8962306a36Sopenharmony_ci		case 1:
9062306a36Sopenharmony_ci			info->format[PSC_VOLTAGE_OUT] = vid;
9162306a36Sopenharmony_ci			info->read_word_data = xdpe122_read_word_data;
9262306a36Sopenharmony_ci			break;
9362306a36Sopenharmony_ci		default:
9462306a36Sopenharmony_ci			return -ENODEV;
9562306a36Sopenharmony_ci		}
9662306a36Sopenharmony_ci	}
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_ci	for (i = 0; i < XDPE122_PAGE_NUM; i++) {
9962306a36Sopenharmony_ci		/* Read the register with VOUT scaling value.*/
10062306a36Sopenharmony_ci		ret = pmbus_read_byte_data(client, i, PMBUS_VOUT_MODE);
10162306a36Sopenharmony_ci		if (ret < 0)
10262306a36Sopenharmony_ci			return ret;
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci		vout_params = ret & GENMASK(4, 0);
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ci		switch (vout_params) {
10762306a36Sopenharmony_ci		case XDPE122_PROT_VR12_5_10MV:
10862306a36Sopenharmony_ci			info->vrm_version[i] = vr13;
10962306a36Sopenharmony_ci			break;
11062306a36Sopenharmony_ci		case XDPE122_PROT_VR12_5MV:
11162306a36Sopenharmony_ci			info->vrm_version[i] = vr12;
11262306a36Sopenharmony_ci			break;
11362306a36Sopenharmony_ci		case XDPE122_PROT_IMVP9_10MV:
11462306a36Sopenharmony_ci			info->vrm_version[i] = imvp9;
11562306a36Sopenharmony_ci			break;
11662306a36Sopenharmony_ci		case XDPE122_AMD_625MV:
11762306a36Sopenharmony_ci			info->vrm_version[i] = amd625mv;
11862306a36Sopenharmony_ci			break;
11962306a36Sopenharmony_ci		default:
12062306a36Sopenharmony_ci			return -EINVAL;
12162306a36Sopenharmony_ci		}
12262306a36Sopenharmony_ci	}
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci	return 0;
12562306a36Sopenharmony_ci}
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_cistatic const struct regulator_desc __maybe_unused xdpe122_reg_desc[] = {
12862306a36Sopenharmony_ci	PMBUS_REGULATOR("vout", 0),
12962306a36Sopenharmony_ci	PMBUS_REGULATOR("vout", 1),
13062306a36Sopenharmony_ci};
13162306a36Sopenharmony_ci
13262306a36Sopenharmony_cistatic struct pmbus_driver_info xdpe122_info = {
13362306a36Sopenharmony_ci	.pages = XDPE122_PAGE_NUM,
13462306a36Sopenharmony_ci	.format[PSC_VOLTAGE_IN] = linear,
13562306a36Sopenharmony_ci	.format[PSC_TEMPERATURE] = linear,
13662306a36Sopenharmony_ci	.format[PSC_CURRENT_IN] = linear,
13762306a36Sopenharmony_ci	.format[PSC_CURRENT_OUT] = linear,
13862306a36Sopenharmony_ci	.format[PSC_POWER] = linear,
13962306a36Sopenharmony_ci	.func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
14062306a36Sopenharmony_ci		PMBUS_HAVE_IIN | PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
14162306a36Sopenharmony_ci		PMBUS_HAVE_TEMP | PMBUS_HAVE_STATUS_TEMP |
14262306a36Sopenharmony_ci		PMBUS_HAVE_POUT | PMBUS_HAVE_PIN | PMBUS_HAVE_STATUS_INPUT,
14362306a36Sopenharmony_ci	.func[1] = PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
14462306a36Sopenharmony_ci		PMBUS_HAVE_IIN | PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
14562306a36Sopenharmony_ci		PMBUS_HAVE_TEMP | PMBUS_HAVE_STATUS_TEMP |
14662306a36Sopenharmony_ci		PMBUS_HAVE_POUT | PMBUS_HAVE_PIN | PMBUS_HAVE_STATUS_INPUT,
14762306a36Sopenharmony_ci	.identify = xdpe122_identify,
14862306a36Sopenharmony_ci#if IS_ENABLED(CONFIG_SENSORS_XDPE122_REGULATOR)
14962306a36Sopenharmony_ci	.num_regulators = 2,
15062306a36Sopenharmony_ci	.reg_desc = xdpe122_reg_desc,
15162306a36Sopenharmony_ci#endif
15262306a36Sopenharmony_ci};
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_cistatic int xdpe122_probe(struct i2c_client *client)
15562306a36Sopenharmony_ci{
15662306a36Sopenharmony_ci	struct pmbus_driver_info *info;
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci	info = devm_kmemdup(&client->dev, &xdpe122_info, sizeof(*info),
15962306a36Sopenharmony_ci			    GFP_KERNEL);
16062306a36Sopenharmony_ci	if (!info)
16162306a36Sopenharmony_ci		return -ENOMEM;
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci	return pmbus_do_probe(client, info);
16462306a36Sopenharmony_ci}
16562306a36Sopenharmony_ci
16662306a36Sopenharmony_cistatic const struct i2c_device_id xdpe122_id[] = {
16762306a36Sopenharmony_ci	{"xdpe11280", 0},
16862306a36Sopenharmony_ci	{"xdpe12254", 0},
16962306a36Sopenharmony_ci	{"xdpe12284", 0},
17062306a36Sopenharmony_ci	{}
17162306a36Sopenharmony_ci};
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, xdpe122_id);
17462306a36Sopenharmony_ci
17562306a36Sopenharmony_cistatic const struct of_device_id __maybe_unused xdpe122_of_match[] = {
17662306a36Sopenharmony_ci	{.compatible = "infineon,xdpe11280"},
17762306a36Sopenharmony_ci	{.compatible = "infineon,xdpe12254"},
17862306a36Sopenharmony_ci	{.compatible = "infineon,xdpe12284"},
17962306a36Sopenharmony_ci	{}
18062306a36Sopenharmony_ci};
18162306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, xdpe122_of_match);
18262306a36Sopenharmony_ci
18362306a36Sopenharmony_cistatic struct i2c_driver xdpe122_driver = {
18462306a36Sopenharmony_ci	.driver = {
18562306a36Sopenharmony_ci		.name = "xdpe12284",
18662306a36Sopenharmony_ci		.of_match_table = of_match_ptr(xdpe122_of_match),
18762306a36Sopenharmony_ci	},
18862306a36Sopenharmony_ci	.probe = xdpe122_probe,
18962306a36Sopenharmony_ci	.id_table = xdpe122_id,
19062306a36Sopenharmony_ci};
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_cimodule_i2c_driver(xdpe122_driver);
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ciMODULE_AUTHOR("Vadim Pasternak <vadimp@mellanox.com>");
19562306a36Sopenharmony_ciMODULE_DESCRIPTION("PMBus driver for Infineon XDPE122 family");
19662306a36Sopenharmony_ciMODULE_LICENSE("GPL");
19762306a36Sopenharmony_ciMODULE_IMPORT_NS(PMBUS);
198