/*
 * (C) Copyright 2007-2013
 * Allwinner Technology Co., Ltd. <www.allwinnertech.com>
 * Jerry Wang <wangflord@allwinnertech.com>
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * 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.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */
#include <common.h>
#include <power/axp81X_reg.h>
#include "axp.h"
#include <pmu.h>
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dc1sw(int onoff)
{
    u8   reg_value;

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
    if(onoff)
    {
		reg_value |= (1 << 7);
	}
	else
	{
		reg_value &= ~(1 << 7);
	}
	if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, reg_value))
	{
		printf("sunxi pmu error : unable to set dc1sw\n");

		return -1;
	}

	return 0;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dc5ldo(int onoff)
{
    u8   reg_value;

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
    if(onoff)
    {
		reg_value |= (1 << 0);
	}
	else
	{
		reg_value &= ~(1 << 0);
	}
	if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, reg_value))
	{
		printf("sunxi pmu error : unable to set dc5ldo\n");

		return -1;
	}

	return 0;
}

/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dcdc1(int set_vol, int onoff)
{
    u8   reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 1600)
		{
			set_vol = 1600;
		}
		else if(set_vol > 3400)
		{
			set_vol = 3400;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC1OUT_VOL, &reg_value))
	    {
			return -1;
	    }
	    reg_value &= 0xE0;
		reg_value |= ((set_vol - 1600)/100);

		if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DC1OUT_VOL, reg_value))
		{
			printf("sunxi pmu error : unable to set dcdc1\n");

			return -1;
		}
		axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC1OUT_VOL, &reg_value);
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 0);
	}
	else
	{
		reg_value |=  (1 << 0);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, reg_value))
	{
		printf("sunxi pmu error : unable to onoff dcdc1\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_dcdc1(void)
{
    u8  reg_value;

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 0)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC1OUT_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;

    return 1600 + 100 * reg_value;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dcdc2(int set_vol, int onoff)
{
    u8   reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 500)
		{
			set_vol = 500;
		}
		else if(set_vol > 1300)
		{
			set_vol = 1300;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC2OUT_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= ~0x7f;
        //dcdc2： 0.5v-1.2v  10mv/step   1.22v-1.3v  20mv/step
        if(set_vol > 1200)
        {
             reg_value |= (70+(set_vol - 1200)/20);
        }
        else
        {
            reg_value |= (set_vol - 500)/10;
        }
	   
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DC2OUT_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set dcdc2\n");
	        return -1;
	    }
#if 0
         if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC2OUT_VOL, &reg_value))
	    {
	    	debug("%d\n", __LINE__);

	        return -1;
	    }
        printf("BOOT_POWER81X_DC2OUT_VOL=%d\n", reg_value);
#endif
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 1);
	}
	else
	{
		reg_value |=  (1 << 1);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, reg_value))
	{
		printf("sunxi pmu error : unable to onoff dcdc2\n");

		return -1;
	}

    return 0;
}

static int axp81X_probe_dcdc2(void)
{
    u8  reg_value;
	
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 1)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC2OUT_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x7f;
     //dcdc2： 0.5v-1.2v  10mv/step   1.22v-1.3v  20mv/step
    if(reg_value > 70)
    {
        return 1200 + 20 * (reg_value-70);
    }
    else
    {
         return 500 + 10 * reg_value;
    }

   
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dcdc3(int set_vol, int onoff)
{
    u8   reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 500)
		{
			set_vol = 500;
		}
		else if(set_vol > 1300)
		{
			set_vol = 1300;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC3OUT_VOL, &reg_value))
	    {
	    	debug("%d\n", __LINE__);

	        return -1;
	    }
	    reg_value &= (~0x7f);
		 //dcdc3： 0.5v-1.2v  10mv/step   1.22v-1.3v  20mv/step
        if(set_vol > 1200)
        {
             reg_value |= (70+(set_vol - 1200)/20);
        }
        else
        {
            reg_value |= (set_vol - 500)/10;
        }
		if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DC3OUT_VOL, reg_value))
		{
			printf("sunxi pmu error : unable to set dcdc3\n");

			return -1;
		}
#if 0
        if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC3OUT_VOL, &reg_value))
	    {
	    	debug("%d\n", __LINE__);

	        return -1;
	    }
        printf("BOOT_POWER81X_DC3OUT_VOL=%d\n", reg_value);
#endif
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 2);
	}
	else
	{
		reg_value |=  (1 << 2);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, reg_value))
	{
		printf("sunxi pmu error : unable to onoff dcdc3\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_dcdc3(void)
{
    u8  reg_value;
	
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 2)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC3OUT_VOL, &reg_value))
    {
		return -1;
    }
     reg_value &= 0x7f;
     //dcdc3： 0.5v-1.2v  10mv/step   1.22v-1.3v  20mv/step
    if(reg_value > 70)
    {
        return 1200 + 20 * (reg_value-70);
    }
    else
    {
         return 500 + 10 * reg_value;
    }
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dcdc4(int set_vol, int onoff)
{
    u8   reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 500)
		{
			set_vol = 500;
		}
		else if(set_vol > 1300)
		{
			set_vol = 1300;
		}

		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC4OUT_VOL, &reg_value))
	    {
	    	debug("%d\n", __LINE__);

	        return -1;
	    }
	    reg_value &= (~0x7f);
		 //dcdc4： 0.5v-1.2v  10mv/step   1.22v-1.3v  20mv/step
        if(set_vol > 1200)
        {
             reg_value |= (70+(set_vol - 1200)/20);
        }
        else
        {
            reg_value |= (set_vol - 500)/10;
        }
		if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DC4OUT_VOL, reg_value))
		{
			printf("sunxi pmu error : unable to set dcdc4\n");

			return -1;
		}
#if 0
        if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC4OUT_VOL, &reg_value))
	    {
	    	debug("%d\n", __LINE__);

	        return -1;
	    }
        printf("BOOT_POWER81X_DC4OUT_VOL=%d\n", reg_value);
#endif
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 3);
	}
	else
	{
		reg_value |=  (1 << 3);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, reg_value))
	{
		printf("sunxi pmu error : unable to onoff dcdc4\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_dcdc4(void)
{
    int vol;
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 3)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC4OUT_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x7f;
    //dcdc4： 0.5v-1.2v  10mv/step   1.22v-1.3v  20mv/step
    if(reg_value > 70)
    {
        return 1200 + 20 * (reg_value-70);
    }
    else
    {
         return 500 + 10 * reg_value;
    }

    return vol;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dcdc5(int set_vol, int onoff)
{
    u8   reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 800)
		{
			set_vol = 800;
		}
		else if(set_vol > 1840)
		{
			set_vol = 1840;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC5OUT_VOL, &reg_value))
	    {
	    	debug("%d\n", __LINE__);

	        return -1;
	    }
	    reg_value &= (~0x7f);
		//dcdc5： 0.8v-1.12v  10mv/step   1.12v-1.84v  20mv/step
        if(set_vol > 1120)
        {
             reg_value |= (32+(set_vol - 1120)/20);
        }
        else
        {
            reg_value |= (set_vol - 800)/10;
        }
		if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DC5OUT_VOL, reg_value))
		{
			printf("sunxi pmu error : unable to set dcdc5\n");

			return -1;
		}
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 4);
	}
	else
	{
		reg_value |=  (1 << 4);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, reg_value))
	{
		printf("sunxi pmu error : unable to onoff dcdc5\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_dcdc5(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 4)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC5OUT_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x7f;
    //dcdc5： 0.8v-1.12v  10mv/step   1.12v-1.84v  20mv/step
    if(reg_value > 32)
    {
        return 1120 + 20 * (reg_value-32);
    }
    else
    {
         return 800 + 10 * reg_value;
    }
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dcdc6(int set_vol, int onoff)
{
    u8   reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 600)
		{
			set_vol = 600;
		}
		else if(set_vol > 1520)
		{
			set_vol = 1520;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC6OUT_VOL, &reg_value))
	    {
	    	debug("%d\n", __LINE__);

	        return -1;
	    }
	    reg_value &= (~0x7f);
		//dcdc6： 0.6v-1.1v  10mv/step   1.12v-1.52v  20mv/step
        if(set_vol > 1100)
        {
             reg_value |= (50+(set_vol - 1100)/20);
        }
        else
        {
            reg_value |= (set_vol - 600)/10;
        }
		if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DC6OUT_VOL, reg_value))
		{
			printf("sunxi pmu error : unable to set dcdc5\n");

			return -1;
		}
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 5);
	}
	else
	{
		reg_value |=  (1 << 5);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, reg_value))
	{
		printf("sunxi pmu error : unable to onoff dcdc5\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_dcdc6(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL1, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x05 << 0)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DC6OUT_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x7f;
    //dcdc6： 0.6v-1.1v  10mv/step   1.12v-1.52v  20mv/step
    if(reg_value > 50)
    {
        return 1100 + 20 * (reg_value-50);
    }
    else
    {
         return 600 + 10 * reg_value;
    }
}

/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_aldo1(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 3300)
		{
			set_vol = 3300;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO1OUT_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
		reg_value |= ((set_vol - 700)/100);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ALDO1OUT_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set aldo1\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 5);
	}
	else
	{
		reg_value |=  (1 << 5);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, reg_value))
	{
		printf("sunxi pmu error : unable to onoff aldo1\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_aldo1(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 5)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO1OUT_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;

    return 700 + 100 * reg_value;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_aldo2(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 3300)
		{
			set_vol = 3300;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO2OUT_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
		reg_value |= ((set_vol - 700)/100);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ALDO2OUT_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set aldo2\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 6);
	}
	else
	{
		reg_value |=  (1 << 6);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, reg_value))
	{
		printf("sunxi pmu error : unable to onoff aldo2\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_aldo2(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 6)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO2OUT_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;

    return 700 + 100 * reg_value;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_aldo3(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 3300)
		{
			set_vol = 3300;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO3OUT_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
		reg_value |= ((set_vol - 700)/100);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ALDO3OUT_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set aldo3\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 7);
	}
	else
	{
		reg_value |=  (1 << 7);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, reg_value))
	{
		printf("sunxi pmu error : unable to onoff aldo3\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_aldo3(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 7)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO3OUT_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;

    return 700 + 100 * reg_value;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dldo1(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		
        if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 3300)
		{
			set_vol = 3300;
		}
        
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DLDO1_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
		reg_value |= ((set_vol-700)/100);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DLDO1_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set dldo1\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 3);
	}
	else
	{
		reg_value |=  (1 << 3);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, reg_value))
	{
		printf("sunxi pmu error : unable to onoff dldo1\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_dldo1(void)
{
    int vol;
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 3)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DLDO1_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;
    vol = 700 + 100 * reg_value;
 
    return vol;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dldo2(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{	
        if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 4200)
		{
			set_vol = 4200;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DLDO2_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
		//dldo： 0.7v-3.4v  100mv/step   3.4v-4.2v  200mv/step
        if(set_vol > 3400)
        {
            reg_value |= (27 + ((set_vol - 3400)/200));  //(3400-700)/100
        }
        else
        {
            reg_value |= ((set_vol - 700)/100);
        }
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DLDO2_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set dldo2\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 4);
	}
	else
	{
		reg_value |=  (1 << 4);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, reg_value))
	{
		printf("sunxi pmu error : unable to onoff dldo2\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_dldo2(void)
{
    u8  reg_value;
    int vol;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 4)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DLDO2_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;

    if(reg_value > 27)
       vol = 3400+(reg_value-27)*200;
   else 
       vol = 700 + 100 * reg_value;

    return vol;
}

/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dldo3(int set_vol, int onoff)
{
    u8 reg_value;

    if(set_vol > 0)
    {
        
        if(set_vol < 700)
        {
            set_vol = 700;
        }
        else if(set_vol > 3300)
        {
            set_vol = 3300;
        }
        
        if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DLDO3_VOL, &reg_value))
        {
            return -1;
        }
        reg_value &= 0xE0;
        reg_value |= ((set_vol-700)/100);
        if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DLDO3_VOL, reg_value))
        {
            printf("sunxi pmu error : unable to set dldo1\n");

            return -1;
        }
    }

    if(onoff < 0)
    {
        return 0;
    }
    if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
        return -1;
    }
    if(onoff == 0)
    {
        reg_value &= ~(1 << 5);
    }
    else
    {
        reg_value |=  (1 << 5);
    }
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, reg_value))
    {
        printf("sunxi pmu error : unable to onoff dldo1\n");

        return -1;
    }

    return 0;
}

static int axp81X_probe_dldo3(void)
{
    int vol;
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 5)))
    {
		return 0;
	}

    if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DLDO3_VOL, &reg_value))
    {
        return -1;
    }
    reg_value &= 0x1f;
    vol = 700 + 100 * reg_value;
 
    return vol;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_dldo4(int set_vol, int onoff)
{
    u8 reg_value;

    if(set_vol > 0)
    {
        
        if(set_vol < 700)
        {
            set_vol = 700;
        }
        else if(set_vol > 3300)
        {
            set_vol = 3300;
        }
        
        if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DLDO4_VOL, &reg_value))
        {
            return -1;
        }
        reg_value &= 0xE0;
        reg_value |= ((set_vol-700)/100);
        if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_DLDO4_VOL, reg_value))
        {
            printf("sunxi pmu error : unable to set dldo1\n");

            return -1;
        }
    }

    if(onoff < 0)
    {
        return 0;
    }
    if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
        return -1;
    }
    if(onoff == 0)
    {
        reg_value &= ~(1 << 6);
    }
    else
    {
        reg_value |=  (1 << 6);
    }
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, reg_value))
    {
        printf("sunxi pmu error : unable to onoff dldo1\n");

        return -1;
    }

    return 0;
}

static int axp81X_probe_dldo4(void)
{
    int vol;
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 6)))
    {
		return 0;
	}

    if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_DLDO4_VOL, &reg_value))
    {
        return -1;
    }
    reg_value &= 0x1f;
    vol = 700 + 100 * reg_value;
 
    return vol;
}


/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_eldo1(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 1900)
		{
			set_vol = 1900;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ELDO1_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
      
        reg_value |= ((set_vol - 700)/50);
       
		
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ELDO1_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set eldo1\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 0);
	}
	else
	{
		reg_value |=  (1 << 0);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, reg_value))
	{
		printf("sunxi pmu error : unable to onoff eldo1\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_eldo1(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 0)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ELDO1_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;

    return 700 + 50 * reg_value;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_eldo2(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 1900)
		{
			set_vol = 1900;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ELDO2_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
		reg_value |= ((set_vol - 700)/50);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ELDO2_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set eldo2\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 1);
	}
	else
	{
		reg_value |=  (1 << 1);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, reg_value))
	{
		printf("sunxi pmu error : unable to onoff eldo2\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_eldo2(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 1)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ELDO2_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;

    return 700 + 50 * reg_value;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_eldo3(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 1900)
		{
			set_vol = 1900;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ELDO3_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
		reg_value |= ((set_vol - 700)/50);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ELDO3_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set eldo3\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 2);
	}
	else
	{
		reg_value |=  (1 << 2);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, reg_value))
	{
		printf("sunxi pmu error : unable to onoff eldo3\n");

		return -1;
	}

	return 0;
}

static int axp81X_probe_eldo3(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_OUTPUT_CTL2, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 2)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ELDO3_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;

    return 700 + 50 * reg_value;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_fldo1(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 1450)
		{
			set_vol = 1450;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_FLDO1_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xF0;
		reg_value |= ((set_vol - 700)/50);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_FLDO1_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set fldo1\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 2);
	}
	else
	{
		reg_value |=  (1 << 2);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, reg_value))
	{
		printf("sunxi pmu error : unable to onoff fldo1\n");

		return -1;
	}

	return 0;
}
static int axp81X_probe_fldo1(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 2)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_FLDO1_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x0f;

    return 700 + 50 * reg_value;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_fldo2(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 1450)
		{
			set_vol = 1450;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_FLDO2_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xF0;
		reg_value |= ((set_vol - 700)/50);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_FLDO2_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set fldo2\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(1 << 3);
	}
	else
	{
		reg_value |=  (1 << 3);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, reg_value))
	{
		printf("sunxi pmu error : unable to onoff fldo2\n");

		return -1;
	}

	return 0;
}
static int axp81X_probe_fldo2(void)
{
    u8  reg_value;
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_ALDO_CTL, &reg_value))
    {
		return -1;
    }
    if(!(reg_value & (0x01 << 3)))
    {
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_FLDO2_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x0f;

    return 700 + 50 * reg_value;
}

/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_gpio0ldo(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 3300)
		{
			set_vol = 3300;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO0_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
		reg_value |= ((set_vol - 700)/100);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_GPIO0_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set gpio0ldo\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO0_CTL, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(7 << 0);
		reg_value |=  (4 << 0);
	}
	else
	{
		reg_value &= ~(7 << 0);
		reg_value |=  (3 << 0);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_GPIO0_CTL, reg_value))
	{
		printf("sunxi pmu error : unable to onoff gpio0ldo\n");

		return -1;
	}

	return 0;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_gpio1ldo(int set_vol, int onoff)
{
	u8 reg_value;

	if(set_vol > 0)
	{
		if(set_vol < 700)
		{
			set_vol = 700;
		}
		else if(set_vol > 3300)
		{
			set_vol = 3300;
		}
		if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO1_VOL, &reg_value))
	    {
	        return -1;
	    }
	    reg_value &= 0xE0;
		reg_value |= ((set_vol - 700)/100);
	    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_GPIO1_VOL, reg_value))
	    {
	    	printf("sunxi pmu error : unable to set gpio1ldo\n");

	        return -1;
	    }
	}

	if(onoff < 0)
	{
		return 0;
	}
	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO1_CTL, &reg_value))
    {
		return -1;
    }
	if(onoff == 0)
	{
		reg_value &= ~(7 << 0);
		reg_value |=  (4 << 0);
	}
	else
	{
		reg_value &= ~(7 << 0);
		reg_value |=  (3 << 0);
	}
    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_GPIO1_CTL, reg_value))
	{
		printf("sunxi pmu error : unable to onoff gpio1ldo\n");

		return -1;
	}

	return 0;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_probe_gpio0ldo(void)
{
    u8  reg_value;

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO0_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;
	return 700 + 100 * reg_value;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_probe_gpio1ldo(void)
{
    u8  reg_value;

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO1_VOL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x1f;
	return 700 + 100 * reg_value;
}

/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_gpio0(int level)
{
	u8 reg_value;

	if((level < 0) || (level > 1))
	{
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO0_CTL, &reg_value))
    {
		return -1;
    }

	if(level == 0)//drive low
	{
		reg_value &= ~(7 << 0);
	}
	else		//drive high
	{
		reg_value &= ~(7 << 0);
		reg_value |=  (1 << 0);
	}

    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_GPIO0_CTL, reg_value))
	{
		printf("sunxi pmu error : unable to level gpio0\n");

		return -1;
	}

	return 0;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_set_gpio1(int level)
{
	u8 reg_value;

	if((level < 0) || (level > 1))
	{
		return 0;
	}

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO1_CTL, &reg_value))
    {
		return -1;
    }

	if(level == 0)//drive low
	{
		reg_value &= ~(7 << 0);
	}
	else		//drive high
	{
		reg_value &= ~(7 << 0);
		reg_value |=  (1 << 0);
	}

    if(axp_i2c_write(AXP81X_ADDR, BOOT_POWER81X_GPIO1_CTL, reg_value))
	{
		printf("sunxi pmu error : unable to level gpio0\n");

		return -1;
	}

	return 0;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_probe_gpio0(void)
{
    u8  reg_value;

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO0_CTL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x07;
    if((reg_value == 0) || (reg_value == 1))
    {
		return reg_value;
	}

	return -1;
}
/*
************************************************************************************************************
*
*                                             function
*
*    函数名称：
*
*    参数列表：
*
*    返回值  ：
*
*    说明    ：
*
*
************************************************************************************************************
*/
static int axp81X_probe_gpio1(void)
{
    u8  reg_value;

	if(axp_i2c_read(AXP81X_ADDR, BOOT_POWER81X_GPIO1_CTL, &reg_value))
    {
		return -1;
    }
    reg_value &= 0x07;
    if((reg_value == 0) || (reg_value == 1))
    {
		return reg_value;
	}

	return -1;
}
/*
************************************************************************************************************
*
*                                             function
*
*    name          :
*
*    parmeters     :
*
*    return        :
*
*    note          :
*
*
************************************************************************************************************
*/
static int axp81X_set_dcdc_output(int sppply_index, int vol_value, int onoff)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_set_dcdc1(vol_value, onoff);
		case 2:
			return axp81X_set_dcdc2(vol_value, onoff);
		case 3:
			return axp81X_set_dcdc3(vol_value, onoff);
		case 4:
			return axp81X_set_dcdc4(vol_value, onoff);
		case 5:
			return axp81X_set_dcdc5(vol_value, onoff);
        case 6:
			return axp81X_set_dcdc6(vol_value, onoff);
	}

	return -1;
}

static int axp81X_set_aldo_output(int sppply_index, int vol_value, int onoff)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_set_aldo1(vol_value, onoff);
		case 2:
			return axp81X_set_aldo2(vol_value, onoff);
		case 3:
			return axp81X_set_aldo3(vol_value, onoff);
	}

	return -1;
}

static int axp81X_set_dldo_output(int sppply_index, int vol_value, int onoff)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_set_dldo1(vol_value, onoff);
		case 2:
			return axp81X_set_dldo2(vol_value, onoff);
        case 3:
			return axp81X_set_dldo3(vol_value, onoff);
		case 4:
			return axp81X_set_dldo4(vol_value, onoff);
	}

	return -1;
}

static int axp81X_set_eldo_output(int sppply_index, int vol_value, int onoff)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_set_eldo1(vol_value, onoff);
		case 2:
			return axp81X_set_eldo2(vol_value, onoff);
		case 3:
			return axp81X_set_eldo3(vol_value, onoff);
	}

	return -1;
}

static int axp81X_set_fldo_output(int sppply_index, int vol_value, int onoff)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_set_fldo1(vol_value, onoff);
		case 2:
			return axp81X_set_fldo2(vol_value, onoff);
	}

	return -1;
}

static int axp81X_set_gpioldo_output(int sppply_index, int vol_value, int onoff)
{
	switch(sppply_index)
	{
		case 0:
			return axp81X_set_gpio0ldo(vol_value, onoff);
		case 1:
			return axp81X_set_gpio1ldo(vol_value, onoff);
	}

	return -1;
}

static int axp81X_set_gpio_output(int sppply_index, int level)
{
	switch(sppply_index)
	{
		case 0:
			return axp81X_set_gpio0(level);
		case 1:
			return axp81X_set_gpio1(level);
	}
	return -1;
}

static int axp81X_set_misc_output(int sppply_index, int vol_value, int onoff)
{
	switch(sppply_index)
	{
		case PMU_SUPPLY_DC5LDO:
			return axp81X_set_dc5ldo(onoff);
		case PMU_SUPPLY_DC1SW:
			return axp81X_set_dc1sw(onoff);
	}

	return -1;
}


int axp81_set_supply_status(int vol_name, int vol_value, int onoff)
{
	int supply_type;
	int sppply_index;

	supply_type  = vol_name & 0xffff0000;
	sppply_index = vol_name & 0x0000ffff;

	switch(supply_type)
	{
		case PMU_SUPPLY_DCDC_TYPE:
			return axp81X_set_dcdc_output(sppply_index, vol_value, onoff);

		case PMU_SUPPLY_ALDO_TYPE:
			return axp81X_set_aldo_output(sppply_index, vol_value, onoff);

		case PMU_SUPPLY_ELDO_TYPE:
			return axp81X_set_eldo_output(sppply_index, vol_value, onoff);

		case PMU_SUPPLY_DLDO_TYPE:
			return axp81X_set_dldo_output(sppply_index, vol_value, onoff);

		case PMU_SUPPLY_GPIOLDO_TYPE:
			return axp81X_set_gpioldo_output(sppply_index, vol_value, onoff);

		case PMU_SUPPLY_MISC_TYPE:
			return axp81X_set_misc_output(vol_name, vol_value, onoff);

		case PMU_SUPPLY_GPIO_TYPE:
			return axp81X_set_gpio_output(sppply_index, onoff);

		default:
			return -1;
	}
}

int axp81_set_supply_status_byname(char *vol_name, int vol_value, int onoff)
{
	int sppply_index;

	if(!strncmp(vol_name, "dcdc", 4))
	{
		sppply_index = simple_strtoul(vol_name + 4, NULL, 10);

		return axp81X_set_dcdc_output(sppply_index, vol_value, onoff);
	}
	else if(!strncmp(vol_name, "aldo", 4))
	{
		sppply_index = simple_strtoul(vol_name + 4, NULL, 10);

		return axp81X_set_aldo_output(sppply_index, vol_value, onoff);
	}
	else if(!strncmp(vol_name, "eldo", 4))
	{
		sppply_index = simple_strtoul(vol_name + 4, NULL, 10);

		return axp81X_set_eldo_output(sppply_index, vol_value, onoff);
	}
	else if(!strncmp(vol_name, "fldo", 4))
	{
		sppply_index = simple_strtoul(vol_name + 4, NULL, 10);

		return axp81X_set_fldo_output(sppply_index, vol_value, onoff);
	}

	else if(!strncmp(vol_name, "dldo", 4))
	{
		sppply_index = simple_strtoul(vol_name + 4, NULL, 10);

		return axp81X_set_dldo_output(sppply_index, vol_value, onoff);
	}
	else if(!strncmp(vol_name, "gpio", 4))
	{
		sppply_index = simple_strtoul(vol_name + 4, NULL, 10);

		return axp81X_set_gpioldo_output(sppply_index, vol_value, onoff);
	}
	else if(!strncmp(vol_name, "dc5ldo", 6))
	{
		return axp81X_set_dc5ldo(onoff);
	}
	else if(!strncmp(vol_name, "dc1sw", 5))
	{
		return axp81X_set_dc1sw(onoff);
	}
	else if (!strncmp(vol_name, "power", 5))	//axp gpio used
	{
		sppply_index = simple_strtoul(vol_name + 5, NULL, 10);

		return axp81X_set_gpio_output(sppply_index, onoff);
	}

	return 0;
}

/*
************************************************************************************************************
*
*                                             function
*
*    name          :
*
*    parmeters     :
*
*    return        :
*
*    note          :
*
*
************************************************************************************************************
*/
static int axp81X_probe_dcdc_output(int sppply_index)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_probe_dcdc1();
		case 2:
			return axp81X_probe_dcdc2();
		case 3:
			return axp81X_probe_dcdc3();
		case 4:
			return axp81X_probe_dcdc4();
		case 5:
			return axp81X_probe_dcdc5();
        case 6:
			return axp81X_probe_dcdc6();
	}

	return -1;
}

static int axp81X_probe_aldo_output(int sppply_index)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_probe_aldo1();
		case 2:
			return axp81X_probe_aldo2();
		case 3:
			return axp81X_probe_aldo3();
	}

	return -1;
}

static int axp81X_probe_dldo_output(int sppply_index)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_probe_dldo1();
		case 2:
			return axp81X_probe_dldo2();
        case 3:
			return axp81X_probe_dldo3();
		case 4:
			return axp81X_probe_dldo4();
	}

	return -1;
}

static int axp81X_probe_eldo_output(int sppply_index)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_probe_eldo1();
		case 2:
			return axp81X_probe_eldo2();
		case 3:
			return axp81X_probe_eldo3();
	}

	return -1;
}
static int axp81X_probe_fldo_output(int sppply_index)
{
	switch(sppply_index)
	{
		case 1:
			return axp81X_probe_fldo1();
		case 2:
			return axp81X_probe_fldo2();
	}

	return -1;
}


static int axp81X_probe_gpioldo_output(int sppply_index)
{
	switch(sppply_index)
	{
		case 0:
			return axp81X_probe_gpio0ldo();
		case 1:
			return axp81X_probe_gpio1ldo();
	}

	return -1;
}

static int axp81X_probe_gpio_output(int sppply_index)
{
	switch(sppply_index)
	{
		case 0:
			return axp81X_probe_gpio0();
		case 1:
			return axp81X_probe_gpio1();
	}

	return -1;
}


int axp81_probe_supply_status(int vol_name, int vol_value, int onoff)
{
	return 0;
}

int axp81_probe_supply_status_byname(char *vol_name)
{
	int sppply_index;

	sppply_index = 1 + vol_name[4] - '1';

	if(!strncmp(vol_name, "dcdc", 4))
	{
		return axp81X_probe_dcdc_output(sppply_index);
	}
	else if(!strncmp(vol_name, "aldo", 4))
	{
		return axp81X_probe_aldo_output(sppply_index);
	}
	else if(!strncmp(vol_name, "dldo", 4))
	{
		return axp81X_probe_dldo_output(sppply_index);
	}
	else if(!strncmp(vol_name, "eldo", 4))
	{
		return axp81X_probe_eldo_output(sppply_index);
	}
	else if(!strncmp(vol_name, "fldo", 4))
	{
		return axp81X_probe_fldo_output(sppply_index);
	}

	//add by ljq 20140224
	else if(!strncmp(vol_name, "gpio", 4))
	{
		return axp81X_probe_gpioldo_output(sppply_index);
	}
	else if (!!strncmp(vol_name, "power", 5))
	{
		sppply_index = simple_strtoul(vol_name + 5, NULL, 10);
		return axp81X_probe_gpio_output(sppply_index);
	}
	return -1;
}