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