|  | /* | 
|  | * 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 | 
|  |  | 
|  | #define TPS65912_MAX_REG_ID	TPS65912_REG_LDO_10 | 
|  |  | 
|  | /* 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); | 
|  | 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"); |