mirror of https://gitee.com/openkylin/linux.git
769 lines
19 KiB
C
769 lines
19 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
||
/*
|
||
* Hardware monitoring driver for MPS Multi-phase Digital VR Controllers
|
||
*
|
||
* Copyright (C) 2020 Nvidia Technologies Ltd.
|
||
*/
|
||
|
||
#include <linux/err.h>
|
||
#include <linux/i2c.h>
|
||
#include <linux/init.h>
|
||
#include <linux/kernel.h>
|
||
#include <linux/module.h>
|
||
#include "pmbus.h"
|
||
|
||
/* Vendor specific registers. */
|
||
#define MP2975_MFR_APS_HYS_R2 0x0d
|
||
#define MP2975_MFR_SLOPE_TRIM3 0x1d
|
||
#define MP2975_MFR_VR_MULTI_CONFIG_R1 0x0d
|
||
#define MP2975_MFR_VR_MULTI_CONFIG_R2 0x1d
|
||
#define MP2975_MFR_APS_DECAY_ADV 0x56
|
||
#define MP2975_MFR_DC_LOOP_CTRL 0x59
|
||
#define MP2975_MFR_OCP_UCP_PHASE_SET 0x65
|
||
#define MP2975_MFR_VR_CONFIG1 0x68
|
||
#define MP2975_MFR_READ_CS1_2 0x82
|
||
#define MP2975_MFR_READ_CS3_4 0x83
|
||
#define MP2975_MFR_READ_CS5_6 0x84
|
||
#define MP2975_MFR_READ_CS7_8 0x85
|
||
#define MP2975_MFR_READ_CS9_10 0x86
|
||
#define MP2975_MFR_READ_CS11_12 0x87
|
||
#define MP2975_MFR_READ_IOUT_PK 0x90
|
||
#define MP2975_MFR_READ_POUT_PK 0x91
|
||
#define MP2975_MFR_READ_VREF_R1 0xa1
|
||
#define MP2975_MFR_READ_VREF_R2 0xa3
|
||
#define MP2975_MFR_OVP_TH_SET 0xe5
|
||
#define MP2975_MFR_UVP_SET 0xe6
|
||
|
||
#define MP2975_VOUT_FORMAT BIT(15)
|
||
#define MP2975_VID_STEP_SEL_R1 BIT(4)
|
||
#define MP2975_IMVP9_EN_R1 BIT(13)
|
||
#define MP2975_VID_STEP_SEL_R2 BIT(3)
|
||
#define MP2975_IMVP9_EN_R2 BIT(12)
|
||
#define MP2975_PRT_THRES_DIV_OV_EN BIT(14)
|
||
#define MP2975_DRMOS_KCS GENMASK(13, 12)
|
||
#define MP2975_PROT_DEV_OV_OFF 10
|
||
#define MP2975_PROT_DEV_OV_ON 5
|
||
#define MP2975_SENSE_AMPL BIT(11)
|
||
#define MP2975_SENSE_AMPL_UNIT 1
|
||
#define MP2975_SENSE_AMPL_HALF 2
|
||
#define MP2975_VIN_UV_LIMIT_UNIT 8
|
||
|
||
#define MP2975_MAX_PHASE_RAIL1 8
|
||
#define MP2975_MAX_PHASE_RAIL2 4
|
||
#define MP2975_PAGE_NUM 2
|
||
|
||
#define MP2975_RAIL2_FUNC (PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT | \
|
||
PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT | \
|
||
PMBUS_PHASE_VIRTUAL)
|
||
|
||
struct mp2975_data {
|
||
struct pmbus_driver_info info;
|
||
int vout_scale;
|
||
int vid_step[MP2975_PAGE_NUM];
|
||
int vref[MP2975_PAGE_NUM];
|
||
int vref_off[MP2975_PAGE_NUM];
|
||
int vout_max[MP2975_PAGE_NUM];
|
||
int vout_ov_fixed[MP2975_PAGE_NUM];
|
||
int vout_format[MP2975_PAGE_NUM];
|
||
int curr_sense_gain[MP2975_PAGE_NUM];
|
||
};
|
||
|
||
#define to_mp2975_data(x) container_of(x, struct mp2975_data, info)
|
||
|
||
static int mp2975_read_byte_data(struct i2c_client *client, int page, int reg)
|
||
{
|
||
switch (reg) {
|
||
case PMBUS_VOUT_MODE:
|
||
/*
|
||
* Enforce VOUT direct format, since device allows to set the
|
||
* different formats for the different rails. Conversion from
|
||
* VID to direct provided by driver internally, in case it is
|
||
* necessary.
|
||
*/
|
||
return PB_VOUT_MODE_DIRECT;
|
||
default:
|
||
return -ENODATA;
|
||
}
|
||
}
|
||
|
||
static int
|
||
mp2975_read_word_helper(struct i2c_client *client, int page, int phase, u8 reg,
|
||
u16 mask)
|
||
{
|
||
int ret = pmbus_read_word_data(client, page, phase, reg);
|
||
|
||
return (ret > 0) ? ret & mask : ret;
|
||
}
|
||
|
||
static int
|
||
mp2975_vid2direct(int vrf, int val)
|
||
{
|
||
switch (vrf) {
|
||
case vr12:
|
||
if (val >= 0x01)
|
||
return 250 + (val - 1) * 5;
|
||
break;
|
||
case vr13:
|
||
if (val >= 0x01)
|
||
return 500 + (val - 1) * 10;
|
||
break;
|
||
case imvp9:
|
||
if (val >= 0x01)
|
||
return 200 + (val - 1) * 10;
|
||
break;
|
||
default:
|
||
return -EINVAL;
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
static int
|
||
mp2975_read_phase(struct i2c_client *client, struct mp2975_data *data,
|
||
int page, int phase, u8 reg)
|
||
{
|
||
int ph_curr, ret;
|
||
|
||
ret = pmbus_read_word_data(client, page, phase, reg);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
if (!((phase + 1) % MP2975_PAGE_NUM))
|
||
ret >>= 8;
|
||
ret &= 0xff;
|
||
|
||
/*
|
||
* Output value is calculated as: (READ_CSx / 80 – 1.23) / (Kcs * Rcs)
|
||
* where:
|
||
* - Kcs is the DrMOS current sense gain of power stage, which is
|
||
* obtained from the register MP2975_MFR_VR_CONFIG1, bits 13-12 with
|
||
* the following selection of DrMOS (data->curr_sense_gain[page]):
|
||
* 00b - 5µA/A, 01b - 8.5µA/A, 10b - 9.7µA/A, 11b - 10µA/A.
|
||
* - Rcs is the internal phase current sense resistor which is constant
|
||
* value 1kΩ.
|
||
*/
|
||
ph_curr = ret * 100 - 9800;
|
||
|
||
/*
|
||
* Current phase sensing, providing by the device is not accurate
|
||
* for the light load. This because sampling of current occurrence of
|
||
* bit weight has a big deviation for light load. For handling such
|
||
* case phase current is represented as the maximum between the value
|
||
* calculated above and total rail current divided by number phases.
|
||
*/
|
||
ret = pmbus_read_word_data(client, page, phase, PMBUS_READ_IOUT);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
return max_t(int, DIV_ROUND_CLOSEST(ret, data->info.phases[page]),
|
||
DIV_ROUND_CLOSEST(ph_curr, data->curr_sense_gain[page]));
|
||
}
|
||
|
||
static int
|
||
mp2975_read_phases(struct i2c_client *client, struct mp2975_data *data,
|
||
int page, int phase)
|
||
{
|
||
int ret;
|
||
|
||
if (page) {
|
||
switch (phase) {
|
||
case 0 ... 1:
|
||
ret = mp2975_read_phase(client, data, page, phase,
|
||
MP2975_MFR_READ_CS7_8);
|
||
break;
|
||
case 2 ... 3:
|
||
ret = mp2975_read_phase(client, data, page, phase,
|
||
MP2975_MFR_READ_CS9_10);
|
||
break;
|
||
case 4 ... 5:
|
||
ret = mp2975_read_phase(client, data, page, phase,
|
||
MP2975_MFR_READ_CS11_12);
|
||
break;
|
||
default:
|
||
return -ENODATA;
|
||
}
|
||
} else {
|
||
switch (phase) {
|
||
case 0 ... 1:
|
||
ret = mp2975_read_phase(client, data, page, phase,
|
||
MP2975_MFR_READ_CS1_2);
|
||
break;
|
||
case 2 ... 3:
|
||
ret = mp2975_read_phase(client, data, page, phase,
|
||
MP2975_MFR_READ_CS3_4);
|
||
break;
|
||
case 4 ... 5:
|
||
ret = mp2975_read_phase(client, data, page, phase,
|
||
MP2975_MFR_READ_CS5_6);
|
||
break;
|
||
case 6 ... 7:
|
||
ret = mp2975_read_phase(client, data, page, phase,
|
||
MP2975_MFR_READ_CS7_8);
|
||
break;
|
||
case 8 ... 9:
|
||
ret = mp2975_read_phase(client, data, page, phase,
|
||
MP2975_MFR_READ_CS9_10);
|
||
break;
|
||
case 10 ... 11:
|
||
ret = mp2975_read_phase(client, data, page, phase,
|
||
MP2975_MFR_READ_CS11_12);
|
||
break;
|
||
default:
|
||
return -ENODATA;
|
||
}
|
||
}
|
||
return ret;
|
||
}
|
||
|
||
static int mp2975_read_word_data(struct i2c_client *client, int page,
|
||
int phase, int reg)
|
||
{
|
||
const struct pmbus_driver_info *info = pmbus_get_driver_info(client);
|
||
struct mp2975_data *data = to_mp2975_data(info);
|
||
int ret;
|
||
|
||
switch (reg) {
|
||
case PMBUS_OT_FAULT_LIMIT:
|
||
ret = mp2975_read_word_helper(client, page, phase, reg,
|
||
GENMASK(7, 0));
|
||
break;
|
||
case PMBUS_VIN_OV_FAULT_LIMIT:
|
||
ret = mp2975_read_word_helper(client, page, phase, reg,
|
||
GENMASK(7, 0));
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
ret = DIV_ROUND_CLOSEST(ret, MP2975_VIN_UV_LIMIT_UNIT);
|
||
break;
|
||
case PMBUS_VOUT_OV_FAULT_LIMIT:
|
||
/*
|
||
* Register provides two values for over-voltage protection
|
||
* threshold for fixed (ovp2) and tracking (ovp1) modes. The
|
||
* minimum of these two values is provided as over-voltage
|
||
* fault alarm.
|
||
*/
|
||
ret = mp2975_read_word_helper(client, page, phase,
|
||
MP2975_MFR_OVP_TH_SET,
|
||
GENMASK(2, 0));
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
ret = min_t(int, data->vout_max[page] + 50 * (ret + 1),
|
||
data->vout_ov_fixed[page]);
|
||
break;
|
||
case PMBUS_VOUT_UV_FAULT_LIMIT:
|
||
ret = mp2975_read_word_helper(client, page, phase,
|
||
MP2975_MFR_UVP_SET,
|
||
GENMASK(2, 0));
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
ret = DIV_ROUND_CLOSEST(data->vref[page] * 10 - 50 *
|
||
(ret + 1) * data->vout_scale, 10);
|
||
break;
|
||
case PMBUS_READ_VOUT:
|
||
ret = mp2975_read_word_helper(client, page, phase, reg,
|
||
GENMASK(11, 0));
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/*
|
||
* READ_VOUT can be provided in VID or direct format. The
|
||
* format type is specified by bit 15 of the register
|
||
* MP2975_MFR_DC_LOOP_CTRL. The driver enforces VOUT direct
|
||
* format, since device allows to set the different formats for
|
||
* the different rails and also all VOUT limits registers are
|
||
* provided in a direct format. In case format is VID - convert
|
||
* to direct.
|
||
*/
|
||
if (data->vout_format[page] == vid)
|
||
ret = mp2975_vid2direct(info->vrm_version[page], ret);
|
||
break;
|
||
case PMBUS_VIRT_READ_POUT_MAX:
|
||
ret = mp2975_read_word_helper(client, page, phase,
|
||
MP2975_MFR_READ_POUT_PK,
|
||
GENMASK(12, 0));
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
ret = DIV_ROUND_CLOSEST(ret, 4);
|
||
break;
|
||
case PMBUS_VIRT_READ_IOUT_MAX:
|
||
ret = mp2975_read_word_helper(client, page, phase,
|
||
MP2975_MFR_READ_IOUT_PK,
|
||
GENMASK(12, 0));
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
ret = DIV_ROUND_CLOSEST(ret, 4);
|
||
break;
|
||
case PMBUS_READ_IOUT:
|
||
ret = mp2975_read_phases(client, data, page, phase);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
break;
|
||
case PMBUS_UT_WARN_LIMIT:
|
||
case PMBUS_UT_FAULT_LIMIT:
|
||
case PMBUS_VIN_UV_WARN_LIMIT:
|
||
case PMBUS_VIN_UV_FAULT_LIMIT:
|
||
case PMBUS_VOUT_UV_WARN_LIMIT:
|
||
case PMBUS_VOUT_OV_WARN_LIMIT:
|
||
case PMBUS_VIN_OV_WARN_LIMIT:
|
||
case PMBUS_IIN_OC_FAULT_LIMIT:
|
||
case PMBUS_IOUT_OC_LV_FAULT_LIMIT:
|
||
case PMBUS_IIN_OC_WARN_LIMIT:
|
||
case PMBUS_IOUT_OC_WARN_LIMIT:
|
||
case PMBUS_IOUT_OC_FAULT_LIMIT:
|
||
case PMBUS_IOUT_UC_FAULT_LIMIT:
|
||
case PMBUS_POUT_OP_FAULT_LIMIT:
|
||
case PMBUS_POUT_OP_WARN_LIMIT:
|
||
case PMBUS_PIN_OP_WARN_LIMIT:
|
||
return -ENXIO;
|
||
default:
|
||
return -ENODATA;
|
||
}
|
||
|
||
return ret;
|
||
}
|
||
|
||
static int mp2975_identify_multiphase_rail2(struct i2c_client *client)
|
||
{
|
||
int ret;
|
||
|
||
/*
|
||
* Identify multiphase for rail 2 - could be from 0 to 4.
|
||
* In case phase number is zero – only page zero is supported
|
||
*/
|
||
ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, 2);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/* Identify multiphase for rail 2 - could be from 0 to 4. */
|
||
ret = i2c_smbus_read_word_data(client, MP2975_MFR_VR_MULTI_CONFIG_R2);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
ret &= GENMASK(2, 0);
|
||
return (ret >= 4) ? 4 : ret;
|
||
}
|
||
|
||
static void mp2975_set_phase_rail1(struct pmbus_driver_info *info)
|
||
{
|
||
int i;
|
||
|
||
for (i = 0 ; i < info->phases[0]; i++)
|
||
info->pfunc[i] = PMBUS_HAVE_IOUT;
|
||
}
|
||
|
||
static void
|
||
mp2975_set_phase_rail2(struct pmbus_driver_info *info, int num_phases)
|
||
{
|
||
int i;
|
||
|
||
/* Set phases for rail 2 from upper to lower. */
|
||
for (i = 1; i <= num_phases; i++)
|
||
info->pfunc[MP2975_MAX_PHASE_RAIL1 - i] = PMBUS_HAVE_IOUT;
|
||
}
|
||
|
||
static int
|
||
mp2975_identify_multiphase(struct i2c_client *client, struct mp2975_data *data,
|
||
struct pmbus_driver_info *info)
|
||
{
|
||
int num_phases2, ret;
|
||
|
||
ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, 2);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/* Identify multiphase for rail 1 - could be from 1 to 8. */
|
||
ret = i2c_smbus_read_word_data(client, MP2975_MFR_VR_MULTI_CONFIG_R1);
|
||
if (ret <= 0)
|
||
return ret;
|
||
|
||
info->phases[0] = ret & GENMASK(3, 0);
|
||
|
||
/*
|
||
* The device provides a total of 8 PWM pins, and can be configured
|
||
* to different phase count applications for rail 1 and rail 2.
|
||
* Rail 1 can be set to 8 phases, while rail 2 can only be set to 4
|
||
* phases at most. When rail 1’s phase count is configured as 0, rail
|
||
* 1 operates with 1-phase DCM. When rail 2 phase count is configured
|
||
* as 0, rail 2 is disabled.
|
||
*/
|
||
if (info->phases[0] > MP2975_MAX_PHASE_RAIL1)
|
||
return -EINVAL;
|
||
|
||
mp2975_set_phase_rail1(info);
|
||
num_phases2 = min(MP2975_MAX_PHASE_RAIL1 - info->phases[0],
|
||
MP2975_MAX_PHASE_RAIL2);
|
||
if (info->phases[1] && info->phases[1] <= num_phases2)
|
||
mp2975_set_phase_rail2(info, num_phases2);
|
||
|
||
return 0;
|
||
}
|
||
|
||
static int
|
||
mp2975_identify_vid(struct i2c_client *client, struct mp2975_data *data,
|
||
struct pmbus_driver_info *info, u32 reg, int page,
|
||
u32 imvp_bit, u32 vr_bit)
|
||
{
|
||
int ret;
|
||
|
||
/* Identify VID mode and step selection. */
|
||
ret = i2c_smbus_read_word_data(client, reg);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
if (ret & imvp_bit) {
|
||
info->vrm_version[page] = imvp9;
|
||
data->vid_step[page] = MP2975_PROT_DEV_OV_OFF;
|
||
} else if (ret & vr_bit) {
|
||
info->vrm_version[page] = vr12;
|
||
data->vid_step[page] = MP2975_PROT_DEV_OV_ON;
|
||
} else {
|
||
info->vrm_version[page] = vr13;
|
||
data->vid_step[page] = MP2975_PROT_DEV_OV_OFF;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
static int
|
||
mp2975_identify_rails_vid(struct i2c_client *client, struct mp2975_data *data,
|
||
struct pmbus_driver_info *info)
|
||
{
|
||
int ret;
|
||
|
||
ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, 2);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/* Identify VID mode for rail 1. */
|
||
ret = mp2975_identify_vid(client, data, info,
|
||
MP2975_MFR_VR_MULTI_CONFIG_R1, 0,
|
||
MP2975_IMVP9_EN_R1, MP2975_VID_STEP_SEL_R1);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/* Identify VID mode for rail 2, if connected. */
|
||
if (info->phases[1])
|
||
ret = mp2975_identify_vid(client, data, info,
|
||
MP2975_MFR_VR_MULTI_CONFIG_R2, 1,
|
||
MP2975_IMVP9_EN_R2,
|
||
MP2975_VID_STEP_SEL_R2);
|
||
return ret;
|
||
}
|
||
|
||
static int
|
||
mp2975_current_sense_gain_get(struct i2c_client *client,
|
||
struct mp2975_data *data)
|
||
{
|
||
int i, ret;
|
||
|
||
/*
|
||
* Obtain DrMOS current sense gain of power stage from the register
|
||
* MP2975_MFR_VR_CONFIG1, bits 13-12. The value is selected as below:
|
||
* 00b - 5µA/A, 01b - 8.5µA/A, 10b - 9.7µA/A, 11b - 10µA/A. Other
|
||
* values are invalid.
|
||
*/
|
||
for (i = 0 ; i < data->info.pages; i++) {
|
||
ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, i);
|
||
if (ret < 0)
|
||
return ret;
|
||
ret = i2c_smbus_read_word_data(client,
|
||
MP2975_MFR_VR_CONFIG1);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
switch ((ret & MP2975_DRMOS_KCS) >> 12) {
|
||
case 0:
|
||
data->curr_sense_gain[i] = 50;
|
||
break;
|
||
case 1:
|
||
data->curr_sense_gain[i] = 85;
|
||
break;
|
||
case 2:
|
||
data->curr_sense_gain[i] = 97;
|
||
break;
|
||
default:
|
||
data->curr_sense_gain[i] = 100;
|
||
break;
|
||
}
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
static int
|
||
mp2975_vref_get(struct i2c_client *client, struct mp2975_data *data,
|
||
struct pmbus_driver_info *info)
|
||
{
|
||
int ret;
|
||
|
||
ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, 3);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/* Get voltage reference value for rail 1. */
|
||
ret = i2c_smbus_read_word_data(client, MP2975_MFR_READ_VREF_R1);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
data->vref[0] = ret * data->vid_step[0];
|
||
|
||
/* Get voltage reference value for rail 2, if connected. */
|
||
if (data->info.pages == MP2975_PAGE_NUM) {
|
||
ret = i2c_smbus_read_word_data(client, MP2975_MFR_READ_VREF_R2);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
data->vref[1] = ret * data->vid_step[1];
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
static int
|
||
mp2975_vref_offset_get(struct i2c_client *client, struct mp2975_data *data,
|
||
int page)
|
||
{
|
||
int ret;
|
||
|
||
ret = i2c_smbus_read_word_data(client, MP2975_MFR_OVP_TH_SET);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
switch ((ret & GENMASK(5, 3)) >> 3) {
|
||
case 1:
|
||
data->vref_off[page] = 140;
|
||
break;
|
||
case 2:
|
||
data->vref_off[page] = 220;
|
||
break;
|
||
case 4:
|
||
data->vref_off[page] = 400;
|
||
break;
|
||
default:
|
||
return -EINVAL;
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
static int
|
||
mp2975_vout_max_get(struct i2c_client *client, struct mp2975_data *data,
|
||
struct pmbus_driver_info *info, int page)
|
||
{
|
||
int ret;
|
||
|
||
/* Get maximum reference voltage of VID-DAC in VID format. */
|
||
ret = i2c_smbus_read_word_data(client, PMBUS_VOUT_MAX);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
data->vout_max[page] = mp2975_vid2direct(info->vrm_version[page], ret &
|
||
GENMASK(8, 0));
|
||
return 0;
|
||
}
|
||
|
||
static int
|
||
mp2975_identify_vout_format(struct i2c_client *client,
|
||
struct mp2975_data *data, int page)
|
||
{
|
||
int ret;
|
||
|
||
ret = i2c_smbus_read_word_data(client, MP2975_MFR_DC_LOOP_CTRL);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
if (ret & MP2975_VOUT_FORMAT)
|
||
data->vout_format[page] = vid;
|
||
else
|
||
data->vout_format[page] = direct;
|
||
return 0;
|
||
}
|
||
|
||
static int
|
||
mp2975_vout_ov_scale_get(struct i2c_client *client, struct mp2975_data *data,
|
||
struct pmbus_driver_info *info)
|
||
{
|
||
int thres_dev, sense_ampl, ret;
|
||
|
||
ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, 0);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/*
|
||
* Get divider for over- and under-voltage protection thresholds
|
||
* configuration from the Advanced Options of Auto Phase Shedding and
|
||
* decay register.
|
||
*/
|
||
ret = i2c_smbus_read_word_data(client, MP2975_MFR_APS_DECAY_ADV);
|
||
if (ret < 0)
|
||
return ret;
|
||
thres_dev = ret & MP2975_PRT_THRES_DIV_OV_EN ? MP2975_PROT_DEV_OV_ON :
|
||
MP2975_PROT_DEV_OV_OFF;
|
||
|
||
/* Select the gain of remote sense amplifier. */
|
||
ret = i2c_smbus_read_word_data(client, PMBUS_VOUT_SCALE_LOOP);
|
||
if (ret < 0)
|
||
return ret;
|
||
sense_ampl = ret & MP2975_SENSE_AMPL ? MP2975_SENSE_AMPL_HALF :
|
||
MP2975_SENSE_AMPL_UNIT;
|
||
|
||
data->vout_scale = sense_ampl * thres_dev;
|
||
|
||
return 0;
|
||
}
|
||
|
||
static int
|
||
mp2975_vout_per_rail_config_get(struct i2c_client *client,
|
||
struct mp2975_data *data,
|
||
struct pmbus_driver_info *info)
|
||
{
|
||
int i, ret;
|
||
|
||
for (i = 0; i < data->info.pages; i++) {
|
||
ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, i);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/* Obtain voltage reference offsets. */
|
||
ret = mp2975_vref_offset_get(client, data, i);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/* Obtain maximum voltage values. */
|
||
ret = mp2975_vout_max_get(client, data, info, i);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/*
|
||
* Get VOUT format for READ_VOUT command : VID or direct.
|
||
* Pages on same device can be configured with different
|
||
* formats.
|
||
*/
|
||
ret = mp2975_identify_vout_format(client, data, i);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/*
|
||
* Set over-voltage fixed value. Thresholds are provided as
|
||
* fixed value, and tracking value. The minimum of them are
|
||
* exposed as over-voltage critical threshold.
|
||
*/
|
||
data->vout_ov_fixed[i] = data->vref[i] +
|
||
DIV_ROUND_CLOSEST(data->vref_off[i] *
|
||
data->vout_scale,
|
||
10);
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
static struct pmbus_driver_info mp2975_info = {
|
||
.pages = 1,
|
||
.format[PSC_VOLTAGE_IN] = linear,
|
||
.format[PSC_VOLTAGE_OUT] = direct,
|
||
.format[PSC_TEMPERATURE] = direct,
|
||
.format[PSC_CURRENT_IN] = linear,
|
||
.format[PSC_CURRENT_OUT] = direct,
|
||
.format[PSC_POWER] = direct,
|
||
.m[PSC_TEMPERATURE] = 1,
|
||
.m[PSC_VOLTAGE_OUT] = 1,
|
||
.R[PSC_VOLTAGE_OUT] = 3,
|
||
.m[PSC_CURRENT_OUT] = 1,
|
||
.m[PSC_POWER] = 1,
|
||
.func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
|
||
PMBUS_HAVE_IIN | PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
|
||
PMBUS_HAVE_TEMP | PMBUS_HAVE_STATUS_TEMP | PMBUS_HAVE_POUT |
|
||
PMBUS_HAVE_PIN | PMBUS_HAVE_STATUS_INPUT | PMBUS_PHASE_VIRTUAL,
|
||
.read_byte_data = mp2975_read_byte_data,
|
||
.read_word_data = mp2975_read_word_data,
|
||
};
|
||
|
||
static int mp2975_probe(struct i2c_client *client)
|
||
{
|
||
struct pmbus_driver_info *info;
|
||
struct mp2975_data *data;
|
||
int ret;
|
||
|
||
data = devm_kzalloc(&client->dev, sizeof(struct mp2975_data),
|
||
GFP_KERNEL);
|
||
if (!data)
|
||
return -ENOMEM;
|
||
|
||
memcpy(&data->info, &mp2975_info, sizeof(*info));
|
||
info = &data->info;
|
||
|
||
/* Identify multiphase configuration for rail 2. */
|
||
ret = mp2975_identify_multiphase_rail2(client);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
if (ret) {
|
||
/* Two rails are connected. */
|
||
data->info.pages = MP2975_PAGE_NUM;
|
||
data->info.phases[1] = ret;
|
||
data->info.func[1] = MP2975_RAIL2_FUNC;
|
||
}
|
||
|
||
/* Identify multiphase configuration. */
|
||
ret = mp2975_identify_multiphase(client, data, info);
|
||
if (ret)
|
||
return ret;
|
||
|
||
/* Identify VID setting per rail. */
|
||
ret = mp2975_identify_rails_vid(client, data, info);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/* Obtain current sense gain of power stage. */
|
||
ret = mp2975_current_sense_gain_get(client, data);
|
||
if (ret)
|
||
return ret;
|
||
|
||
/* Obtain voltage reference values. */
|
||
ret = mp2975_vref_get(client, data, info);
|
||
if (ret)
|
||
return ret;
|
||
|
||
/* Obtain vout over-voltage scales. */
|
||
ret = mp2975_vout_ov_scale_get(client, data, info);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
/* Obtain offsets, maximum and format for vout. */
|
||
ret = mp2975_vout_per_rail_config_get(client, data, info);
|
||
if (ret)
|
||
return ret;
|
||
|
||
return pmbus_do_probe(client, info);
|
||
}
|
||
|
||
static const struct i2c_device_id mp2975_id[] = {
|
||
{"mp2975", 0},
|
||
{}
|
||
};
|
||
|
||
MODULE_DEVICE_TABLE(i2c, mp2975_id);
|
||
|
||
static const struct of_device_id __maybe_unused mp2975_of_match[] = {
|
||
{.compatible = "mps,mp2975"},
|
||
{}
|
||
};
|
||
MODULE_DEVICE_TABLE(of, mp2975_of_match);
|
||
|
||
static struct i2c_driver mp2975_driver = {
|
||
.driver = {
|
||
.name = "mp2975",
|
||
.of_match_table = of_match_ptr(mp2975_of_match),
|
||
},
|
||
.probe_new = mp2975_probe,
|
||
.id_table = mp2975_id,
|
||
};
|
||
|
||
module_i2c_driver(mp2975_driver);
|
||
|
||
MODULE_AUTHOR("Vadim Pasternak <vadimp@nvidia.com>");
|
||
MODULE_DESCRIPTION("PMBus driver for MPS MP2975 device");
|
||
MODULE_LICENSE("GPL");
|