| /* | 
 |  * drivers/regulator/ab3100.c | 
 |  * | 
 |  * Copyright (C) 2008-2009 ST-Ericsson AB | 
 |  * License terms: GNU General Public License (GPL) version 2 | 
 |  * Low-level control of the AB3100 IC Low Dropout (LDO) | 
 |  * regulators, external regulator and buck converter | 
 |  * Author: Mattias Wallin <mattias.wallin@stericsson.com> | 
 |  * Author: Linus Walleij <linus.walleij@stericsson.com> | 
 |  */ | 
 |  | 
 | #include <linux/module.h> | 
 | #include <linux/kernel.h> | 
 | #include <linux/init.h> | 
 | #include <linux/err.h> | 
 | #include <linux/platform_device.h> | 
 | #include <linux/regulator/driver.h> | 
 | #include <linux/mfd/ab3100.h> | 
 | #include <linux/mfd/abx500.h> | 
 | #include <linux/of.h> | 
 | #include <linux/regulator/of_regulator.h> | 
 |  | 
 | /* LDO registers and some handy masking definitions for AB3100 */ | 
 | #define AB3100_LDO_A		0x40 | 
 | #define AB3100_LDO_C		0x41 | 
 | #define AB3100_LDO_D		0x42 | 
 | #define AB3100_LDO_E		0x43 | 
 | #define AB3100_LDO_E_SLEEP	0x44 | 
 | #define AB3100_LDO_F		0x45 | 
 | #define AB3100_LDO_G		0x46 | 
 | #define AB3100_LDO_H		0x47 | 
 | #define AB3100_LDO_H_SLEEP_MODE	0 | 
 | #define AB3100_LDO_H_SLEEP_EN	2 | 
 | #define AB3100_LDO_ON		4 | 
 | #define AB3100_LDO_H_VSEL_AC	5 | 
 | #define AB3100_LDO_K		0x48 | 
 | #define AB3100_LDO_EXT		0x49 | 
 | #define AB3100_BUCK		0x4A | 
 | #define AB3100_BUCK_SLEEP	0x4B | 
 | #define AB3100_REG_ON_MASK	0x10 | 
 |  | 
 | /** | 
 |  * struct ab3100_regulator | 
 |  * A struct passed around the individual regulator functions | 
 |  * @platform_device: platform device holding this regulator | 
 |  * @dev: handle to the device | 
 |  * @plfdata: AB3100 platform data passed in at probe time | 
 |  * @regreg: regulator register number in the AB3100 | 
 |  */ | 
 | struct ab3100_regulator { | 
 | 	struct regulator_dev *rdev; | 
 | 	struct device *dev; | 
 | 	struct ab3100_platform_data *plfdata; | 
 | 	u8 regreg; | 
 | }; | 
 |  | 
 | /* The order in which registers are initialized */ | 
 | static const u8 ab3100_reg_init_order[AB3100_NUM_REGULATORS+2] = { | 
 | 	AB3100_LDO_A, | 
 | 	AB3100_LDO_C, | 
 | 	AB3100_LDO_E, | 
 | 	AB3100_LDO_E_SLEEP, | 
 | 	AB3100_LDO_F, | 
 | 	AB3100_LDO_G, | 
 | 	AB3100_LDO_H, | 
 | 	AB3100_LDO_K, | 
 | 	AB3100_LDO_EXT, | 
 | 	AB3100_BUCK, | 
 | 	AB3100_BUCK_SLEEP, | 
 | 	AB3100_LDO_D, | 
 | }; | 
 |  | 
 | /* Preset (hardware defined) voltages for these regulators */ | 
 | #define LDO_A_VOLTAGE 2750000 | 
 | #define LDO_C_VOLTAGE 2650000 | 
 | #define LDO_D_VOLTAGE 2650000 | 
 |  | 
 | static const unsigned int ldo_e_buck_typ_voltages[] = { | 
 | 	1800000, | 
 | 	1400000, | 
 | 	1300000, | 
 | 	1200000, | 
 | 	1100000, | 
 | 	1050000, | 
 | 	900000, | 
 | }; | 
 |  | 
 | static const unsigned int ldo_f_typ_voltages[] = { | 
 | 	1800000, | 
 | 	1400000, | 
 | 	1300000, | 
 | 	1200000, | 
 | 	1100000, | 
 | 	1050000, | 
 | 	2500000, | 
 | 	2650000, | 
 | }; | 
 |  | 
 | static const unsigned int ldo_g_typ_voltages[] = { | 
 | 	2850000, | 
 | 	2750000, | 
 | 	1800000, | 
 | 	1500000, | 
 | }; | 
 |  | 
 | static const unsigned int ldo_h_typ_voltages[] = { | 
 | 	2750000, | 
 | 	1800000, | 
 | 	1500000, | 
 | 	1200000, | 
 | }; | 
 |  | 
 | static const unsigned int ldo_k_typ_voltages[] = { | 
 | 	2750000, | 
 | 	1800000, | 
 | }; | 
 |  | 
 |  | 
 | /* The regulator devices */ | 
 | static struct ab3100_regulator | 
 | ab3100_regulators[AB3100_NUM_REGULATORS] = { | 
 | 	{ | 
 | 		.regreg = AB3100_LDO_A, | 
 | 	}, | 
 | 	{ | 
 | 		.regreg = AB3100_LDO_C, | 
 | 	}, | 
 | 	{ | 
 | 		.regreg = AB3100_LDO_D, | 
 | 	}, | 
 | 	{ | 
 | 		.regreg = AB3100_LDO_E, | 
 | 	}, | 
 | 	{ | 
 | 		.regreg = AB3100_LDO_F, | 
 | 	}, | 
 | 	{ | 
 | 		.regreg = AB3100_LDO_G, | 
 | 	}, | 
 | 	{ | 
 | 		.regreg = AB3100_LDO_H, | 
 | 	}, | 
 | 	{ | 
 | 		.regreg = AB3100_LDO_K, | 
 | 	}, | 
 | 	{ | 
 | 		.regreg = AB3100_LDO_EXT, | 
 | 		/* No voltages for the external regulator */ | 
 | 	}, | 
 | 	{ | 
 | 		.regreg = AB3100_BUCK, | 
 | 	}, | 
 | }; | 
 |  | 
 | /* | 
 |  * General functions for enable, disable and is_enabled used for | 
 |  * LDO: A,C,E,F,G,H,K,EXT and BUCK | 
 |  */ | 
 | static int ab3100_enable_regulator(struct regulator_dev *reg) | 
 | { | 
 | 	struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | 
 | 	int err; | 
 | 	u8 regval; | 
 |  | 
 | 	err = abx500_get_register_interruptible(abreg->dev, 0, abreg->regreg, | 
 | 						®val); | 
 | 	if (err) { | 
 | 		dev_warn(®->dev, "failed to get regid %d value\n", | 
 | 			 abreg->regreg); | 
 | 		return err; | 
 | 	} | 
 |  | 
 | 	/* The regulator is already on, no reason to go further */ | 
 | 	if (regval & AB3100_REG_ON_MASK) | 
 | 		return 0; | 
 |  | 
 | 	regval |= AB3100_REG_ON_MASK; | 
 |  | 
 | 	err = abx500_set_register_interruptible(abreg->dev, 0, abreg->regreg, | 
 | 						regval); | 
 | 	if (err) { | 
 | 		dev_warn(®->dev, "failed to set regid %d value\n", | 
 | 			 abreg->regreg); | 
 | 		return err; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int ab3100_disable_regulator(struct regulator_dev *reg) | 
 | { | 
 | 	struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | 
 | 	int err; | 
 | 	u8 regval; | 
 |  | 
 | 	/* | 
 | 	 * LDO D is a special regulator. When it is disabled, the entire | 
 | 	 * system is shut down. So this is handled specially. | 
 | 	 */ | 
 | 	pr_info("Called ab3100_disable_regulator\n"); | 
 | 	if (abreg->regreg == AB3100_LDO_D) { | 
 | 		dev_info(®->dev, "disabling LDO D - shut down system\n"); | 
 | 		/* Setting LDO D to 0x00 cuts the power to the SoC */ | 
 | 		return abx500_set_register_interruptible(abreg->dev, 0, | 
 | 							 AB3100_LDO_D, 0x00U); | 
 | 	} | 
 |  | 
 | 	/* | 
 | 	 * All other regulators are handled here | 
 | 	 */ | 
 | 	err = abx500_get_register_interruptible(abreg->dev, 0, abreg->regreg, | 
 | 						®val); | 
 | 	if (err) { | 
 | 		dev_err(®->dev, "unable to get register 0x%x\n", | 
 | 			abreg->regreg); | 
 | 		return err; | 
 | 	} | 
 | 	regval &= ~AB3100_REG_ON_MASK; | 
 | 	return abx500_set_register_interruptible(abreg->dev, 0, abreg->regreg, | 
 | 						 regval); | 
 | } | 
 |  | 
 | static int ab3100_is_enabled_regulator(struct regulator_dev *reg) | 
 | { | 
 | 	struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | 
 | 	u8 regval; | 
 | 	int err; | 
 |  | 
 | 	err = abx500_get_register_interruptible(abreg->dev, 0, abreg->regreg, | 
 | 						®val); | 
 | 	if (err) { | 
 | 		dev_err(®->dev, "unable to get register 0x%x\n", | 
 | 			abreg->regreg); | 
 | 		return err; | 
 | 	} | 
 |  | 
 | 	return regval & AB3100_REG_ON_MASK; | 
 | } | 
 |  | 
 | static int ab3100_get_voltage_regulator(struct regulator_dev *reg) | 
 | { | 
 | 	struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | 
 | 	u8 regval; | 
 | 	int err; | 
 |  | 
 | 	/* | 
 | 	 * For variable types, read out setting and index into | 
 | 	 * supplied voltage list. | 
 | 	 */ | 
 | 	err = abx500_get_register_interruptible(abreg->dev, 0, | 
 | 						abreg->regreg, ®val); | 
 | 	if (err) { | 
 | 		dev_warn(®->dev, | 
 | 			 "failed to get regulator value in register %02x\n", | 
 | 			 abreg->regreg); | 
 | 		return err; | 
 | 	} | 
 |  | 
 | 	/* The 3 highest bits index voltages */ | 
 | 	regval &= 0xE0; | 
 | 	regval >>= 5; | 
 |  | 
 | 	if (regval >= reg->desc->n_voltages) { | 
 | 		dev_err(®->dev, | 
 | 			"regulator register %02x contains an illegal voltage setting\n", | 
 | 			abreg->regreg); | 
 | 		return -EINVAL; | 
 | 	} | 
 |  | 
 | 	return reg->desc->volt_table[regval]; | 
 | } | 
 |  | 
 | static int ab3100_set_voltage_regulator_sel(struct regulator_dev *reg, | 
 | 					    unsigned selector) | 
 | { | 
 | 	struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | 
 | 	u8 regval; | 
 | 	int err; | 
 |  | 
 | 	err = abx500_get_register_interruptible(abreg->dev, 0, | 
 | 						abreg->regreg, ®val); | 
 | 	if (err) { | 
 | 		dev_warn(®->dev, | 
 | 			 "failed to get regulator register %02x\n", | 
 | 			 abreg->regreg); | 
 | 		return err; | 
 | 	} | 
 |  | 
 | 	/* The highest three bits control the variable regulators */ | 
 | 	regval &= ~0xE0; | 
 | 	regval |= (selector << 5); | 
 |  | 
 | 	err = abx500_set_register_interruptible(abreg->dev, 0, | 
 | 						abreg->regreg, regval); | 
 | 	if (err) | 
 | 		dev_warn(®->dev, "failed to set regulator register %02x\n", | 
 | 			abreg->regreg); | 
 |  | 
 | 	return err; | 
 | } | 
 |  | 
 | static int ab3100_set_suspend_voltage_regulator(struct regulator_dev *reg, | 
 | 						int uV) | 
 | { | 
 | 	struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | 
 | 	u8 regval; | 
 | 	int err; | 
 | 	int bestindex; | 
 | 	u8 targetreg; | 
 |  | 
 | 	if (abreg->regreg == AB3100_LDO_E) | 
 | 		targetreg = AB3100_LDO_E_SLEEP; | 
 | 	else if (abreg->regreg == AB3100_BUCK) | 
 | 		targetreg = AB3100_BUCK_SLEEP; | 
 | 	else | 
 | 		return -EINVAL; | 
 |  | 
 | 	/* LDO E and BUCK have special suspend voltages you can set */ | 
 | 	bestindex = regulator_map_voltage_iterate(reg, uV, uV); | 
 |  | 
 | 	err = abx500_get_register_interruptible(abreg->dev, 0, | 
 | 						targetreg, ®val); | 
 | 	if (err) { | 
 | 		dev_warn(®->dev, | 
 | 			 "failed to get regulator register %02x\n", | 
 | 			 targetreg); | 
 | 		return err; | 
 | 	} | 
 |  | 
 | 	/* The highest three bits control the variable regulators */ | 
 | 	regval &= ~0xE0; | 
 | 	regval |= (bestindex << 5); | 
 |  | 
 | 	err = abx500_set_register_interruptible(abreg->dev, 0, | 
 | 						targetreg, regval); | 
 | 	if (err) | 
 | 		dev_warn(®->dev, "failed to set regulator register %02x\n", | 
 | 			abreg->regreg); | 
 |  | 
 | 	return err; | 
 | } | 
 |  | 
 | /* | 
 |  * The external regulator can just define a fixed voltage. | 
 |  */ | 
 | static int ab3100_get_voltage_regulator_external(struct regulator_dev *reg) | 
 | { | 
 | 	struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | 
 |  | 
 | 	if (abreg->plfdata) | 
 | 		return abreg->plfdata->external_voltage; | 
 | 	else | 
 | 		/* TODO: encode external voltage into device tree */ | 
 | 		return 0; | 
 | } | 
 |  | 
 | static struct regulator_ops regulator_ops_fixed = { | 
 | 	.list_voltage = regulator_list_voltage_linear, | 
 | 	.enable      = ab3100_enable_regulator, | 
 | 	.disable     = ab3100_disable_regulator, | 
 | 	.is_enabled  = ab3100_is_enabled_regulator, | 
 | }; | 
 |  | 
 | static struct regulator_ops regulator_ops_variable = { | 
 | 	.enable      = ab3100_enable_regulator, | 
 | 	.disable     = ab3100_disable_regulator, | 
 | 	.is_enabled  = ab3100_is_enabled_regulator, | 
 | 	.get_voltage = ab3100_get_voltage_regulator, | 
 | 	.set_voltage_sel = ab3100_set_voltage_regulator_sel, | 
 | 	.list_voltage = regulator_list_voltage_table, | 
 | }; | 
 |  | 
 | static struct regulator_ops regulator_ops_variable_sleepable = { | 
 | 	.enable      = ab3100_enable_regulator, | 
 | 	.disable     = ab3100_disable_regulator, | 
 | 	.is_enabled  = ab3100_is_enabled_regulator, | 
 | 	.get_voltage = ab3100_get_voltage_regulator, | 
 | 	.set_voltage_sel = ab3100_set_voltage_regulator_sel, | 
 | 	.set_suspend_voltage = ab3100_set_suspend_voltage_regulator, | 
 | 	.list_voltage = regulator_list_voltage_table, | 
 | }; | 
 |  | 
 | /* | 
 |  * LDO EXT is an external regulator so it is really | 
 |  * not possible to set any voltage locally here, AB3100 | 
 |  * is an on/off switch plain an simple. The external | 
 |  * voltage is defined in the board set-up if any. | 
 |  */ | 
 | static struct regulator_ops regulator_ops_external = { | 
 | 	.enable      = ab3100_enable_regulator, | 
 | 	.disable     = ab3100_disable_regulator, | 
 | 	.is_enabled  = ab3100_is_enabled_regulator, | 
 | 	.get_voltage = ab3100_get_voltage_regulator_external, | 
 | }; | 
 |  | 
 | static struct regulator_desc | 
 | ab3100_regulator_desc[AB3100_NUM_REGULATORS] = { | 
 | 	{ | 
 | 		.name = "LDO_A", | 
 | 		.id   = AB3100_LDO_A, | 
 | 		.ops  = ®ulator_ops_fixed, | 
 | 		.n_voltages = 1, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 		.min_uV = LDO_A_VOLTAGE, | 
 | 		.enable_time = 200, | 
 | 	}, | 
 | 	{ | 
 | 		.name = "LDO_C", | 
 | 		.id   = AB3100_LDO_C, | 
 | 		.ops  = ®ulator_ops_fixed, | 
 | 		.n_voltages = 1, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 		.min_uV = LDO_C_VOLTAGE, | 
 | 		.enable_time = 200, | 
 | 	}, | 
 | 	{ | 
 | 		.name = "LDO_D", | 
 | 		.id   = AB3100_LDO_D, | 
 | 		.ops  = ®ulator_ops_fixed, | 
 | 		.n_voltages = 1, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 		.min_uV = LDO_D_VOLTAGE, | 
 | 		.enable_time = 200, | 
 | 	}, | 
 | 	{ | 
 | 		.name = "LDO_E", | 
 | 		.id   = AB3100_LDO_E, | 
 | 		.ops  = ®ulator_ops_variable_sleepable, | 
 | 		.n_voltages = ARRAY_SIZE(ldo_e_buck_typ_voltages), | 
 | 		.volt_table = ldo_e_buck_typ_voltages, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 		.enable_time = 200, | 
 | 	}, | 
 | 	{ | 
 | 		.name = "LDO_F", | 
 | 		.id   = AB3100_LDO_F, | 
 | 		.ops  = ®ulator_ops_variable, | 
 | 		.n_voltages = ARRAY_SIZE(ldo_f_typ_voltages), | 
 | 		.volt_table = ldo_f_typ_voltages, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 		.enable_time = 600, | 
 | 	}, | 
 | 	{ | 
 | 		.name = "LDO_G", | 
 | 		.id   = AB3100_LDO_G, | 
 | 		.ops  = ®ulator_ops_variable, | 
 | 		.n_voltages = ARRAY_SIZE(ldo_g_typ_voltages), | 
 | 		.volt_table = ldo_g_typ_voltages, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 		.enable_time = 400, | 
 | 	}, | 
 | 	{ | 
 | 		.name = "LDO_H", | 
 | 		.id   = AB3100_LDO_H, | 
 | 		.ops  = ®ulator_ops_variable, | 
 | 		.n_voltages = ARRAY_SIZE(ldo_h_typ_voltages), | 
 | 		.volt_table = ldo_h_typ_voltages, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 		.enable_time = 200, | 
 | 	}, | 
 | 	{ | 
 | 		.name = "LDO_K", | 
 | 		.id   = AB3100_LDO_K, | 
 | 		.ops  = ®ulator_ops_variable, | 
 | 		.n_voltages = ARRAY_SIZE(ldo_k_typ_voltages), | 
 | 		.volt_table = ldo_k_typ_voltages, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 		.enable_time = 200, | 
 | 	}, | 
 | 	{ | 
 | 		.name = "LDO_EXT", | 
 | 		.id   = AB3100_LDO_EXT, | 
 | 		.ops  = ®ulator_ops_external, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 	}, | 
 | 	{ | 
 | 		.name = "BUCK", | 
 | 		.id   = AB3100_BUCK, | 
 | 		.ops  = ®ulator_ops_variable_sleepable, | 
 | 		.n_voltages = ARRAY_SIZE(ldo_e_buck_typ_voltages), | 
 | 		.volt_table = ldo_e_buck_typ_voltages, | 
 | 		.type = REGULATOR_VOLTAGE, | 
 | 		.owner = THIS_MODULE, | 
 | 		.enable_time = 1000, | 
 | 	}, | 
 | }; | 
 |  | 
 | static int ab3100_regulator_register(struct platform_device *pdev, | 
 | 				     struct ab3100_platform_data *plfdata, | 
 | 				     struct regulator_init_data *init_data, | 
 | 				     struct device_node *np, | 
 | 				     unsigned long id) | 
 | { | 
 | 	struct regulator_desc *desc; | 
 | 	struct ab3100_regulator *reg; | 
 | 	struct regulator_dev *rdev; | 
 | 	struct regulator_config config = { }; | 
 | 	int err, i; | 
 |  | 
 | 	for (i = 0; i < AB3100_NUM_REGULATORS; i++) { | 
 | 		desc = &ab3100_regulator_desc[i]; | 
 | 		if (desc->id == id) | 
 | 			break; | 
 | 	} | 
 | 	if (desc->id != id) | 
 | 		return -ENODEV; | 
 |  | 
 | 	/* Same index used for this array */ | 
 | 	reg = &ab3100_regulators[i]; | 
 |  | 
 | 	/* | 
 | 	 * Initialize per-regulator struct. | 
 | 	 * Inherit platform data, this comes down from the | 
 | 	 * i2c boarddata, from the machine. So if you want to | 
 | 	 * see what it looks like for a certain machine, go | 
 | 	 * into the machine I2C setup. | 
 | 	 */ | 
 | 	reg->dev = &pdev->dev; | 
 | 	if (plfdata) { | 
 | 		reg->plfdata = plfdata; | 
 | 		config.init_data = &plfdata->reg_constraints[i]; | 
 | 	} else if (np) { | 
 | 		config.of_node = np; | 
 | 		config.init_data = init_data; | 
 | 	} | 
 | 	config.dev = &pdev->dev; | 
 | 	config.driver_data = reg; | 
 |  | 
 | 	rdev = devm_regulator_register(&pdev->dev, desc, &config); | 
 | 	if (IS_ERR(rdev)) { | 
 | 		err = PTR_ERR(rdev); | 
 | 		dev_err(&pdev->dev, | 
 | 			"%s: failed to register regulator %s err %d\n", | 
 | 			__func__, desc->name, | 
 | 			err); | 
 | 		return err; | 
 | 	} | 
 |  | 
 | 	/* Then set a pointer back to the registered regulator */ | 
 | 	reg->rdev = rdev; | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct of_regulator_match ab3100_regulator_matches[] = { | 
 | 	{ .name = "ab3100_ldo_a", .driver_data = (void *) AB3100_LDO_A, }, | 
 | 	{ .name = "ab3100_ldo_c", .driver_data = (void *) AB3100_LDO_C, }, | 
 | 	{ .name = "ab3100_ldo_d", .driver_data = (void *) AB3100_LDO_D, }, | 
 | 	{ .name = "ab3100_ldo_e", .driver_data = (void *) AB3100_LDO_E, }, | 
 | 	{ .name = "ab3100_ldo_f", .driver_data = (void *) AB3100_LDO_F }, | 
 | 	{ .name = "ab3100_ldo_g", .driver_data = (void *) AB3100_LDO_G }, | 
 | 	{ .name = "ab3100_ldo_h", .driver_data = (void *) AB3100_LDO_H }, | 
 | 	{ .name = "ab3100_ldo_k", .driver_data = (void *) AB3100_LDO_K }, | 
 | 	{ .name = "ab3100_ext", .driver_data = (void *) AB3100_LDO_EXT }, | 
 | 	{ .name = "ab3100_buck", .driver_data = (void *) AB3100_BUCK }, | 
 | }; | 
 |  | 
 | /* | 
 |  * Initial settings of ab3100 registers. | 
 |  * Common for below LDO regulator settings are that | 
 |  * bit 7-5 controls voltage. Bit 4 turns regulator ON(1) or OFF(0). | 
 |  * Bit 3-2 controls sleep enable and bit 1-0 controls sleep mode. | 
 |  */ | 
 | /* LDO_A 0x16: 2.75V, ON, SLEEP_A, SLEEP OFF GND */ | 
 | #define LDO_A_SETTING		0x16 | 
 | /* LDO_C 0x10: 2.65V, ON, SLEEP_A or B, SLEEP full power */ | 
 | #define LDO_C_SETTING		0x10 | 
 | /* LDO_D 0x10: 2.65V, ON, sleep mode not used */ | 
 | #define LDO_D_SETTING		0x10 | 
 | /* LDO_E 0x10: 1.8V, ON, SLEEP_A or B, SLEEP full power */ | 
 | #define LDO_E_SETTING		0x10 | 
 | /* LDO_E SLEEP 0x00: 1.8V, not used, SLEEP_A or B, not used */ | 
 | #define LDO_E_SLEEP_SETTING	0x00 | 
 | /* LDO_F 0xD0: 2.5V, ON, SLEEP_A or B, SLEEP full power */ | 
 | #define LDO_F_SETTING		0xD0 | 
 | /* LDO_G 0x00: 2.85V, OFF, SLEEP_A or B, SLEEP full power */ | 
 | #define LDO_G_SETTING		0x00 | 
 | /* LDO_H 0x18: 2.75V, ON, SLEEP_B, SLEEP full power */ | 
 | #define LDO_H_SETTING		0x18 | 
 | /* LDO_K 0x00: 2.75V, OFF, SLEEP_A or B, SLEEP full power */ | 
 | #define LDO_K_SETTING		0x00 | 
 | /* LDO_EXT 0x00: Voltage not set, OFF, not used, not used */ | 
 | #define LDO_EXT_SETTING		0x00 | 
 | /* BUCK 0x7D: 1.2V, ON, SLEEP_A and B, SLEEP low power */ | 
 | #define BUCK_SETTING	0x7D | 
 | /* BUCK SLEEP 0xAC: 1.05V, Not used, SLEEP_A and B, Not used */ | 
 | #define BUCK_SLEEP_SETTING	0xAC | 
 |  | 
 | static const u8 ab3100_reg_initvals[] = { | 
 | 	LDO_A_SETTING, | 
 | 	LDO_C_SETTING, | 
 | 	LDO_E_SETTING, | 
 | 	LDO_E_SLEEP_SETTING, | 
 | 	LDO_F_SETTING, | 
 | 	LDO_G_SETTING, | 
 | 	LDO_H_SETTING, | 
 | 	LDO_K_SETTING, | 
 | 	LDO_EXT_SETTING, | 
 | 	BUCK_SETTING, | 
 | 	BUCK_SLEEP_SETTING, | 
 | 	LDO_D_SETTING, | 
 | }; | 
 |  | 
 | static int ab3100_regulators_remove(struct platform_device *pdev) | 
 | { | 
 | 	int i; | 
 |  | 
 | 	for (i = 0; i < AB3100_NUM_REGULATORS; i++) { | 
 | 		struct ab3100_regulator *reg = &ab3100_regulators[i]; | 
 |  | 
 | 		reg->rdev = NULL; | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int | 
 | ab3100_regulator_of_probe(struct platform_device *pdev, struct device_node *np) | 
 | { | 
 | 	int err, i; | 
 |  | 
 | 	/* | 
 | 	 * Set up the regulator registers, as was previously done with | 
 | 	 * platform data. | 
 | 	 */ | 
 | 	/* Set up regulators */ | 
 | 	for (i = 0; i < ARRAY_SIZE(ab3100_reg_init_order); i++) { | 
 | 		err = abx500_set_register_interruptible(&pdev->dev, 0, | 
 | 					ab3100_reg_init_order[i], | 
 | 					ab3100_reg_initvals[i]); | 
 | 		if (err) { | 
 | 			dev_err(&pdev->dev, "regulator initialization failed with error %d\n", | 
 | 				err); | 
 | 			return err; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	for (i = 0; i < ARRAY_SIZE(ab3100_regulator_matches); i++) { | 
 | 		err = ab3100_regulator_register( | 
 | 			pdev, NULL, ab3100_regulator_matches[i].init_data, | 
 | 			ab3100_regulator_matches[i].of_node, | 
 | 			(unsigned long)ab3100_regulator_matches[i].driver_data); | 
 | 		if (err) { | 
 | 			ab3100_regulators_remove(pdev); | 
 | 			return err; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 |  | 
 | static int ab3100_regulators_probe(struct platform_device *pdev) | 
 | { | 
 | 	struct ab3100_platform_data *plfdata = dev_get_platdata(&pdev->dev); | 
 | 	struct device_node *np = pdev->dev.of_node; | 
 | 	int err = 0; | 
 | 	u8 data; | 
 | 	int i; | 
 |  | 
 | 	/* Check chip state */ | 
 | 	err = abx500_get_register_interruptible(&pdev->dev, 0, | 
 | 						AB3100_LDO_D, &data); | 
 | 	if (err) { | 
 | 		dev_err(&pdev->dev, "could not read initial status of LDO_D\n"); | 
 | 		return err; | 
 | 	} | 
 | 	if (data & 0x10) | 
 | 		dev_notice(&pdev->dev, | 
 | 			   "chip is already in active mode (Warm start)\n"); | 
 | 	else | 
 | 		dev_notice(&pdev->dev, | 
 | 			   "chip is in inactive mode (Cold start)\n"); | 
 |  | 
 | 	if (np) { | 
 | 		err = of_regulator_match(&pdev->dev, np, | 
 | 					 ab3100_regulator_matches, | 
 | 					 ARRAY_SIZE(ab3100_regulator_matches)); | 
 | 		if (err < 0) { | 
 | 			dev_err(&pdev->dev, | 
 | 				"Error parsing regulator init data: %d\n", err); | 
 | 			return err; | 
 | 		} | 
 | 		return ab3100_regulator_of_probe(pdev, np); | 
 | 	} | 
 |  | 
 | 	/* Set up regulators */ | 
 | 	for (i = 0; i < ARRAY_SIZE(ab3100_reg_init_order); i++) { | 
 | 		err = abx500_set_register_interruptible(&pdev->dev, 0, | 
 | 					ab3100_reg_init_order[i], | 
 | 					plfdata->reg_initvals[i]); | 
 | 		if (err) { | 
 | 			dev_err(&pdev->dev, "regulator initialization failed with error %d\n", | 
 | 				err); | 
 | 			return err; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	/* Register the regulators */ | 
 | 	for (i = 0; i < AB3100_NUM_REGULATORS; i++) { | 
 | 		struct regulator_desc *desc = &ab3100_regulator_desc[i]; | 
 |  | 
 | 		err = ab3100_regulator_register(pdev, plfdata, NULL, NULL, | 
 | 						desc->id); | 
 | 		if (err) { | 
 | 			ab3100_regulators_remove(pdev); | 
 | 			return err; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct platform_driver ab3100_regulators_driver = { | 
 | 	.driver = { | 
 | 		.name  = "ab3100-regulators", | 
 | 		.owner = THIS_MODULE, | 
 | 	}, | 
 | 	.probe = ab3100_regulators_probe, | 
 | 	.remove = ab3100_regulators_remove, | 
 | }; | 
 |  | 
 | static __init int ab3100_regulators_init(void) | 
 | { | 
 | 	return platform_driver_register(&ab3100_regulators_driver); | 
 | } | 
 |  | 
 | static __exit void ab3100_regulators_exit(void) | 
 | { | 
 | 	platform_driver_unregister(&ab3100_regulators_driver); | 
 | } | 
 |  | 
 | subsys_initcall(ab3100_regulators_init); | 
 | module_exit(ab3100_regulators_exit); | 
 |  | 
 | MODULE_AUTHOR("Mattias Wallin <mattias.wallin@stericsson.com>"); | 
 | MODULE_DESCRIPTION("AB3100 Regulator driver"); | 
 | MODULE_LICENSE("GPL"); | 
 | MODULE_ALIAS("platform:ab3100-regulators"); |