xdp710.c

  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * Driver for Infineon XDP710 Hot-Swap Controller
  4 */
  5
  6#include <linux/bitops.h>
  7#include <linux/i2c.h>
  8#include <linux/module.h>
  9#include <linux/of_device.h>
 10#include "pmbus.h"
 11
 12#define XDP710_REG_CFG		0xD3
 13#define XDP710_V_SNS_CFG	0xD4
 14#define XDP710_CS_RNG		0xD5
 15
 16/*
 17 * The table to map configuration register values
 18 * to sense resistor values
 19 */
 20static const int micro_ohm_rsense[] = {
 21	200, 250, 300, 330, 400, 470, 500, 600,
 22	670, 700, 750, 800, 900, 1000, 1100, 1200,
 23	1250, 1300, 1400, 1500, 1600, 1700, 1800, 1900,
 24	2000, 2100, 2200, 2300, 2400, 2500, 2600, 2700,
 25	2800, 3000, 3100, 3200, 3300, 3400, 3500, 3600,
 26	3700, 3800, 3900, 4000, 4100, 4200, 4300, 4400,
 27	4500, 4600, 4700, 4800, 4900, 5000, 5500, 6000,
 28	6500, 7000, 7500, 8000, 8500, 9000, 9500, 10000
 29};
 30
 31static struct pmbus_driver_info xdp710_info = {
 32	.pages = 1,
 33	.format[PSC_VOLTAGE_IN] = direct,
 34	.format[PSC_VOLTAGE_OUT] = direct,
 35	.format[PSC_CURRENT_OUT] = direct,
 36	.format[PSC_POWER] = direct,
 37	.format[PSC_TEMPERATURE] = direct,
 38	.m[PSC_VOLTAGE_IN] = 4653,
 39	.b[PSC_VOLTAGE_IN] = 0,
 40	.R[PSC_VOLTAGE_IN] = -2,
 41	.m[PSC_VOLTAGE_OUT] = 4653,
 42	.b[PSC_VOLTAGE_OUT] = 0,
 43	.R[PSC_VOLTAGE_OUT] = -2,
 44	.m[PSC_CURRENT_OUT] = 23165,
 45	.b[PSC_CURRENT_OUT] = 0,
 46	.R[PSC_CURRENT_OUT] = -2,
 47	.m[PSC_POWER] = 4211,
 48	.b[PSC_POWER] = 0,
 49	.R[PSC_POWER] = -2,
 50	.m[PSC_TEMPERATURE] = 52,
 51	.b[PSC_TEMPERATURE] = 14321,
 52	.R[PSC_TEMPERATURE] = -1,
 53	.func[0] =
 54		PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | PMBUS_HAVE_PIN |
 55		PMBUS_HAVE_TEMP | PMBUS_HAVE_IOUT |
 56		PMBUS_HAVE_STATUS_INPUT | PMBUS_HAVE_STATUS_TEMP,
 57};
 58
 59static int xdp710_probe(struct i2c_client *client)
 60{
 61	struct pmbus_driver_info *info;
 62	u8 cs_rng;
 63	u8 vtlm_rng;
 64	int rsense;
 65	int ret;
 66	int m = 0;
 67
 68	info = devm_kmemdup(&client->dev, &xdp710_info, sizeof(*info),
 69			    GFP_KERNEL);
 70	if (!info)
 71		return -ENOMEM;
 72
 73	ret = i2c_smbus_read_word_data(client, XDP710_CS_RNG);
 74	if (ret < 0) {
 75		dev_err(&client->dev, "Can't get CS_RNG");
 76		return ret;
 77	}
 78	cs_rng = (ret >> 6) & GENMASK(1, 0);
 79
 80	ret = i2c_smbus_read_word_data(client, XDP710_V_SNS_CFG);
 81	if (ret < 0) {
 82		dev_err(&client->dev, "Can't get V_SNS_CFG");
 83		return ret;
 84	}
 85	vtlm_rng = ret & GENMASK(1, 0);
 86
 87	ret = i2c_smbus_read_word_data(client, XDP710_REG_CFG);
 88	if (ret < 0) {
 89		dev_err(&client->dev, "Can't get REG_CFG");
 90		return ret;
 91	}
 92	ret &= GENMASK(5, 0);
 93	rsense = micro_ohm_rsense[ret];
 94
 95	info->m[PSC_VOLTAGE_IN] <<= vtlm_rng;
 96	info->m[PSC_VOLTAGE_OUT] <<= vtlm_rng;
 97
 98	m = info->m[PSC_CURRENT_OUT];
 99	info->m[PSC_CURRENT_OUT] = DIV_ROUND_CLOSEST(m * rsense >> cs_rng, 1000);
100
101	m = info->m[PSC_POWER];
102	info->m[PSC_POWER] = DIV_ROUND_CLOSEST(m * rsense >> cs_rng, 1000);
103
104	return pmbus_do_probe(client, info);
105}
106
107static const struct of_device_id xdp710_of_match[] = {
108	{ .compatible = "infineon,xdp710" },
109	{}
110};
111
112static const struct i2c_device_id xdp710_id[] = {
113	{"xdp710"},
114	{ }
115};
116MODULE_DEVICE_TABLE(i2c, xdp710_id);
117
118static struct i2c_driver xdp710_driver = {
119	.driver = {
120		   .name = "xdp710",
121		   .of_match_table = xdp710_of_match,
122	},
123	.probe = xdp710_probe,
124	.id_table = xdp710_id,
125};
126module_i2c_driver(xdp710_driver);
127
128MODULE_AUTHOR("Peter Yin <peter.yin@quantatw.com>");
129MODULE_DESCRIPTION("PMBus driver for XDP710 HSC");
130MODULE_LICENSE("GPL");
131MODULE_IMPORT_NS("PMBUS");