132 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Driver for Infineon XDP710 Hot-Swap Controller4 */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 0xD313#define XDP710_V_SNS_CFG 0xD414#define XDP710_CS_RNG 0xD515 16/*17 * The table to map configuration register values18 * to sense resistor values19 */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, 1000029};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);132