On Fri, Jan 06, 2017 at 06:47:30AM +0800, Icenowy Zheng wrote:
> > > +++ b/drivers/power/axp803.c
> > > @@ -0,0 +1,255 @@
> > > +/*
> > > + * AXP803 driver based on AXP818 driver
> > > + *
> > > + * Based on axp818.c
> > > + * (C) Copyright 2015 Vishnu Patekar
> > > + *
> > > + * Based on axp221.c
> > > + * (C) Copyright 2014 Hans de Goede
> > > + * (C) Copyright 2013 Oliver Schinagl
> > > + *
> > > + * SPDX-License-Identifier: GPL-2.0+
> > > + */
> > > +
> > > +#include
> > > +#include
> > > +#include
> > > +#include
> > > +#include
> > > +
> > > +static u8 axp803_mvolt_to_cfg(int mvolt, int min, int max, int div)
> > > +{
> > > + if (mvolt < min)
> > > + mvolt = min;
> > > + else if (mvolt > max)
> > > + mvolt = max;
> > > +
> > > + returnĀ (mvolt - min) / div;
> > > +}
> > > +
> > > +int axp_set_dcdc1(unsigned int mvolt)
> > > +{
> > > + int ret;
> > > + u8 cfg = axp803_mvolt_to_cfg(mvolt, 1600, 3400, 100);
> > > +
> > > + if (mvolt == 0)
> > > + return pmic_bus_clrbits(AXP803_OUTPUT_CTRL1,
> > > + AXP803_OUTPUT_CTRL1_DCDC1_EN);
> > > +
> > > + ret = pmic_bus_write(AXP803_DCDC1_CTRL, cfg);
> > > + if (ret)
> > > + return ret;
> > > +
> > > + return pmic_bus_setbits(AXP803_OUTPUT_CTRL1,
> > > + AXP803_OUTPUT_CTRL1_DCDC1_EN);
> > > +}
> > > +
> > > +int axp_set_dcdc2(unsigned int mvolt)
> > > +{
> > > + int ret;
> > > + u8 cfg;
> > > +
> > > + if (mvolt >= 1220)
> > > + cfg = 70 + axp803_mvolt_to_cfg(mvolt, 1220, 1300, 20);
> > > + else
> > > + cfg = axp803_mvolt_to_cfg(mvolt, 500, 1200, 10);
> > > +
> > > + if (mvolt == 0)
> > > + return pmic_bus_clrbits(AXP803_OUTPUT_CTRL1,
> > > + AXP803_OUTPUT_CTRL1_DCDC2_EN);
> > > +
> > > + ret = pmic_bus_write(AXP803_DCDC2_CTRL, cfg);
> > > + if (ret)
> > > + return ret;
> > > +
> > > + return pmic_bus_setbits(AXP803_OUTPUT_CTRL1,
> > > + AXP803_OUTPUT_CTRL1_DCDC2_EN);
> > > +}
> > > +
> > > +int axp_set_dcdc3(unsigned int mvolt)
> > > +{
> > > + int ret;
> > > + u8 cfg;
> > > +
> > > + if (mvolt >= 1220)
> > > + cfg = 70 + axp803_mvolt_to_cfg(mvolt, 1220, 1300, 20);
> > > + else
> > > + cfg = axp803_mvolt_to_cfg(mvolt, 500, 1200, 10);
> > > +
> > > + if (mvolt == 0)
> > > + return pmic_bus_clrbits(AXP803_OUTPUT_CTRL1,
> > > + AXP803_OUTPUT_CTRL1_DCDC3_EN);
> > > +
> > > + ret = pmic_bus_write(AXP803_DCDC3_CTRL, cfg);
> > > + if (ret)
> > > + return ret;
> > > +
> > > + return pmic_bus_setbits(AXP803_OUTPUT_CTRL1,
> > > + AXP803_OUTPUT_CTRL1_DCDC3_EN);
> > > +}
> > > +
> > > +int axp_set_dcdc5(unsigned int mvolt)
> > > +{
> > > + int ret;
> > > + u8 cfg;
> > > +
> > > + if (mvolt >= 1140)
> > > + cfg = 32 + axp803_mvolt_to_cfg(mvolt, 1140, 1840, 20);
> > > + else
> > > + cfg = axp803_mvolt_to_cfg(mvolt, 800, 1120, 10);
> > > +
> > > + if (mvolt == 0)
> > > + return pmic_bus_clrbits(AXP803_OUTPUT_CTRL1,
> > > + AXP803_OUTPUT_CTRL1_DCDC5_EN);
> > > +
> > > + ret = pmic_bus_write(AXP803_DCDC5_CTRL, cfg);
> > > + if (ret)
> > > + return ret;
> > > +
> > > + return pmic_bus_setbits(AXP803_OUTPUT_CTRL1,
> > > + AXP803_OUTPUT_CTRL1_DCDC5_EN);
> > > +}
> > > +
> > > +int axp_set_aldo(int aldo_num, unsigned int mvolt)
> > > +{
> > > + int ret;
> > > + u8 cfg;
> > > +
> > > + if (aldo_num < 1 || aldo_num > 3)
> > > + return -EINVAL;
> > > +
> > > + if (mvolt == 0)
> > > + return pmic_bus_clrbits(AXP803_OUTPUT_CTRL3,
> > > + AXP803_OUTPUT_CTRL3_ALDO1_EN << (aldo_num - 1));
> > > +
> > > + cfg = axp803_mvolt_to_cfg(mvolt, 700, 3300, 100);
> > > + ret = pmic_bus_write(AXP803_ALDO1_CTRL + (aldo_num - 1), cfg);
> > > + if (ret)
> > > + return ret;
> > > +
> > > + return pmic_bus_setbits(AXP803_OUTPUT_CTRL3,
> > > + AXP803_OUTPUT_CTRL3_ALDO1_EN << (aldo_num - 1));
> > > +}
> > > +
> > > +/* TODO: re-work other AXP drivers to consolidate ALDO functions. */
> > > +int axp_set_aldo1(unsigned int mvolt)
> > > +{
> > > + return axp_set_aldo(1, mvolt);
> > > +}
> > > +
> > > +int axp_set_aldo2(unsigned int mvolt)
> > > +{
> > > + return axp_set_aldo(2, mvolt);
> > > +}
> > > +
> > > +int axp_set_aldo3(unsigned int mvolt)
> > > +{
> > > + return axp_set_aldo(3, mvolt);
> > > +}
> > > +
> > > +int axp_set_dldo(int dldo_num, unsigned int mvolt)
> > > +{
> > > + int ret;
> > > + u8 cfg;
> > > +
> > > + if (dldo_num < 1 || dldo_num > 4)
> > > + return -EINVAL;
> > > +
> > > + if (mvolt == 0)
> > > + return pmic_bus_clrbits(AXP803_OUTPUT_CTRL2,
> > > + AXP803_OUTPUT_CTRL2_DLDO1_EN << (dldo_num - 1));
> > > +
> > > + cfg = axp803_mvolt_to_cfg(mvolt, 700, 3300, 100);
> > > + if (dldo_num == 2 && mvolt > 3300)
> > > + cfg += 1 + axp803_mvolt_to_cfg(mvolt, 3400, 4200, 200);
> > > + ret = pmic_bus_write(AXP803_DLDO1_CTRL + (dldo_num - 1), cfg);
> > > + if (ret)
> > > + return ret;
> > > +
> > > + return pmic_bus_setbits(AXP803_OUTPUT_CTRL2,
> > > + AXP803_OUTPUT_CTRL2_DLDO1_EN << (dldo_num - 1));
> > > +}
> > > +
> > >