 2c043bcbf2
			
		
	
	
	2c043bcbf2
	
	
	
		
			
			With device tree support for regulators, its needed that the regulator_dev->dev device has the right of_node attached. To be able to do this add an additional parameter to the regulator_register() api, wherein the dt-adapted driver can then pass this additional info onto the regulator core. Signed-off-by: Rajendra Nayak <rnayak@ti.com> Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
		
			
				
	
	
		
			798 lines
		
	
	
	
		
			18 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			798 lines
		
	
	
	
		
			18 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * tps65912.c  --  TI tps65912
 | |
|  *
 | |
|  * Copyright 2011 Texas Instruments Inc.
 | |
|  *
 | |
|  * Author: Margarita Olaya Cabrera <magi@slimlogic.co.uk>
 | |
|  *
 | |
|  *  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 driver is based on wm8350 implementation.
 | |
|  */
 | |
| 
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/err.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <linux/regulator/driver.h>
 | |
| #include <linux/regulator/machine.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/gpio.h>
 | |
| #include <linux/mfd/tps65912.h>
 | |
| 
 | |
| /* DCDC's */
 | |
| #define TPS65912_REG_DCDC1	0
 | |
| #define TPS65912_REG_DCDC2	1
 | |
| #define TPS65912_REG_DCDC3	2
 | |
| #define TPS65912_REG_DCDC4	3
 | |
| 
 | |
| /* LDOs */
 | |
| #define TPS65912_REG_LDO1	4
 | |
| #define TPS65912_REG_LDO2	5
 | |
| #define TPS65912_REG_LDO3	6
 | |
| #define TPS65912_REG_LDO4	7
 | |
| #define TPS65912_REG_LDO5	8
 | |
| #define TPS65912_REG_LDO6	9
 | |
| #define TPS65912_REG_LDO7	10
 | |
| #define TPS65912_REG_LDO8	11
 | |
| #define TPS65912_REG_LDO9	12
 | |
| #define TPS65912_REG_LDO10	13
 | |
| 
 | |
| /* Number of step-down converters available */
 | |
| #define TPS65912_NUM_DCDC	4
 | |
| 
 | |
| /* Number of LDO voltage regulators  available */
 | |
| #define TPS65912_NUM_LDO	10
 | |
| 
 | |
| /* Number of total regulators available */
 | |
| #define TPS65912_NUM_REGULATOR		(TPS65912_NUM_DCDC + TPS65912_NUM_LDO)
 | |
| 
 | |
| #define TPS65912_REG_ENABLED	0x80
 | |
| #define OP_SELREG_MASK		0x40
 | |
| #define OP_SELREG_SHIFT		6
 | |
| 
 | |
| struct tps_info {
 | |
| 	const char *name;
 | |
| };
 | |
| 
 | |
| static struct tps_info tps65912_regs[] = {
 | |
| 	{
 | |
| 		.name = "DCDC1",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "DCDC2",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "DCDC3",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "DCDC4",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO1",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO2",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO3",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO4",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO5",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO6",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO7",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO8",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO9",
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "LDO10",
 | |
| 	},
 | |
| };
 | |
| 
 | |
| struct tps65912_reg {
 | |
| 	struct regulator_desc desc[TPS65912_NUM_REGULATOR];
 | |
| 	struct tps65912 *mfd;
 | |
| 	struct regulator_dev *rdev[TPS65912_NUM_REGULATOR];
 | |
| 	struct tps_info *info[TPS65912_NUM_REGULATOR];
 | |
| 	/* for read/write access */
 | |
| 	struct mutex io_lock;
 | |
| 	int mode;
 | |
| 	int (*get_ctrl_reg)(int);
 | |
| 	int dcdc1_range;
 | |
| 	int dcdc2_range;
 | |
| 	int dcdc3_range;
 | |
| 	int dcdc4_range;
 | |
| 	int pwm_mode_reg;
 | |
| 	int eco_reg;
 | |
| };
 | |
| 
 | |
| static int tps65912_get_range(struct tps65912_reg *pmic, int id)
 | |
| {
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 
 | |
| 	if (id > TPS65912_REG_DCDC4)
 | |
| 		return 0;
 | |
| 
 | |
| 	switch (id) {
 | |
| 	case TPS65912_REG_DCDC1:
 | |
| 		pmic->dcdc1_range = tps65912_reg_read(mfd,
 | |
| 							TPS65912_DCDC1_LIMIT);
 | |
| 		if (pmic->dcdc1_range < 0)
 | |
| 			return pmic->dcdc1_range;
 | |
| 		pmic->dcdc1_range = (pmic->dcdc1_range &
 | |
| 			DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
 | |
| 		return pmic->dcdc1_range;
 | |
| 	case TPS65912_REG_DCDC2:
 | |
| 		pmic->dcdc2_range = tps65912_reg_read(mfd,
 | |
| 							TPS65912_DCDC2_LIMIT);
 | |
| 		if (pmic->dcdc2_range < 0)
 | |
| 			return pmic->dcdc2_range;
 | |
| 		pmic->dcdc2_range = (pmic->dcdc2_range &
 | |
| 			DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
 | |
| 		return pmic->dcdc2_range;
 | |
| 	case TPS65912_REG_DCDC3:
 | |
| 		pmic->dcdc3_range = tps65912_reg_read(mfd,
 | |
| 							TPS65912_DCDC3_LIMIT);
 | |
| 		if (pmic->dcdc3_range < 0)
 | |
| 			return pmic->dcdc3_range;
 | |
| 		pmic->dcdc3_range = (pmic->dcdc3_range &
 | |
| 			DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
 | |
| 		return pmic->dcdc3_range;
 | |
| 	case TPS65912_REG_DCDC4:
 | |
| 		pmic->dcdc4_range = tps65912_reg_read(mfd,
 | |
| 							TPS65912_DCDC4_LIMIT);
 | |
| 		if (pmic->dcdc4_range < 0)
 | |
| 			return pmic->dcdc4_range;
 | |
| 		pmic->dcdc4_range = (pmic->dcdc4_range &
 | |
| 			DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
 | |
| 		return pmic->dcdc4_range;
 | |
| 	default:
 | |
| 		return 0;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static unsigned long tps65912_vsel_to_uv_range0(u8 vsel)
 | |
| {
 | |
| 	unsigned long uv;
 | |
| 
 | |
| 	uv = ((vsel * 12500) + 500000);
 | |
| 	return uv;
 | |
| }
 | |
| 
 | |
| static unsigned long tps65912_vsel_to_uv_range1(u8 vsel)
 | |
| {
 | |
| 	unsigned long uv;
 | |
| 
 | |
| 	 uv = ((vsel * 12500) + 700000);
 | |
| 	return uv;
 | |
| }
 | |
| 
 | |
| static unsigned long tps65912_vsel_to_uv_range2(u8 vsel)
 | |
| {
 | |
| 	unsigned long uv;
 | |
| 
 | |
| 	uv = ((vsel * 25000) + 500000);
 | |
| 	return uv;
 | |
| }
 | |
| 
 | |
| static unsigned long tps65912_vsel_to_uv_range3(u8 vsel)
 | |
| {
 | |
| 	unsigned long uv;
 | |
| 
 | |
| 	if (vsel == 0x3f)
 | |
| 		uv = 3800000;
 | |
| 	else
 | |
| 		uv = ((vsel * 50000) + 500000);
 | |
| 
 | |
| 	return uv;
 | |
| }
 | |
| 
 | |
| static unsigned long tps65912_vsel_to_uv_ldo(u8 vsel)
 | |
| {
 | |
| 	unsigned long uv = 0;
 | |
| 
 | |
| 	if (vsel <= 32)
 | |
| 		uv = ((vsel * 25000) + 800000);
 | |
| 	else if (vsel > 32 && vsel <= 60)
 | |
| 		uv = (((vsel - 32) * 50000) + 1600000);
 | |
| 	else if (vsel > 60)
 | |
| 		uv = (((vsel - 60) * 100000) + 3000000);
 | |
| 
 | |
| 	return uv;
 | |
| }
 | |
| 
 | |
| static int tps65912_get_ctrl_register(int id)
 | |
| {
 | |
| 	switch (id) {
 | |
| 	case TPS65912_REG_DCDC1:
 | |
| 		return TPS65912_DCDC1_AVS;
 | |
| 	case TPS65912_REG_DCDC2:
 | |
| 		return TPS65912_DCDC2_AVS;
 | |
| 	case TPS65912_REG_DCDC3:
 | |
| 		return TPS65912_DCDC3_AVS;
 | |
| 	case TPS65912_REG_DCDC4:
 | |
| 		return TPS65912_DCDC4_AVS;
 | |
| 	case TPS65912_REG_LDO1:
 | |
| 		return TPS65912_LDO1_AVS;
 | |
| 	case TPS65912_REG_LDO2:
 | |
| 		return TPS65912_LDO2_AVS;
 | |
| 	case TPS65912_REG_LDO3:
 | |
| 		return TPS65912_LDO3_AVS;
 | |
| 	case TPS65912_REG_LDO4:
 | |
| 		return TPS65912_LDO4_AVS;
 | |
| 	case TPS65912_REG_LDO5:
 | |
| 		return TPS65912_LDO5;
 | |
| 	case TPS65912_REG_LDO6:
 | |
| 		return TPS65912_LDO6;
 | |
| 	case TPS65912_REG_LDO7:
 | |
| 		return TPS65912_LDO7;
 | |
| 	case TPS65912_REG_LDO8:
 | |
| 		return TPS65912_LDO8;
 | |
| 	case TPS65912_REG_LDO9:
 | |
| 		return TPS65912_LDO9;
 | |
| 	case TPS65912_REG_LDO10:
 | |
| 		return TPS65912_LDO10;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int tps65912_get_dcdc_sel_register(struct tps65912_reg *pmic, int id)
 | |
| {
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int opvsel = 0, sr = 0;
 | |
| 	u8 reg = 0;
 | |
| 
 | |
| 	if (id < TPS65912_REG_DCDC1 || id > TPS65912_REG_DCDC4)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	switch (id) {
 | |
| 	case TPS65912_REG_DCDC1:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_DCDC1_OP);
 | |
| 		sr = ((opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT);
 | |
| 		if (sr)
 | |
| 			reg = TPS65912_DCDC1_AVS;
 | |
| 		else
 | |
| 			reg = TPS65912_DCDC1_OP;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC2:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_DCDC2_OP);
 | |
| 		sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
 | |
| 		if (sr)
 | |
| 			reg = TPS65912_DCDC2_AVS;
 | |
| 		else
 | |
| 			reg = TPS65912_DCDC2_OP;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC3:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_DCDC3_OP);
 | |
| 		sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
 | |
| 		if (sr)
 | |
| 			reg = TPS65912_DCDC3_AVS;
 | |
| 		else
 | |
| 			reg = TPS65912_DCDC3_OP;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC4:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_DCDC4_OP);
 | |
| 		sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
 | |
| 		if (sr)
 | |
| 			reg = TPS65912_DCDC4_AVS;
 | |
| 		else
 | |
| 			reg = TPS65912_DCDC4_OP;
 | |
| 		break;
 | |
| 	}
 | |
| 	return reg;
 | |
| }
 | |
| 
 | |
| static int tps65912_get_ldo_sel_register(struct tps65912_reg *pmic, int id)
 | |
| {
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int opvsel = 0, sr = 0;
 | |
| 	u8 reg = 0;
 | |
| 
 | |
| 	if (id < TPS65912_REG_LDO1 || id > TPS65912_REG_LDO10)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	switch (id) {
 | |
| 	case TPS65912_REG_LDO1:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_LDO1_OP);
 | |
| 		sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
 | |
| 		if (sr)
 | |
| 			reg = TPS65912_LDO1_AVS;
 | |
| 		else
 | |
| 			reg = TPS65912_LDO1_OP;
 | |
| 		break;
 | |
| 	case TPS65912_REG_LDO2:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_LDO2_OP);
 | |
| 		sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
 | |
| 		if (sr)
 | |
| 			reg = TPS65912_LDO2_AVS;
 | |
| 		else
 | |
| 			reg = TPS65912_LDO2_OP;
 | |
| 		break;
 | |
| 	case TPS65912_REG_LDO3:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_LDO3_OP);
 | |
| 		sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
 | |
| 		if (sr)
 | |
| 			reg = TPS65912_LDO3_AVS;
 | |
| 		else
 | |
| 			reg = TPS65912_LDO3_OP;
 | |
| 		break;
 | |
| 	case TPS65912_REG_LDO4:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_LDO4_OP);
 | |
| 		sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
 | |
| 		if (sr)
 | |
| 			reg = TPS65912_LDO4_AVS;
 | |
| 		else
 | |
| 			reg = TPS65912_LDO4_OP;
 | |
| 		break;
 | |
| 	case TPS65912_REG_LDO5:
 | |
| 		reg = TPS65912_LDO5;
 | |
| 		break;
 | |
| 	case TPS65912_REG_LDO6:
 | |
| 		reg = TPS65912_LDO6;
 | |
| 		break;
 | |
| 	case TPS65912_REG_LDO7:
 | |
| 		reg = TPS65912_LDO7;
 | |
| 		break;
 | |
| 	case TPS65912_REG_LDO8:
 | |
| 		reg = TPS65912_LDO8;
 | |
| 		break;
 | |
| 	case TPS65912_REG_LDO9:
 | |
| 		reg = TPS65912_LDO9;
 | |
| 		break;
 | |
| 	case TPS65912_REG_LDO10:
 | |
| 		reg = TPS65912_LDO10;
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	return reg;
 | |
| }
 | |
| 
 | |
| static int tps65912_get_mode_regiters(struct tps65912_reg *pmic, int id)
 | |
| {
 | |
| 	switch (id) {
 | |
| 	case TPS65912_REG_DCDC1:
 | |
| 		pmic->pwm_mode_reg = TPS65912_DCDC1_CTRL;
 | |
| 		pmic->eco_reg = TPS65912_DCDC1_AVS;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC2:
 | |
| 		pmic->pwm_mode_reg = TPS65912_DCDC2_CTRL;
 | |
| 		pmic->eco_reg = TPS65912_DCDC2_AVS;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC3:
 | |
| 		pmic->pwm_mode_reg = TPS65912_DCDC3_CTRL;
 | |
| 		pmic->eco_reg = TPS65912_DCDC3_AVS;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC4:
 | |
| 		pmic->pwm_mode_reg = TPS65912_DCDC4_CTRL;
 | |
| 		pmic->eco_reg = TPS65912_DCDC4_AVS;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int tps65912_reg_is_enabled(struct regulator_dev *dev)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int reg, value, id = rdev_get_id(dev);
 | |
| 
 | |
| 	if (id < TPS65912_REG_DCDC1 || id > TPS65912_REG_LDO10)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	reg = pmic->get_ctrl_reg(id);
 | |
| 	if (reg < 0)
 | |
| 		return reg;
 | |
| 
 | |
| 	value = tps65912_reg_read(mfd, reg);
 | |
| 	if (value < 0)
 | |
| 		return value;
 | |
| 
 | |
| 	return value & TPS65912_REG_ENABLED;
 | |
| }
 | |
| 
 | |
| static int tps65912_reg_enable(struct regulator_dev *dev)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int id = rdev_get_id(dev);
 | |
| 	int reg;
 | |
| 
 | |
| 	if (id < TPS65912_REG_DCDC1 || id > TPS65912_REG_LDO10)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	reg = pmic->get_ctrl_reg(id);
 | |
| 	if (reg < 0)
 | |
| 		return reg;
 | |
| 
 | |
| 	return tps65912_set_bits(mfd, reg, TPS65912_REG_ENABLED);
 | |
| }
 | |
| 
 | |
| static int tps65912_reg_disable(struct regulator_dev *dev)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int id = rdev_get_id(dev), reg;
 | |
| 
 | |
| 	reg = pmic->get_ctrl_reg(id);
 | |
| 	if (reg < 0)
 | |
| 		return reg;
 | |
| 
 | |
| 	return tps65912_clear_bits(mfd, reg, TPS65912_REG_ENABLED);
 | |
| }
 | |
| 
 | |
| static int tps65912_set_mode(struct regulator_dev *dev, unsigned int mode)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int pwm_mode, eco, id = rdev_get_id(dev);
 | |
| 
 | |
| 	tps65912_get_mode_regiters(pmic, id);
 | |
| 
 | |
| 	pwm_mode = tps65912_reg_read(mfd, pmic->pwm_mode_reg);
 | |
| 	eco = tps65912_reg_read(mfd, pmic->eco_reg);
 | |
| 
 | |
| 	pwm_mode &= DCDCCTRL_DCDC_MODE_MASK;
 | |
| 	eco &= DCDC_AVS_ECO_MASK;
 | |
| 
 | |
| 	switch (mode) {
 | |
| 	case REGULATOR_MODE_FAST:
 | |
| 		/* Verify if mode alredy set */
 | |
| 		if (pwm_mode && !eco)
 | |
| 			break;
 | |
| 		tps65912_set_bits(mfd, pmic->pwm_mode_reg, DCDCCTRL_DCDC_MODE_MASK);
 | |
| 		tps65912_clear_bits(mfd, pmic->eco_reg, DCDC_AVS_ECO_MASK);
 | |
| 		break;
 | |
| 	case REGULATOR_MODE_NORMAL:
 | |
| 	case REGULATOR_MODE_IDLE:
 | |
| 		if (!pwm_mode && !eco)
 | |
| 			break;
 | |
| 		tps65912_clear_bits(mfd, pmic->pwm_mode_reg, DCDCCTRL_DCDC_MODE_MASK);
 | |
| 		tps65912_clear_bits(mfd, pmic->eco_reg, DCDC_AVS_ECO_MASK);
 | |
| 		break;
 | |
| 	case REGULATOR_MODE_STANDBY:
 | |
| 		if (!pwm_mode && eco)
 | |
| 			break;
 | |
| 		tps65912_clear_bits(mfd, pmic->pwm_mode_reg, DCDCCTRL_DCDC_MODE_MASK);
 | |
| 		tps65912_set_bits(mfd, pmic->eco_reg, DCDC_AVS_ECO_MASK);
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static unsigned int tps65912_get_mode(struct regulator_dev *dev)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int pwm_mode, eco, mode = 0, id = rdev_get_id(dev);
 | |
| 
 | |
| 	tps65912_get_mode_regiters(pmic, id);
 | |
| 
 | |
| 	pwm_mode = tps65912_reg_read(mfd, pmic->pwm_mode_reg);
 | |
| 	eco = tps65912_reg_read(mfd, pmic->eco_reg);
 | |
| 
 | |
| 	pwm_mode &= DCDCCTRL_DCDC_MODE_MASK;
 | |
| 	eco &= DCDC_AVS_ECO_MASK;
 | |
| 
 | |
| 	if (pwm_mode && !eco)
 | |
| 		mode = REGULATOR_MODE_FAST;
 | |
| 	else if (!pwm_mode && !eco)
 | |
| 		mode = REGULATOR_MODE_NORMAL;
 | |
| 	else if (!pwm_mode && eco)
 | |
| 		mode = REGULATOR_MODE_STANDBY;
 | |
| 
 | |
| 	return mode;
 | |
| }
 | |
| 
 | |
| static int tps65912_get_voltage_dcdc(struct regulator_dev *dev)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int id = rdev_get_id(dev), voltage = 0, range;
 | |
| 	int opvsel = 0, avsel = 0, sr, vsel;
 | |
| 
 | |
| 	switch (id) {
 | |
| 	case TPS65912_REG_DCDC1:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_DCDC1_OP);
 | |
| 		avsel = tps65912_reg_read(mfd, TPS65912_DCDC1_AVS);
 | |
| 		range = pmic->dcdc1_range;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC2:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_DCDC2_OP);
 | |
| 		avsel = tps65912_reg_read(mfd, TPS65912_DCDC2_AVS);
 | |
| 		range = pmic->dcdc2_range;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC3:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_DCDC3_OP);
 | |
| 		avsel = tps65912_reg_read(mfd, TPS65912_DCDC3_AVS);
 | |
| 		range = pmic->dcdc3_range;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC4:
 | |
| 		opvsel = tps65912_reg_read(mfd, TPS65912_DCDC4_OP);
 | |
| 		avsel = tps65912_reg_read(mfd, TPS65912_DCDC4_AVS);
 | |
| 		range = pmic->dcdc4_range;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
 | |
| 	if (sr)
 | |
| 		vsel = avsel;
 | |
| 	else
 | |
| 		vsel = opvsel;
 | |
| 	vsel &= 0x3F;
 | |
| 
 | |
| 	switch (range) {
 | |
| 	case 0:
 | |
| 		/* 0.5 - 1.2875V in 12.5mV steps */
 | |
| 		voltage = tps65912_vsel_to_uv_range0(vsel);
 | |
| 		break;
 | |
| 	case 1:
 | |
| 		/* 0.7 - 1.4875V in 12.5mV steps */
 | |
| 		voltage = tps65912_vsel_to_uv_range1(vsel);
 | |
| 		break;
 | |
| 	case 2:
 | |
| 		/* 0.5 - 2.075V in 25mV steps */
 | |
| 		voltage = tps65912_vsel_to_uv_range2(vsel);
 | |
| 		break;
 | |
| 	case 3:
 | |
| 		/* 0.5 - 3.8V in 50mV steps */
 | |
| 		voltage = tps65912_vsel_to_uv_range3(vsel);
 | |
| 		break;
 | |
| 	}
 | |
| 	return voltage;
 | |
| }
 | |
| 
 | |
| static int tps65912_set_voltage_dcdc(struct regulator_dev *dev,
 | |
| 						unsigned selector)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int id = rdev_get_id(dev);
 | |
| 	int value;
 | |
| 	u8 reg;
 | |
| 
 | |
| 	reg = tps65912_get_dcdc_sel_register(pmic, id);
 | |
| 	value = tps65912_reg_read(mfd, reg);
 | |
| 	value &= 0xC0;
 | |
| 	return tps65912_reg_write(mfd, reg, selector | value);
 | |
| }
 | |
| 
 | |
| static int tps65912_get_voltage_ldo(struct regulator_dev *dev)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int id = rdev_get_id(dev);
 | |
| 	int vsel = 0;
 | |
| 	u8 reg;
 | |
| 
 | |
| 	reg = tps65912_get_ldo_sel_register(pmic, id);
 | |
| 	vsel = tps65912_reg_read(mfd, reg);
 | |
| 	vsel &= 0x3F;
 | |
| 
 | |
| 	return tps65912_vsel_to_uv_ldo(vsel);
 | |
| }
 | |
| 
 | |
| static int tps65912_set_voltage_ldo(struct regulator_dev *dev,
 | |
| 						unsigned selector)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	struct tps65912 *mfd = pmic->mfd;
 | |
| 	int id = rdev_get_id(dev), reg, value;
 | |
| 
 | |
| 	reg = tps65912_get_ldo_sel_register(pmic, id);
 | |
| 	value = tps65912_reg_read(mfd, reg);
 | |
| 	value &= 0xC0;
 | |
| 	return tps65912_reg_write(mfd, reg, selector | value);
 | |
| }
 | |
| 
 | |
| static int tps65912_list_voltage_dcdc(struct regulator_dev *dev,
 | |
| 					unsigned selector)
 | |
| {
 | |
| 	struct tps65912_reg *pmic = rdev_get_drvdata(dev);
 | |
| 	int range, voltage = 0, id = rdev_get_id(dev);
 | |
| 
 | |
| 	switch (id) {
 | |
| 	case TPS65912_REG_DCDC1:
 | |
| 		range = pmic->dcdc1_range;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC2:
 | |
| 		range = pmic->dcdc2_range;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC3:
 | |
| 		range = pmic->dcdc3_range;
 | |
| 		break;
 | |
| 	case TPS65912_REG_DCDC4:
 | |
| 		range = pmic->dcdc4_range;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	switch (range) {
 | |
| 	case 0:
 | |
| 		/* 0.5 - 1.2875V in 12.5mV steps */
 | |
| 		voltage = tps65912_vsel_to_uv_range0(selector);
 | |
| 		break;
 | |
| 	case 1:
 | |
| 		/* 0.7 - 1.4875V in 12.5mV steps */
 | |
| 		voltage = tps65912_vsel_to_uv_range1(selector);
 | |
| 		break;
 | |
| 	case 2:
 | |
| 		/* 0.5 - 2.075V in 25mV steps */
 | |
| 		voltage = tps65912_vsel_to_uv_range2(selector);
 | |
| 		break;
 | |
| 	case 3:
 | |
| 		/* 0.5 - 3.8V in 50mV steps */
 | |
| 		voltage = tps65912_vsel_to_uv_range3(selector);
 | |
| 		break;
 | |
| 	}
 | |
| 	return voltage;
 | |
| }
 | |
| 
 | |
| static int tps65912_list_voltage_ldo(struct regulator_dev *dev,
 | |
| 					unsigned selector)
 | |
| {
 | |
| 	int ldo = rdev_get_id(dev);
 | |
| 
 | |
| 	if (ldo < TPS65912_REG_LDO1 || ldo > TPS65912_REG_LDO10)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	return tps65912_vsel_to_uv_ldo(selector);
 | |
| }
 | |
| 
 | |
| /* Operations permitted on DCDCx */
 | |
| static struct regulator_ops tps65912_ops_dcdc = {
 | |
| 	.is_enabled = tps65912_reg_is_enabled,
 | |
| 	.enable = tps65912_reg_enable,
 | |
| 	.disable = tps65912_reg_disable,
 | |
| 	.set_mode = tps65912_set_mode,
 | |
| 	.get_mode = tps65912_get_mode,
 | |
| 	.get_voltage = tps65912_get_voltage_dcdc,
 | |
| 	.set_voltage_sel = tps65912_set_voltage_dcdc,
 | |
| 	.list_voltage = tps65912_list_voltage_dcdc,
 | |
| };
 | |
| 
 | |
| /* Operations permitted on LDOx */
 | |
| static struct regulator_ops tps65912_ops_ldo = {
 | |
| 	.is_enabled = tps65912_reg_is_enabled,
 | |
| 	.enable = tps65912_reg_enable,
 | |
| 	.disable = tps65912_reg_disable,
 | |
| 	.get_voltage = tps65912_get_voltage_ldo,
 | |
| 	.set_voltage_sel = tps65912_set_voltage_ldo,
 | |
| 	.list_voltage = tps65912_list_voltage_ldo,
 | |
| };
 | |
| 
 | |
| static __devinit int tps65912_probe(struct platform_device *pdev)
 | |
| {
 | |
| 	struct tps65912 *tps65912 = dev_get_drvdata(pdev->dev.parent);
 | |
| 	struct tps_info *info;
 | |
| 	struct regulator_init_data *reg_data;
 | |
| 	struct regulator_dev *rdev;
 | |
| 	struct tps65912_reg *pmic;
 | |
| 	struct tps65912_board *pmic_plat_data;
 | |
| 	int i, err;
 | |
| 
 | |
| 	pmic_plat_data = dev_get_platdata(tps65912->dev);
 | |
| 	if (!pmic_plat_data)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	reg_data = pmic_plat_data->tps65912_pmic_init_data;
 | |
| 
 | |
| 	pmic = kzalloc(sizeof(*pmic), GFP_KERNEL);
 | |
| 	if (!pmic)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	mutex_init(&pmic->io_lock);
 | |
| 	pmic->mfd = tps65912;
 | |
| 	platform_set_drvdata(pdev, pmic);
 | |
| 
 | |
| 	pmic->get_ctrl_reg = &tps65912_get_ctrl_register;
 | |
| 	info = tps65912_regs;
 | |
| 
 | |
| 	for (i = 0; i < TPS65912_NUM_REGULATOR; i++, info++, reg_data++) {
 | |
| 		int range = 0;
 | |
| 		/* Register the regulators */
 | |
| 		pmic->info[i] = info;
 | |
| 
 | |
| 		pmic->desc[i].name = info->name;
 | |
| 		pmic->desc[i].id = i;
 | |
| 		pmic->desc[i].n_voltages = 64;
 | |
| 		pmic->desc[i].ops = (i > TPS65912_REG_DCDC4 ?
 | |
| 			&tps65912_ops_ldo : &tps65912_ops_dcdc);
 | |
| 		pmic->desc[i].type = REGULATOR_VOLTAGE;
 | |
| 		pmic->desc[i].owner = THIS_MODULE;
 | |
| 		range = tps65912_get_range(pmic, i);
 | |
| 		rdev = regulator_register(&pmic->desc[i],
 | |
| 					tps65912->dev, reg_data, pmic, NULL);
 | |
| 		if (IS_ERR(rdev)) {
 | |
| 			dev_err(tps65912->dev,
 | |
| 				"failed to register %s regulator\n",
 | |
| 				pdev->name);
 | |
| 			err = PTR_ERR(rdev);
 | |
| 			goto err;
 | |
| 		}
 | |
| 
 | |
| 		/* Save regulator for cleanup */
 | |
| 		pmic->rdev[i] = rdev;
 | |
| 	}
 | |
| 	return 0;
 | |
| 
 | |
| err:
 | |
| 	while (--i >= 0)
 | |
| 		regulator_unregister(pmic->rdev[i]);
 | |
| 
 | |
| 	kfree(pmic);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int __devexit tps65912_remove(struct platform_device *pdev)
 | |
| {
 | |
| 	struct tps65912_reg *tps65912_reg = platform_get_drvdata(pdev);
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < TPS65912_NUM_REGULATOR; i++)
 | |
| 		regulator_unregister(tps65912_reg->rdev[i]);
 | |
| 
 | |
| 	kfree(tps65912_reg);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static struct platform_driver tps65912_driver = {
 | |
| 	.driver = {
 | |
| 		.name = "tps65912-pmic",
 | |
| 		.owner = THIS_MODULE,
 | |
| 	},
 | |
| 	.probe = tps65912_probe,
 | |
| 	.remove = __devexit_p(tps65912_remove),
 | |
| };
 | |
| 
 | |
| /**
 | |
|  * tps65912_init
 | |
|  *
 | |
|  * Module init function
 | |
|  */
 | |
| static int __init tps65912_init(void)
 | |
| {
 | |
| 	return platform_driver_register(&tps65912_driver);
 | |
| }
 | |
| subsys_initcall(tps65912_init);
 | |
| 
 | |
| /**
 | |
|  * tps65912_cleanup
 | |
|  *
 | |
|  * Module exit function
 | |
|  */
 | |
| static void __exit tps65912_cleanup(void)
 | |
| {
 | |
| 	platform_driver_unregister(&tps65912_driver);
 | |
| }
 | |
| module_exit(tps65912_cleanup);
 | |
| 
 | |
| MODULE_AUTHOR("Margarita Olaya Cabrera <magi@slimlogic.co.uk>");
 | |
| MODULE_DESCRIPTION("TPS65912 voltage regulator driver");
 | |
| MODULE_LICENSE("GPL v2");
 | |
| MODULE_ALIAS("platform:tps65912-pmic");
 |