Received: by 2002:a05:6358:d09b:b0:dc:cd0c:909e with SMTP id jc27csp2042194rwb; Thu, 8 Dec 2022 19:23:45 -0800 (PST) X-Google-Smtp-Source: AA0mqf4jUA1aNU/2BMEQXr+TnJ42YSDihDwT4GR/SpfpgwNOW1ZsM5RDiZKXnQ/0jtrKFRJSD+P1 X-Received: by 2002:a17:906:4315:b0:7c0:bc68:757e with SMTP id j21-20020a170906431500b007c0bc68757emr3856520ejm.39.1670556225156; Thu, 08 Dec 2022 19:23:45 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1670556225; cv=none; d=google.com; s=arc-20160816; b=vySsetXJYaqUgRaX/SKuKlyF2TBcx0Ot+zLKNRyUGBVk2KpnD9MUJ8FGwnEceuDHom XeV2UKykXVQkwViKn2kOhYI1q22okuUQqpemo9Cv6HHVE/wt7XrV5PVibXq3H5KUXp6m yJ42a0ZJaZKlLu/UuoYjtq3G5d3F6qmkdKqPVtWuphI2FltcUYlrWQ/XzD1N+UM1d36e BOAXhYecftbRRcGKuc1BfVu3Yl6OvkQbgxOOFiQgjyMzt8iHEm4jIduQlhICMgiDLeqQ 94JpYkKniXXjqpnRvmMR1J824oXqR4S3Izb6lywNPY0tCL1ggsX/0whiE8GGvx6VO2Fz WuSw== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:mime-version :message-id:date:subject:to:from:dkim-signature; bh=tN+POyhJMO6HhyjBc1WcYL4uwjFwfR6bk3xEGD6H4aw=; b=rZpzhwRrPeRRK9CoHMTqqKtCZuop6cThVV13fyTx+NGN52DRkkgSe2HlLp2CgSJFD1 ayNVMzTZZTdBZmXZosa8E4L91kvcNQsg41fHzhT4o1ld8lOVflww0G/VbDR2GjRHfUzH LrgSrM6bjdsJaBZzR9zHOjHZcHXHtuQK0JEW207IyExmhsA9dVjYEJ9xSTH0RNpdkyJm TGHYSfStkcbbZLo8gYiJ+qpiV/KNMQfScURucSjeVpROZdpJyZtBrnh0yug7GCwVbI6r rPSntahph2DoeVPPaMQPpUlPnzst3RSuFof0T0/7fXtmX/Ip1o3AddtHtdMvPb7a2zmM gbBA== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@bytedance-com.20210112.gappssmtp.com header.s=20210112 header.b="CleY/UWp"; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=bytedance.com Return-Path: Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id hu8-20020a170907a08800b007c0a7b0c5b0si186978ejc.761.2022.12.08.19.23.27; Thu, 08 Dec 2022 19:23:45 -0800 (PST) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20; Authentication-Results: mx.google.com; dkim=pass header.i=@bytedance-com.20210112.gappssmtp.com header.s=20210112 header.b="CleY/UWp"; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=bytedance.com Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S229854AbiLICqe (ORCPT + 73 others); Thu, 8 Dec 2022 21:46:34 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:34668 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229470AbiLICqc (ORCPT ); Thu, 8 Dec 2022 21:46:32 -0500 Received: from mail-pl1-x632.google.com (mail-pl1-x632.google.com [IPv6:2607:f8b0:4864:20::632]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 9597C86F47 for ; Thu, 8 Dec 2022 18:46:31 -0800 (PST) Received: by mail-pl1-x632.google.com with SMTP id jl24so3463684plb.8 for ; Thu, 08 Dec 2022 18:46:31 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=bytedance-com.20210112.gappssmtp.com; s=20210112; h=content-transfer-encoding:mime-version:message-id:date:subject:to :from:from:to:cc:subject:date:message-id:reply-to; bh=tN+POyhJMO6HhyjBc1WcYL4uwjFwfR6bk3xEGD6H4aw=; b=CleY/UWpHPRz+smU+49qhxh6NYICheUyhsRm62Vzk/J1KpB6piI/kKQKjq4T7sksnZ SXFGl7RwX4Z5oY3i+nhUxq8dHTO18EIGMVo4h1gO64OZdCJcnc3Jc7om2icgRvAivDx3 yF/QQZiU/piKoJrUlglfT6MCESbjG/QIvVq3kPj8lPTwLyYoolcm16Kk/qtbKIKqs9P0 YbtaSJ/vDnESE5cHorZF8ao5/W3IpRdgpdJgTOrl5lE5/Ew7b6OA8KpPVGSylqD7d3Qw EhqFtI7ITmYTM8v6u0C9dvbnQ+Fj66H8DAI9P3mdRZj14Ny6ZWRmC47etV2mlEn+uOHl v7Tg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=content-transfer-encoding:mime-version:message-id:date:subject:to :from:x-gm-message-state:from:to:cc:subject:date:message-id:reply-to; bh=tN+POyhJMO6HhyjBc1WcYL4uwjFwfR6bk3xEGD6H4aw=; b=FHCuWq5IgY4pSE2ihWCPuumvxs1WHGroWXKIcGeF+89YNMgIl7FAW40lCRdZy/Navi G0QBmc5s5XbGHCosKCTN9D3hnQ3GsX2TtUTBo3DQb5BMhso9hZS56XaTEcMqI8h29QDq X39fRaDb9W7rhy3wsYhWPGyqMNy3fOWhonYsmC0CtHuyYIkD7pcc03S4lVAGWeEEwGVl GWFqxq8Dnbvq8hwEcch/xkrmGHDbpW799QbfbJYg9Jvt9XEvUJt4H6Yu1tZWSsXTV94n F38o73rVxYoz3afDcAe/PIKeGAOQRtUANTTiKF0TDs98bCQWqWKy7E5WGNdrsi33rmHf 8cww== X-Gm-Message-State: ANoB5pmR91LBVO1DwU9W7DA0loChHiMVCOuZ1zAfRwp3ZwAx9wn7YbRH Amr3LRx3gE/jIB7ErBSZOCje6zLRh+4YVU+d X-Received: by 2002:a17:902:e983:b0:189:6457:4e14 with SMTP id f3-20020a170902e98300b0018964574e14mr4543368plb.8.1670553990764; Thu, 08 Dec 2022 18:46:30 -0800 (PST) Received: from localhost ([49.7.199.2]) by smtp.gmail.com with ESMTPSA id jb1-20020a170903258100b00180033438a0sm140478plb.106.2022.12.08.18.46.30 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Thu, 08 Dec 2022 18:46:30 -0800 (PST) From: Wang Xiaohua To: linux-kernel@vger.kernel.org, linux@roeck-us.net, linux-hwmon@vger.kernel.org, jdelvare@suse.com, openbmc@lists.ozlabs.org, joel@jms.id.au Subject: [PATCH linux dev-6.0 v3] pmbus: Add mp2971/mp2973 support in mp2975 Date: Fri, 9 Dec 2022 10:45:22 +0800 Message-Id: <20221209024522.2102509-1-wangxiaohua.1217@bytedance.com> X-Mailer: git-send-email 2.25.1 MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit X-Spam-Status: No, score=-1.9 required=5.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,RCVD_IN_DNSWL_NONE,SPF_HELO_NONE,SPF_PASS autolearn=ham autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Add mp2971/mp2973 support in mp2975 Tested with: My unit only include mp2971 and mp2973 devices MP2973: cat /sys/bus/i2c/devices/5-0076/hwmon/hwmon24/*label iin iout1 iout2 vin vout1 vout2 pin pout1 pout2 cat /sys/bus/i2c/devices/5-0076/hwmon/hwmon24/*input 0 82500 14000 12187 1787 1793 0 148000000 25000000 54000 MP2971: cat /sys/bus/i2c/devices/5-0062/hwmon/hwmon20/*label iin iout1 iout2 vin vout1 vout2 pin pout1 pout2 cat /sys/bus/i2c/devices/5-0062/hwmon/hwmon20/*input 18500 22000 500 12187 1025 1800 226000000 22000000 1000000 55000 Signed-off-by: Wang Xiaohua v2: - Fix auto build test WARNING v3: - Fix incorrect return code --- drivers/hwmon/pmbus/mp2975.c | 415 +++++++++++++++++++++++++++++++---- 1 file changed, 374 insertions(+), 41 deletions(-) diff --git a/drivers/hwmon/pmbus/mp2975.c b/drivers/hwmon/pmbus/mp2975.c index 51986adfbf47..4d1b7ac1800e 100644 --- a/drivers/hwmon/pmbus/mp2975.c +++ b/drivers/hwmon/pmbus/mp2975.c @@ -52,10 +52,33 @@ #define MP2975_MAX_PHASE_RAIL2 4 #define MP2975_PAGE_NUM 2 +#define MP2971_RAIL2_FUNC \ + (PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT | PMBUS_HAVE_IOUT | \ + PMBUS_HAVE_STATUS_IOUT | PMBUS_HAVE_POUT) + #define MP2975_RAIL2_FUNC (PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT | \ PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT | \ PMBUS_HAVE_POUT | PMBUS_PHASE_VIRTUAL) +struct mp2971_device_info { + int max_phase_rail1; + int max_phase_rail2; + int imvp9_en_r1_mask; + int imvp9_en_r2_mask; +}; + +struct mp2971_data { + struct pmbus_driver_info info; + int vid_step[MP2975_PAGE_NUM]; + int vout_format[MP2975_PAGE_NUM]; + int vout_mode[MP2975_PAGE_NUM]; + int vout_exponent[MP2975_PAGE_NUM]; + int max_phase_rail1; + int max_phase_rail2; + int imvp9_en_r1_mask; + int imvp9_en_r2_mask; +}; + struct mp2975_data { struct pmbus_driver_info info; int vout_scale; @@ -68,6 +91,9 @@ struct mp2975_data { int curr_sense_gain[MP2975_PAGE_NUM]; }; +static const struct i2c_device_id mp2975_id[]; + +#define to_mp2971_data(x) container_of(x, struct mp2971_data, info) #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) @@ -95,6 +121,40 @@ mp2975_read_word_helper(struct i2c_client *client, int page, int phase, u8 reg, return (ret > 0) ? ret & mask : ret; } +static int +mp2971_linear2direct(struct mp2971_data *data, int page, int val) +{ + /* simple case */ + if (val == 0) + return 0; + + /* LINEAR16 does not support negative voltages */ + if (val < 0) + return 0; + + /* + * For a static exponents, we don't have a choice + * but to adjust the value to it. + */ + + if (data->vout_exponent[page] < 0) + val <<= -data->vout_exponent[page]; + else + val >>= data->vout_exponent[page]; + return clamp_val(val, 0, 0xffff); +} + +static int +mp2971_vid2direct(struct mp2971_data *data, int page, int val) +{ + int vrf = data->info.vrm_version[page]; + + if (vrf == imvp9) + return (val + 29) * data->vid_step[page]; + + return (val + 49) * data->vid_step[page]; +} + static int mp2975_vid2direct(int vrf, int val) { @@ -214,6 +274,74 @@ mp2975_read_phases(struct i2c_client *client, struct mp2975_data *data, return ret; } +static int +mp2971_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 mp2971_data *data = to_mp2971_data(info); + int ret; + + switch (reg) { + case PMBUS_OT_FAULT_LIMIT: + case PMBUS_VIN_OV_FAULT_LIMIT: + case PMBUS_VOUT_OV_FAULT_LIMIT: + case PMBUS_VOUT_UV_FAULT_LIMIT: + case PMBUS_READ_IOUT: + ret = mp2975_read_word_helper(client, page, phase, + reg, GENMASK(15, 0)); + 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 + * MP2971_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. + */ + switch (data->vout_format[page]) { + case linear: + ret = mp2971_linear2direct(data, page, ret); + break; + case vid: + ret = mp2971_vid2direct(data, page, ret); + break; + case direct: + break; + default: + return -ENODATA; + } + 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_read_word_data(struct i2c_client *client, int page, int phase, int reg) { @@ -365,6 +493,63 @@ mp2975_set_phase_rail2(struct pmbus_driver_info *info, int num_phases) info->pfunc[MP2975_MAX_PHASE_RAIL1 - i] = PMBUS_HAVE_IOUT; } +static int mp2971_identify_multiphase(struct i2c_client *client, + struct mp2971_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 multiphase for rail 1 - could be from 1 to 12. */ + 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] > data->max_phase_rail1) + return -EINVAL; + + return 0; +} + +static int +mp2971_identify_vid(struct i2c_client *client, struct mp2971_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_multiphase(struct i2c_client *client, struct mp2975_data *data, struct pmbus_driver_info *info) @@ -428,6 +613,68 @@ mp2975_identify_vid(struct i2c_client *client, struct mp2975_data *data, return 0; } +static int +mp2971_identify_rails_vid(struct i2c_client *client, struct mp2971_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 = mp2971_identify_vid(client, data, info, + MP2975_MFR_VR_MULTI_CONFIG_R1, 0, + data->imvp9_en_r1_mask, + MP2975_VID_STEP_SEL_R1); + if (ret < 0) + return ret; + + /* Identify VID mode for rail 2, if connected. */ + if (info->phases[1]) + ret = mp2971_identify_vid(client, data, info, + MP2975_MFR_VR_MULTI_CONFIG_R2, 1, + data->imvp9_en_r2_mask, + MP2975_VID_STEP_SEL_R2); + return ret; +} + +static int mp2971_identify_vout_format(struct i2c_client *client, + struct mp2971_data *data, + struct pmbus_driver_info *info) +{ + int i, ret, vout_mode; + + for (i = 0; i < info->pages; i++) { + ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, i); + if (ret < 0) + return ret; + + ret = i2c_smbus_read_byte_data(client, PMBUS_VOUT_MODE); + if (ret < 0) + return ret; + + vout_mode = ret; + + switch (vout_mode >> 5) { + case 0: + data->vout_format[i] = linear; + data->vout_exponent[i] = ((s8)(vout_mode << 3)) >> 3; + break; + case 1: + data->vout_format[i] = vid; + break; + case 2: + data->vout_format[i] = direct; + break; + default: + return -ENODEV; + } + } + return 0; +} + static int mp2975_identify_rails_vid(struct i2c_client *client, struct mp2975_data *data, struct pmbus_driver_info *info) @@ -659,6 +906,24 @@ mp2975_vout_per_rail_config_get(struct i2c_client *client, return 0; } +static struct pmbus_driver_info mp2971_info = { + .pages = 1, + .format[PSC_VOLTAGE_IN] = linear, + .format[PSC_VOLTAGE_OUT] = direct, + .format[PSC_TEMPERATURE] = linear, + .format[PSC_CURRENT_IN] = linear, + .format[PSC_CURRENT_OUT] = linear, + .format[PSC_POWER] = linear, + .m[PSC_VOLTAGE_OUT] = 1, + .R[PSC_VOLTAGE_OUT] = 3, + .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, + .read_byte_data = mp2975_read_byte_data, + .read_word_data = mp2971_read_word_data, +}; + static struct pmbus_driver_info mp2975_info = { .pages = 1, .format[PSC_VOLTAGE_IN] = linear, @@ -683,63 +948,131 @@ static struct pmbus_driver_info mp2975_info = { static int mp2975_probe(struct i2c_client *client) { struct pmbus_driver_info *info; - struct mp2975_data *data; int ret; + char *name; - data = devm_kzalloc(&client->dev, sizeof(struct mp2975_data), - GFP_KERNEL); - if (!data) - return -ENOMEM; + name = (char *)i2c_match_id(mp2975_id, client)->name; - memcpy(&data->info, &mp2975_info, sizeof(*info)); - info = &data->info; + if (!name) + return -EINVAL; - /* Identify multiphase configuration for rail 2. */ - ret = mp2975_identify_multiphase_rail2(client); - if (ret < 0) - return ret; + if (!strcmp(name, "mp2971") || !strcmp(name, "mp2973")) { + struct mp2971_data *data; + struct mp2971_device_info *device_info; - if (ret) { - /* Two rails are connected. */ - data->info.pages = MP2975_PAGE_NUM; - data->info.phases[1] = ret; - data->info.func[1] = MP2975_RAIL2_FUNC; - } + data = devm_kzalloc(&client->dev, sizeof(struct mp2971_data), + GFP_KERNEL); + if (!data) + return -ENOMEM; - /* Identify multiphase configuration. */ - ret = mp2975_identify_multiphase(client, data, info); - if (ret) - return ret; + device_info = + (struct mp2971_device_info *)i2c_match_id(mp2975_id, client) + ->driver_data; - /* Identify VID setting per rail. */ - ret = mp2975_identify_rails_vid(client, data, info); - if (ret < 0) - return ret; + memcpy(&data->info, &mp2971_info, sizeof(*info)); + info = &data->info; - /* Obtain current sense gain of power stage. */ - ret = mp2975_current_sense_gain_get(client, data); - if (ret) - return ret; + if (device_info) { + data->imvp9_en_r1_mask = device_info->imvp9_en_r1_mask; + data->imvp9_en_r2_mask = device_info->imvp9_en_r2_mask; + data->max_phase_rail1 = device_info->max_phase_rail1; + data->max_phase_rail2 = device_info->max_phase_rail2; + } - /* Obtain voltage reference values. */ - ret = mp2975_vref_get(client, data, info); - if (ret) - return ret; + /* Identify multiphase configuration for rail 2. */ + ret = mp2975_identify_multiphase_rail2(client); + if (ret < 0) + return ret; - /* Obtain vout over-voltage scales. */ - ret = mp2975_vout_ov_scale_get(client, data, info); - 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] = MP2971_RAIL2_FUNC; + } - /* Obtain offsets, maximum and format for vout. */ - ret = mp2975_vout_per_rail_config_get(client, data, info); - if (ret) - return ret; + /* Identify multiphase configuration. */ + ret = mp2971_identify_multiphase(client, data, info); + if (ret) + return ret; + + /* Identify VID setting per rail. */ + ret = mp2971_identify_rails_vid(client, data, info); + if (ret < 0) + return ret; + + /* Identify vout format. */ + ret = mp2971_identify_vout_format(client, data, info); + if (ret < 0) + return ret; + + } else { + struct mp2975_data *data; + + 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 mp2971_device_info mp2971_device_info = { + .imvp9_en_r1_mask = BIT(14), + .imvp9_en_r2_mask = BIT(13), + .max_phase_rail1 = 8, + .max_phase_rail2 = 4, +}; + static const struct i2c_device_id mp2975_id[] = { + {"mp2971", (kernel_ulong_t)&mp2971_device_info }, + {"mp2973", (kernel_ulong_t)&mp2971_device_info }, {"mp2975", 0}, {} }; -- 2.25.1