| 
									
										
										
										
											2011-06-09 14:50:27 -05:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							| 
									
										
										
										
											2011-07-06 21:57:18 +03:00
										 |  |  | 	int reg; | 
					
						
							| 
									
										
										
										
											2011-06-09 14:50:27 -05:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	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], | 
					
						
							| 
									
										
										
										
											2011-11-18 16:47:19 +05:30
										 |  |  | 					tps65912->dev, reg_data, pmic, NULL); | 
					
						
							| 
									
										
										
										
											2011-06-09 14:50:27 -05:00
										 |  |  | 		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"); |