/* * Copyright (c) 2014, Sony Mobile Communications AB. * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include #include #include #include #include #include #include #include #include #define MAX_REQUEST_LEN 2 struct request_member { int word; unsigned int mask; int shift; }; struct rpm_reg_parts { struct request_member mV; /* used if voltage is in mV */ struct request_member uV; /* used if voltage is in uV */ struct request_member ip; /* peak current in mA */ struct request_member pd; /* pull down enable */ struct request_member ia; /* average current in mA */ struct request_member fm; /* force mode */ struct request_member pm; /* power mode */ struct request_member pc; /* pin control */ struct request_member pf; /* pin function */ struct request_member enable_state; /* NCP and switch */ struct request_member comp_mode; /* NCP */ struct request_member freq; /* frequency: NCP and SMPS */ struct request_member freq_clk_src; /* clock source: SMPS */ struct request_member hpm; /* switch: control OCP and SS */ int request_len; }; #define FORCE_MODE_IS_2_BITS(reg) \ (((reg)->parts->fm.mask >> (reg)->parts->fm.shift) == 3) struct qcom_rpm_reg { struct qcom_rpm *rpm; struct mutex lock; struct device *dev; struct regulator_desc desc; const struct rpm_reg_parts *parts; int resource; u32 val[MAX_REQUEST_LEN]; int uV; int is_enabled; bool supports_force_mode_auto; bool supports_force_mode_bypass; }; static const struct rpm_reg_parts rpm8660_ldo_parts = { .request_len = 2, .mV = { 0, 0x00000FFF, 0 }, .ip = { 0, 0x00FFF000, 12 }, .fm = { 0, 0x03000000, 24 }, .pc = { 0, 0x3C000000, 26 }, .pf = { 0, 0xC0000000, 30 }, .pd = { 1, 0x00000001, 0 }, .ia = { 1, 0x00001FFE, 1 }, }; static const struct rpm_reg_parts rpm8660_smps_parts = { .request_len = 2, .mV = { 0, 0x00000FFF, 0 }, .ip = { 0, 0x00FFF000, 12 }, .fm = { 0, 0x03000000, 24 }, .pc = { 0, 0x3C000000, 26 }, .pf = { 0, 0xC0000000, 30 }, .pd = { 1, 0x00000001, 0 }, .ia = { 1, 0x00001FFE, 1 }, .freq = { 1, 0x001FE000, 13 }, .freq_clk_src = { 1, 0x00600000, 21 }, }; static const struct rpm_reg_parts rpm8660_switch_parts = { .request_len = 1, .enable_state = { 0, 0x00000001, 0 }, .pd = { 0, 0x00000002, 1 }, .pc = { 0, 0x0000003C, 2 }, .pf = { 0, 0x000000C0, 6 }, .hpm = { 0, 0x00000300, 8 }, }; static const struct rpm_reg_parts rpm8660_ncp_parts = { .request_len = 1, .mV = { 0, 0x00000FFF, 0 }, .enable_state = { 0, 0x00001000, 12 }, .comp_mode = { 0, 0x00002000, 13 }, .freq = { 0, 0x003FC000, 14 }, }; static const struct rpm_reg_parts rpm8960_ldo_parts = { .request_len = 2, .uV = { 0, 0x007FFFFF, 0 }, .pd = { 0, 0x00800000, 23 }, .pc = { 0, 0x0F000000, 24 }, .pf = { 0, 0xF0000000, 28 }, .ip = { 1, 0x000003FF, 0 }, .ia = { 1, 0x000FFC00, 10 }, .fm = { 1, 0x00700000, 20 }, }; static const struct rpm_reg_parts rpm8960_smps_parts = { .request_len = 2, .uV = { 0, 0x007FFFFF, 0 }, .pd = { 0, 0x00800000, 23 }, .pc = { 0, 0x0F000000, 24 }, .pf = { 0, 0xF0000000, 28 }, .ip = { 1, 0x000003FF, 0 }, .ia = { 1, 0x000FFC00, 10 }, .fm = { 1, 0x00700000, 20 }, .pm = { 1, 0x00800000, 23 }, .freq = { 1, 0x1F000000, 24 }, .freq_clk_src = { 1, 0x60000000, 29 }, }; static const struct rpm_reg_parts rpm8960_switch_parts = { .request_len = 1, .enable_state = { 0, 0x00000001, 0 }, .pd = { 0, 0x00000002, 1 }, .pc = { 0, 0x0000003C, 2 }, .pf = { 0, 0x000003C0, 6 }, .hpm = { 0, 0x00000C00, 10 }, }; static const struct rpm_reg_parts rpm8960_ncp_parts = { .request_len = 1, .uV = { 0, 0x007FFFFF, 0 }, .enable_state = { 0, 0x00800000, 23 }, .comp_mode = { 0, 0x01000000, 24 }, .freq = { 0, 0x3E000000, 25 }, }; /* * Physically available PMIC regulator voltage ranges */ static const struct regulator_linear_range pldo_ranges[] = { REGULATOR_LINEAR_RANGE( 750000, 0, 59, 12500), REGULATOR_LINEAR_RANGE(1500000, 60, 123, 25000), REGULATOR_LINEAR_RANGE(3100000, 124, 160, 50000), }; static const struct regulator_linear_range nldo_ranges[] = { REGULATOR_LINEAR_RANGE( 750000, 0, 63, 12500), }; static const struct regulator_linear_range nldo1200_ranges[] = { REGULATOR_LINEAR_RANGE( 375000, 0, 59, 6250), REGULATOR_LINEAR_RANGE( 750000, 60, 123, 12500), }; static const struct regulator_linear_range smps_ranges[] = { REGULATOR_LINEAR_RANGE( 375000, 0, 29, 12500), REGULATOR_LINEAR_RANGE( 750000, 30, 89, 12500), REGULATOR_LINEAR_RANGE(1500000, 90, 153, 25000), }; static const struct regulator_linear_range ftsmps_ranges[] = { REGULATOR_LINEAR_RANGE( 350000, 0, 6, 50000), REGULATOR_LINEAR_RANGE( 700000, 7, 63, 12500), REGULATOR_LINEAR_RANGE(1500000, 64, 100, 50000), }; static const struct regulator_linear_range smb208_ranges[] = { REGULATOR_LINEAR_RANGE( 375000, 0, 29, 12500), REGULATOR_LINEAR_RANGE( 750000, 30, 89, 12500), REGULATOR_LINEAR_RANGE(1500000, 90, 153, 25000), REGULATOR_LINEAR_RANGE(3100000, 154, 234, 25000), }; static const struct regulator_linear_range ncp_ranges[] = { REGULATOR_LINEAR_RANGE(1500000, 0, 31, 50000), }; static int rpm_reg_write(struct qcom_rpm_reg *vreg, const struct request_member *req, const int value) { if (WARN_ON((value << req->shift) & ~req->mask)) return -EINVAL; vreg->val[req->word] &= ~req->mask; vreg->val[req->word] |= value << req->shift; return qcom_rpm_write(vreg->rpm, QCOM_RPM_ACTIVE_STATE, vreg->resource, vreg->val, vreg->parts->request_len); } static int rpm_reg_set_mV_sel(struct regulator_dev *rdev, unsigned selector) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); const struct rpm_reg_parts *parts = vreg->parts; const struct request_member *req = &parts->mV; int ret = 0; int uV; if (req->mask == 0) return -EINVAL; uV = regulator_list_voltage_linear_range(rdev, selector); if (uV < 0) return uV; mutex_lock(&vreg->lock); if (vreg->is_enabled) ret = rpm_reg_write(vreg, req, uV / 1000); if (!ret) vreg->uV = uV; mutex_unlock(&vreg->lock); return ret; } static int rpm_reg_set_uV_sel(struct regulator_dev *rdev, unsigned selector) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); const struct rpm_reg_parts *parts = vreg->parts; const struct request_member *req = &parts->uV; int ret = 0; int uV; if (req->mask == 0) return -EINVAL; uV = regulator_list_voltage_linear_range(rdev, selector); if (uV < 0) return uV; mutex_lock(&vreg->lock); if (vreg->is_enabled) ret = rpm_reg_write(vreg, req, uV); if (!ret) vreg->uV = uV; mutex_unlock(&vreg->lock); return ret; } static int rpm_reg_get_voltage(struct regulator_dev *rdev) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); return vreg->uV; } static int rpm_reg_mV_enable(struct regulator_dev *rdev) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); const struct rpm_reg_parts *parts = vreg->parts; const struct request_member *req = &parts->mV; int ret; if (req->mask == 0) return -EINVAL; mutex_lock(&vreg->lock); ret = rpm_reg_write(vreg, req, vreg->uV / 1000); if (!ret) vreg->is_enabled = 1; mutex_unlock(&vreg->lock); return ret; } static int rpm_reg_uV_enable(struct regulator_dev *rdev) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); const struct rpm_reg_parts *parts = vreg->parts; const struct request_member *req = &parts->uV; int ret; if (req->mask == 0) return -EINVAL; mutex_lock(&vreg->lock); ret = rpm_reg_write(vreg, req, vreg->uV); if (!ret) vreg->is_enabled = 1; mutex_unlock(&vreg->lock); return ret; } static int rpm_reg_switch_enable(struct regulator_dev *rdev) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); const struct rpm_reg_parts *parts = vreg->parts; const struct request_member *req = &parts->enable_state; int ret; if (req->mask == 0) return -EINVAL; mutex_lock(&vreg->lock); ret = rpm_reg_write(vreg, req, 1); if (!ret) vreg->is_enabled = 1; mutex_unlock(&vreg->lock); return ret; } static int rpm_reg_mV_disable(struct regulator_dev *rdev) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); const struct rpm_reg_parts *parts = vreg->parts; const struct request_member *req = &parts->mV; int ret; if (req->mask == 0) return -EINVAL; mutex_lock(&vreg->lock); ret = rpm_reg_write(vreg, req, 0); if (!ret) vreg->is_enabled = 0; mutex_unlock(&vreg->lock); return ret; } static int rpm_reg_uV_disable(struct regulator_dev *rdev) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); const struct rpm_reg_parts *parts = vreg->parts; const struct request_member *req = &parts->uV; int ret; if (req->mask == 0) return -EINVAL; mutex_lock(&vreg->lock); ret = rpm_reg_write(vreg, req, 0); if (!ret) vreg->is_enabled = 0; mutex_unlock(&vreg->lock); return ret; } static int rpm_reg_switch_disable(struct regulator_dev *rdev) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); const struct rpm_reg_parts *parts = vreg->parts; const struct request_member *req = &parts->enable_state; int ret; if (req->mask == 0) return -EINVAL; mutex_lock(&vreg->lock); ret = rpm_reg_write(vreg, req, 0); if (!ret) vreg->is_enabled = 0; mutex_unlock(&vreg->lock); return ret; } static int rpm_reg_is_enabled(struct regulator_dev *rdev) { struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev); return vreg->is_enabled; } static struct regulator_ops uV_ops = { .list_voltage = regulator_list_voltage_linear_range, .set_voltage_sel = rpm_reg_set_uV_sel, .get_voltage = rpm_reg_get_voltage, .enable = rpm_reg_uV_enable, .disable = rpm_reg_uV_disable, .is_enabled = rpm_reg_is_enabled, }; static struct regulator_ops mV_ops = { .list_voltage = regulator_list_voltage_linear_range, .set_voltage_sel = rpm_reg_set_mV_sel, .get_voltage = rpm_reg_get_voltage, .enable = rpm_reg_mV_enable, .disable = rpm_reg_mV_disable, .is_enabled = rpm_reg_is_enabled, }; static struct regulator_ops switch_ops = { .enable = rpm_reg_switch_enable, .disable = rpm_reg_switch_disable, .is_enabled = rpm_reg_is_enabled, }; /* * PM8058 regulators */ static const struct qcom_rpm_reg pm8058_pldo = { .desc.linear_ranges = pldo_ranges, .desc.n_linear_ranges = ARRAY_SIZE(pldo_ranges), .desc.n_voltages = 161, .desc.ops = &mV_ops, .parts = &rpm8660_ldo_parts, .supports_force_mode_auto = false, .supports_force_mode_bypass = false, }; static const struct qcom_rpm_reg pm8058_nldo = { .desc.linear_ranges = nldo_ranges, .desc.n_linear_ranges = ARRAY_SIZE(nldo_ranges), .desc.n_voltages = 64, .desc.ops = &mV_ops, .parts = &rpm8660_ldo_parts, .supports_force_mode_auto = false, .supports_force_mode_bypass = false, }; static const struct qcom_rpm_reg pm8058_smps = { .desc.linear_ranges = smps_ranges, .desc.n_linear_ranges = ARRAY_SIZE(smps_ranges), .desc.n_voltages = 154, .desc.ops = &mV_ops, .parts = &rpm8660_smps_parts, .supports_force_mode_auto = false, .supports_force_mode_bypass = false, }; static const struct qcom_rpm_reg pm8058_ncp = { .desc.linear_ranges = ncp_ranges, .desc.n_linear_ranges = ARRAY_SIZE(ncp_ranges), .desc.n_voltages = 32, .desc.ops = &mV_ops, .parts = &rpm8660_ncp_parts, }; static const struct qcom_rpm_reg pm8058_switch = { .desc.ops = &switch_ops, .parts = &rpm8660_switch_parts, }; /* * PM8901 regulators */ static const struct qcom_rpm_reg pm8901_pldo = { .desc.linear_ranges = pldo_ranges, .desc.n_linear_ranges = ARRAY_SIZE(pldo_ranges), .desc.n_voltages = 161, .desc.ops = &mV_ops, .parts = &rpm8660_ldo_parts, .supports_force_mode_auto = false, .supports_force_mode_bypass = true, }; static const struct qcom_rpm_reg pm8901_nldo = { .desc.linear_ranges = nldo_ranges, .desc.n_linear_ranges = ARRAY_SIZE(nldo_ranges), .desc.n_voltages = 64, .desc.ops = &mV_ops, .parts = &rpm8660_ldo_parts, .supports_force_mode_auto = false, .supports_force_mode_bypass = true, }; static const struct qcom_rpm_reg pm8901_ftsmps = { .desc.linear_ranges = ftsmps_ranges, .desc.n_linear_ranges = ARRAY_SIZE(ftsmps_ranges), .desc.n_voltages = 101, .desc.ops = &mV_ops, .parts = &rpm8660_smps_parts, .supports_force_mode_auto = true, .supports_force_mode_bypass = false, }; static const struct qcom_rpm_reg pm8901_switch = { .desc.ops = &switch_ops, .parts = &rpm8660_switch_parts, }; /* * PM8921 regulators */ static const struct qcom_rpm_reg pm8921_pldo = { .desc.linear_ranges = pldo_ranges, .desc.n_linear_ranges = ARRAY_SIZE(pldo_ranges), .desc.n_voltages = 161, .desc.ops = &uV_ops, .parts = &rpm8960_ldo_parts, .supports_force_mode_auto = false, .supports_force_mode_bypass = true, }; static const struct qcom_rpm_reg pm8921_nldo = { .desc.linear_ranges = nldo_ranges, .desc.n_linear_ranges = ARRAY_SIZE(nldo_ranges), .desc.n_voltages = 64, .desc.ops = &uV_ops, .parts = &rpm8960_ldo_parts, .supports_force_mode_auto = false, .supports_force_mode_bypass = true, }; static const struct qcom_rpm_reg pm8921_nldo1200 = { .desc.linear_ranges = nldo1200_ranges, .desc.n_linear_ranges = ARRAY_SIZE(nldo1200_ranges), .desc.n_voltages = 124, .desc.ops = &uV_ops, .parts = &rpm8960_ldo_parts, .supports_force_mode_auto = false, .supports_force_mode_bypass = true, }; static const struct qcom_rpm_reg pm8921_smps = { .desc.linear_ranges = smps_ranges, .desc.n_linear_ranges = ARRAY_SIZE(smps_ranges), .desc.n_voltages = 154, .desc.ops = &uV_ops, .parts = &rpm8960_smps_parts, .supports_force_mode_auto = true, .supports_force_mode_bypass = false, }; static const struct qcom_rpm_reg pm8921_ftsmps = { .desc.linear_ranges = ftsmps_ranges, .desc.n_linear_ranges = ARRAY_SIZE(ftsmps_ranges), .desc.n_voltages = 101, .desc.ops = &uV_ops, .parts = &rpm8960_smps_parts, .supports_force_mode_auto = true, .supports_force_mode_bypass = false, }; static const struct qcom_rpm_reg pm8921_ncp = { .desc.linear_ranges = ncp_ranges, .desc.n_linear_ranges = ARRAY_SIZE(ncp_ranges), .desc.n_voltages = 32, .desc.ops = &uV_ops, .parts = &rpm8960_ncp_parts, }; static const struct qcom_rpm_reg pm8921_switch = { .desc.ops = &switch_ops, .parts = &rpm8960_switch_parts, }; static const struct qcom_rpm_reg smb208_smps = { .desc.linear_ranges = smb208_ranges, .desc.n_linear_ranges = ARRAY_SIZE(smb208_ranges), .desc.n_voltages = 235, .desc.ops = &uV_ops, .parts = &rpm8960_smps_parts, .supports_force_mode_auto = false, .supports_force_mode_bypass = false, }; static const struct of_device_id rpm_of_match[] = { { .compatible = "qcom,rpm-pm8058-pldo", .data = &pm8058_pldo }, { .compatible = "qcom,rpm-pm8058-nldo", .data = &pm8058_nldo }, { .compatible = "qcom,rpm-pm8058-smps", .data = &pm8058_smps }, { .compatible = "qcom,rpm-pm8058-ncp", .data = &pm8058_ncp }, { .compatible = "qcom,rpm-pm8058-switch", .data = &pm8058_switch }, { .compatible = "qcom,rpm-pm8901-pldo", .data = &pm8901_pldo }, { .compatible = "qcom,rpm-pm8901-nldo", .data = &pm8901_nldo }, { .compatible = "qcom,rpm-pm8901-ftsmps", .data = &pm8901_ftsmps }, { .compatible = "qcom,rpm-pm8901-switch", .data = &pm8901_switch }, { .compatible = "qcom,rpm-pm8921-pldo", .data = &pm8921_pldo }, { .compatible = "qcom,rpm-pm8921-nldo", .data = &pm8921_nldo }, { .compatible = "qcom,rpm-pm8921-nldo1200", .data = &pm8921_nldo1200 }, { .compatible = "qcom,rpm-pm8921-smps", .data = &pm8921_smps }, { .compatible = "qcom,rpm-pm8921-ftsmps", .data = &pm8921_ftsmps }, { .compatible = "qcom,rpm-pm8921-ncp", .data = &pm8921_ncp }, { .compatible = "qcom,rpm-pm8921-switch", .data = &pm8921_switch }, { .compatible = "qcom,rpm-smb208", .data = &smb208_smps }, { } }; MODULE_DEVICE_TABLE(of, rpm_of_match); static int rpm_reg_set(struct qcom_rpm_reg *vreg, const struct request_member *req, const int value) { if (req->mask == 0 || (value << req->shift) & ~req->mask) return -EINVAL; vreg->val[req->word] &= ~req->mask; vreg->val[req->word] |= value << req->shift; return 0; } static int rpm_reg_of_parse_freq(struct device *dev, struct qcom_rpm_reg *vreg) { static const int freq_table[] = { 19200000, 9600000, 6400000, 4800000, 3840000, 3200000, 2740000, 2400000, 2130000, 1920000, 1750000, 1600000, 1480000, 1370000, 1280000, 1200000, }; const char *key; u32 freq; int ret; int i; key = "qcom,switch-mode-frequency"; ret = of_property_read_u32(dev->of_node, key, &freq); if (ret) { dev_err(dev, "regulator requires %s property\n", key); return -EINVAL; } for (i = 0; i < ARRAY_SIZE(freq_table); i++) { if (freq == freq_table[i]) { rpm_reg_set(vreg, &vreg->parts->freq, i + 1); return 0; } } dev_err(dev, "invalid frequency %d\n", freq); return -EINVAL; } static int rpm_reg_probe(struct platform_device *pdev) { struct regulator_init_data *initdata; const struct qcom_rpm_reg *template; const struct of_device_id *match; struct regulator_config config = { }; struct regulator_dev *rdev; struct qcom_rpm_reg *vreg; const char *key; u32 force_mode; bool pwm; u32 val; int ret; match = of_match_device(rpm_of_match, &pdev->dev); template = match->data; vreg = devm_kmalloc(&pdev->dev, sizeof(*vreg), GFP_KERNEL); if (!vreg) { dev_err(&pdev->dev, "failed to allocate vreg\n"); return -ENOMEM; } memcpy(vreg, template, sizeof(*vreg)); mutex_init(&vreg->lock); vreg->dev = &pdev->dev; vreg->desc.id = -1; vreg->desc.owner = THIS_MODULE; vreg->desc.type = REGULATOR_VOLTAGE; vreg->desc.name = pdev->dev.of_node->name; vreg->desc.supply_name = "vin"; vreg->rpm = dev_get_drvdata(pdev->dev.parent); if (!vreg->rpm) { dev_err(&pdev->dev, "unable to retrieve handle to rpm\n"); return -ENODEV; } initdata = of_get_regulator_init_data(&pdev->dev, pdev->dev.of_node, &vreg->desc); if (!initdata) return -EINVAL; key = "reg"; ret = of_property_read_u32(pdev->dev.of_node, key, &val); if (ret) { dev_err(&pdev->dev, "failed to read %s\n", key); return ret; } vreg->resource = val; if ((vreg->parts->uV.mask || vreg->parts->mV.mask) && (!initdata->constraints.min_uV || !initdata->constraints.max_uV)) { dev_err(&pdev->dev, "no voltage specified for regulator\n"); return -EINVAL; } key = "bias-pull-down"; if (of_property_read_bool(pdev->dev.of_node, key)) { ret = rpm_reg_set(vreg, &vreg->parts->pd, 1); if (ret) { dev_err(&pdev->dev, "%s is invalid", key); return ret; } } if (vreg->parts->freq.mask) { ret = rpm_reg_of_parse_freq(&pdev->dev, vreg); if (ret < 0) return ret; } if (vreg->parts->pm.mask) { key = "qcom,power-mode-hysteretic"; pwm = !of_property_read_bool(pdev->dev.of_node, key); ret = rpm_reg_set(vreg, &vreg->parts->pm, pwm); if (ret) { dev_err(&pdev->dev, "failed to set power mode\n"); return ret; } } if (vreg->parts->fm.mask) { force_mode = -1; key = "qcom,force-mode"; ret = of_property_read_u32(pdev->dev.of_node, key, &val); if (ret == -EINVAL) { val = QCOM_RPM_FORCE_MODE_NONE; } else if (ret < 0) { dev_err(&pdev->dev, "failed to read %s\n", key); return ret; } /* * If force-mode is encoded as 2 bits then the * possible register values are: * NONE, LPM, HPM * otherwise: * NONE, LPM, AUTO, HPM, BYPASS */ switch (val) { case QCOM_RPM_FORCE_MODE_NONE: force_mode = 0; break; case QCOM_RPM_FORCE_MODE_LPM: force_mode = 1; break; case QCOM_RPM_FORCE_MODE_HPM: if (FORCE_MODE_IS_2_BITS(vreg)) force_mode = 2; else force_mode = 3; break; case QCOM_RPM_FORCE_MODE_AUTO: if (vreg->supports_force_mode_auto) force_mode = 2; break; case QCOM_RPM_FORCE_MODE_BYPASS: if (vreg->supports_force_mode_bypass) force_mode = 4; break; } if (force_mode == -1) { dev_err(&pdev->dev, "invalid force mode\n"); return -EINVAL; } ret = rpm_reg_set(vreg, &vreg->parts->fm, force_mode); if (ret) { dev_err(&pdev->dev, "failed to set force mode\n"); return ret; } } config.dev = &pdev->dev; config.init_data = initdata; config.driver_data = vreg; config.of_node = pdev->dev.of_node; rdev = devm_regulator_register(&pdev->dev, &vreg->desc, &config); if (IS_ERR(rdev)) { dev_err(&pdev->dev, "can't register regulator\n"); return PTR_ERR(rdev); } return 0; } static struct platform_driver rpm_reg_driver = { .probe = rpm_reg_probe, .driver = { .name = "qcom_rpm_reg", .of_match_table = of_match_ptr(rpm_of_match), }, }; static int __init rpm_reg_init(void) { return platform_driver_register(&rpm_reg_driver); } subsys_initcall(rpm_reg_init); static void __exit rpm_reg_exit(void) { platform_driver_unregister(&rpm_reg_driver); } module_exit(rpm_reg_exit) MODULE_DESCRIPTION("Qualcomm RPM regulator driver"); MODULE_LICENSE("GPL v2");