[people/ms/u-boot.git] / drivers / power / axp209.c

/*
 * (C) Copyright 2012
 * Henrik Nordstrom <henrik@henriknordstrom.net>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <command.h>
#include <asm/arch/pmic_bus.h>
#include <axp_pmic.h>

static u8 axp209_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_dcdc2(unsigned int mvolt)
{
	int rc;
	u8 cfg, current;

	if (mvolt == 0)
		return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
					AXP209_OUTPUT_CTRL_DCDC2);

	rc = pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_DCDC2);
	if (rc)
		return rc;

	cfg = axp209_mvolt_to_cfg(mvolt, 700, 2275, 25);

	/* Do we really need to be this gentle? It has built-in voltage slope */
	while ((rc = pmic_bus_read(AXP209_DCDC2_VOLTAGE, &current)) == 0 &&
	       current != cfg) {
		if (current < cfg)
			current++;
		else
			current--;

		rc = pmic_bus_write(AXP209_DCDC2_VOLTAGE, current);
		if (rc)
			break;
	}

	return rc;
}

int axp_set_dcdc3(unsigned int mvolt)
{
	u8 cfg = axp209_mvolt_to_cfg(mvolt, 700, 3500, 25);
	int rc;

	if (mvolt == 0)
		return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
					AXP209_OUTPUT_CTRL_DCDC3);

	rc = pmic_bus_write(AXP209_DCDC3_VOLTAGE, cfg);
	if (rc)
		return rc;

	return pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_DCDC3);
}

int axp_set_aldo2(unsigned int mvolt)
{
	int rc;
	u8 cfg, reg;

	if (mvolt == 0)
		return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
					AXP209_OUTPUT_CTRL_LDO2);

	cfg = axp209_mvolt_to_cfg(mvolt, 1800, 3300, 100);

	rc = pmic_bus_read(AXP209_LDO24_VOLTAGE, &reg);
	if (rc)
		return rc;

	/* LDO2 configuration is in upper 4 bits */
	reg = (reg & 0x0f) | (cfg << 4);
	rc = pmic_bus_write(AXP209_LDO24_VOLTAGE, reg);
	if (rc)
		return rc;

	return pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_LDO2);
}

int axp_set_aldo3(unsigned int mvolt)
{
	u8 cfg;
	int rc;

	if (mvolt == 0)
		return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
					AXP209_OUTPUT_CTRL_LDO3);

	if (mvolt == -1)
		cfg = 0x80;	/* determined by LDO3IN pin */
	else
		cfg = axp209_mvolt_to_cfg(mvolt, 700, 3500, 25);

	rc = pmic_bus_write(AXP209_LDO3_VOLTAGE, cfg);
	if (rc)
		return rc;

	return pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_LDO3);
}

int axp_set_aldo4(unsigned int mvolt)
{
	int rc;
	static const unsigned int vindex[] = {
		1250, 1300, 1400, 1500, 1600, 1700, 1800, 1900, 2000, 2500,
		2700, 2800, 3000, 3100, 3200, 3300
	};
	u8 cfg, reg;

	if (mvolt == 0)
		return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
					AXP209_OUTPUT_CTRL_LDO4);

	/* Translate mvolt to register cfg value, requested <= selected */
	for (cfg = 15; vindex[cfg] > mvolt && cfg > 0; cfg--);

	rc = pmic_bus_read(AXP209_LDO24_VOLTAGE, &reg);
	if (rc)
		return rc;

	/* LDO4 configuration is in lower 4 bits */
	reg = (reg & 0xf0) | (cfg << 0);
	rc = pmic_bus_write(AXP209_LDO24_VOLTAGE, reg);
	if (rc)
		return rc;

	return pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_LDO4);
}

int axp_init(void)
{
	u8 ver;
	int i, rc;

	rc = pmic_bus_init();
	if (rc)
		return rc;

	rc = pmic_bus_read(AXP209_CHIP_VERSION, &ver);
	if (rc)
		return rc;

	/* Low 4 bits is chip version */
	ver &= 0x0f;

	if (ver != 0x1)
		return -EINVAL;

	/* Mask all interrupts */
	for (i = AXP209_IRQ_ENABLE1; i <= AXP209_IRQ_ENABLE5; i++) {
		rc = pmic_bus_write(i, 0);
		if (rc)
			return rc;
	}

	/*
	 * Turn off LDOIO regulators / tri-state GPIO pins, when rebooting
	 * from android these are sometimes on.
	 */
	rc = pmic_bus_write(AXP_GPIO0_CTRL, AXP_GPIO_CTRL_INPUT);
	if (rc)
		return rc;

	rc = pmic_bus_write(AXP_GPIO1_CTRL, AXP_GPIO_CTRL_INPUT);
	if (rc)
		return rc;

	rc = pmic_bus_write(AXP_GPIO2_CTRL, AXP_GPIO_CTRL_INPUT);
	if (rc)
		return rc;

	return 0;
}

int do_poweroff(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
{
	pmic_bus_write(AXP209_SHUTDOWN, AXP209_POWEROFF);

	/* infinite loop during shutdown */
	while (1) {}

	/* not reached */
	return 0;
}
Commit	Line	Data
14bc66bd HN	1	/*
	2	* (C) Copyright 2012
	3	* Henrik Nordstrom <henrik@henriknordstrom.net>
	4	*
	5	* SPDX-License-Identifier: GPL-2.0+
	6	*/
	7
	8	#include <common.h>
467e92b3	9	#include <command.h>
30490b52	10	#include <asm/arch/pmic_bus.h>
6944aff1	11	#include <axp_pmic.h>
14bc66bd	12
14bc66bd HN	13	static u8 axp209_mvolt_to_cfg(int mvolt, int min, int max, int div)
	14	{
	15	if (mvolt < min)
	16	mvolt = min;
	17	else if (mvolt > max)
	18	mvolt = max;
	19
	20	return (mvolt - min) / div;
	21	}
	22
6944aff1	23	int axp_set_dcdc2(unsigned int mvolt)
14bc66bd HN	24	{
	25	int rc;
	26	u8 cfg, current;
	27
beba401f HG	28	if (mvolt == 0)
	29	return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
	30	AXP209_OUTPUT_CTRL_DCDC2);
	31
	32	rc = pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_DCDC2);
	33	if (rc)
	34	return rc;
	35
14bc66bd HN	36	cfg = axp209_mvolt_to_cfg(mvolt, 700, 2275, 25);
	37
	38	/* Do we really need to be this gentle? It has built-in voltage slope */
30490b52	39	while ((rc = pmic_bus_read(AXP209_DCDC2_VOLTAGE, &current)) == 0 &&
14bc66bd HN	40	current != cfg) {
	41	if (current < cfg)
	42	current++;
	43	else
	44	current--;
	45
30490b52	46	rc = pmic_bus_write(AXP209_DCDC2_VOLTAGE, current);
14bc66bd HN	47	if (rc)
	48	break;
	49	}
	50
	51	return rc;
	52	}
	53
6944aff1	54	int axp_set_dcdc3(unsigned int mvolt)
14bc66bd HN	55	{
14bc66bd HN	56	u8 cfg = axp209_mvolt_to_cfg(mvolt, 700, 3500, 25);
beba401f HG	57	int rc;
	58
	59	if (mvolt == 0)
	60	return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
	61	AXP209_OUTPUT_CTRL_DCDC3);
14bc66bd	62
beba401f HG	63	rc = pmic_bus_write(AXP209_DCDC3_VOLTAGE, cfg);
	64	if (rc)
	65	return rc;
	66
	67	return pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_DCDC3);
14bc66bd HN	68	}
14bc66bd HN	69
6944aff1	70	int axp_set_aldo2(unsigned int mvolt)
14bc66bd HN	71	{
	72	int rc;
	73	u8 cfg, reg;
	74
beba401f HG	75	if (mvolt == 0)
	76	return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
	77	AXP209_OUTPUT_CTRL_LDO2);
	78
14bc66bd HN	79	cfg = axp209_mvolt_to_cfg(mvolt, 1800, 3300, 100);
14bc66bd HN	80
30490b52	81	rc = pmic_bus_read(AXP209_LDO24_VOLTAGE, &reg);
14bc66bd HN	82	if (rc)
	83	return rc;
	84
	85	/* LDO2 configuration is in upper 4 bits */
	86	reg = (reg & 0x0f) \| (cfg << 4);
beba401f HG	87	rc = pmic_bus_write(AXP209_LDO24_VOLTAGE, reg);
	88	if (rc)
	89	return rc;
	90
	91	return pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_LDO2);
14bc66bd HN	92	}
14bc66bd HN	93
6944aff1	94	int axp_set_aldo3(unsigned int mvolt)
14bc66bd HN	95	{
14bc66bd HN	96	u8 cfg;
beba401f HG	97	int rc;
	98
	99	if (mvolt == 0)
	100	return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
	101	AXP209_OUTPUT_CTRL_LDO3);
14bc66bd HN	102
	103	if (mvolt == -1)
	104	cfg = 0x80; /* determined by LDO3IN pin */
	105	else
99deda1d	106	cfg = axp209_mvolt_to_cfg(mvolt, 700, 3500, 25);
14bc66bd	107
beba401f HG	108	rc = pmic_bus_write(AXP209_LDO3_VOLTAGE, cfg);
	109	if (rc)
	110	return rc;
	111
	112	return pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_LDO3);
14bc66bd HN	113	}
14bc66bd HN	114
6944aff1	115	int axp_set_aldo4(unsigned int mvolt)
14bc66bd HN	116	{
14bc66bd HN	117	int rc;
6944aff1	118	static const unsigned int vindex[] = {
14bc66bd HN	119	1250, 1300, 1400, 1500, 1600, 1700, 1800, 1900, 2000, 2500,
	120	2700, 2800, 3000, 3100, 3200, 3300
	121	};
	122	u8 cfg, reg;
	123
beba401f HG	124	if (mvolt == 0)
	125	return pmic_bus_clrbits(AXP209_OUTPUT_CTRL,
	126	AXP209_OUTPUT_CTRL_LDO4);
	127
14bc66bd HN	128	/* Translate mvolt to register cfg value, requested <= selected */
	129	for (cfg = 15; vindex[cfg] > mvolt && cfg > 0; cfg--);
	130
30490b52	131	rc = pmic_bus_read(AXP209_LDO24_VOLTAGE, &reg);
14bc66bd HN	132	if (rc)
	133	return rc;
	134
	135	/* LDO4 configuration is in lower 4 bits */
	136	reg = (reg & 0xf0) \| (cfg << 0);
beba401f HG	137	rc = pmic_bus_write(AXP209_LDO24_VOLTAGE, reg);
	138	if (rc)
	139	return rc;
	140
	141	return pmic_bus_setbits(AXP209_OUTPUT_CTRL, AXP209_OUTPUT_CTRL_LDO4);
14bc66bd HN	142	}
14bc66bd HN	143
6944aff1	144	int axp_init(void)
14bc66bd HN	145	{
14bc66bd HN	146	u8 ver;
9dcf68fa	147	int i, rc;
14bc66bd	148
30490b52 HG	149	rc = pmic_bus_init();
	150	if (rc)
	151	return rc;
	152
	153	rc = pmic_bus_read(AXP209_CHIP_VERSION, &ver);
14bc66bd HN	154	if (rc)
	155	return rc;
	156
	157	/* Low 4 bits is chip version */
	158	ver &= 0x0f;
	159
	160	if (ver != 0x1)
505cf475	161	return -EINVAL;
14bc66bd	162
9dcf68fa HG	163	/* Mask all interrupts */
9dcf68fa HG	164	for (i = AXP209_IRQ_ENABLE1; i <= AXP209_IRQ_ENABLE5; i++) {
30490b52	165	rc = pmic_bus_write(i, 0);
9dcf68fa HG	166	if (rc)
	167	return rc;
	168	}
	169
253e62bf HG	170	/*
	171	* Turn off LDOIO regulators / tri-state GPIO pins, when rebooting
	172	* from android these are sometimes on.
	173	*/
	174	rc = pmic_bus_write(AXP_GPIO0_CTRL, AXP_GPIO_CTRL_INPUT);
	175	if (rc)
	176	return rc;
	177
	178	rc = pmic_bus_write(AXP_GPIO1_CTRL, AXP_GPIO_CTRL_INPUT);
	179	if (rc)
	180	return rc;
	181
	182	rc = pmic_bus_write(AXP_GPIO2_CTRL, AXP_GPIO_CTRL_INPUT);
	183	if (rc)
	184	return rc;
	185
14bc66bd HN	186	return 0;
14bc66bd HN	187	}
467e92b3 MS	188
	189	int do_poweroff(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
	190	{
	191	pmic_bus_write(AXP209_SHUTDOWN, AXP209_POWEROFF);
	192
	193	/* infinite loop during shutdown */
	194	while (1) {}
	195
	196	/* not reached */
	197	return 0;
	198	}