[mirror_ubuntu-artful-kernel.git] / drivers / regulator / ab8500-ext.c

/*
 * Copyright (C) ST-Ericsson SA 2010
 *
 * License Terms: GNU General Public License v2
 *
 * Authors: Bengt Jonsson <bengt.g.jonsson@stericsson.com>
 *
 * This file is based on drivers/regulator/ab8500.c
 *
 * AB8500 external regulators
 *
 * ab8500-ext supports the following regulators:
 * - VextSupply3
 */
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/err.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/machine.h>
#include <linux/mfd/abx500.h>
#include <linux/mfd/abx500/ab8500.h>
#include <linux/regulator/ab8500.h>

/**
 * struct ab8500_ext_regulator_info - ab8500 regulator information
 * @dev: device pointer
 * @desc: regulator description
 * @rdev: regulator device
 * @cfg: regulator configuration (extension of regulator FW configuration)
 * @update_bank: bank to control on/off
 * @update_reg: register to control on/off
 * @update_mask: mask to enable/disable and set mode of regulator
 * @update_val: bits holding the regulator current mode
 * @update_val_hp: bits to set EN pin active (LPn pin deactive)
 *                 normally this means high power mode
 * @update_val_lp: bits to set EN pin active and LPn pin active
 *                 normally this means low power mode
 * @update_val_hw: bits to set regulator pins in HW control
 *                 SysClkReq pins and logic will choose mode
 */
struct ab8500_ext_regulator_info {
	struct device *dev;
	struct regulator_desc desc;
	struct regulator_dev *rdev;
	struct ab8500_ext_regulator_cfg *cfg;
	u8 update_bank;
	u8 update_reg;
	u8 update_mask;
	u8 update_val;
	u8 update_val_hp;
	u8 update_val_lp;
	u8 update_val_hw;
};

static int ab8500_ext_regulator_enable(struct regulator_dev *rdev)
{
	int ret;
	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
	u8 regval;

	if (info == NULL) {
		dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
		return -EINVAL;
	}

	/*
	 * To satisfy both HW high power request and SW request, the regulator
	 * must be on in high power.
	 */
	if (info->cfg && info->cfg->hwreq)
		regval = info->update_val_hp;
	else
		regval = info->update_val;

	ret = abx500_mask_and_set_register_interruptible(info->dev,
		info->update_bank, info->update_reg,
		info->update_mask, regval);
	if (ret < 0) {
		dev_err(rdev_get_dev(info->rdev),
			"couldn't set enable bits for regulator\n");
		return ret;
	}

	dev_dbg(rdev_get_dev(rdev),
		"%s-enable (bank, reg, mask, value): 0x%02x, 0x%02x, 0x%02x, 0x%02x\n",
		info->desc.name, info->update_bank, info->update_reg,
		info->update_mask, regval);

	return 0;
}

static int ab8500_ext_regulator_disable(struct regulator_dev *rdev)
{
	int ret;
	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
	u8 regval;

	if (info == NULL) {
		dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
		return -EINVAL;
	}

	/*
	 * Set the regulator in HW request mode if configured
	 */
	if (info->cfg && info->cfg->hwreq)
		regval = info->update_val_hw;
	else
		regval = 0;

	ret = abx500_mask_and_set_register_interruptible(info->dev,
		info->update_bank, info->update_reg,
		info->update_mask, regval);
	if (ret < 0) {
		dev_err(rdev_get_dev(info->rdev),
			"couldn't set disable bits for regulator\n");
		return ret;
	}

	dev_dbg(rdev_get_dev(rdev), "%s-disable (bank, reg, mask, value):"
		" 0x%02x, 0x%02x, 0x%02x, 0x%02x\n",
		info->desc.name, info->update_bank, info->update_reg,
		info->update_mask, regval);

	return 0;
}

static int ab8500_ext_regulator_is_enabled(struct regulator_dev *rdev)
{
	int ret;
	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
	u8 regval;

	if (info == NULL) {
		dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
		return -EINVAL;
	}

	ret = abx500_get_register_interruptible(info->dev,
		info->update_bank, info->update_reg, &regval);
	if (ret < 0) {
		dev_err(rdev_get_dev(rdev),
			"couldn't read 0x%x register\n", info->update_reg);
		return ret;
	}

	dev_dbg(rdev_get_dev(rdev), "%s-is_enabled (bank, reg, mask, value):"
		" 0x%02x, 0x%02x, 0x%02x, 0x%02x\n",
		info->desc.name, info->update_bank, info->update_reg,
		info->update_mask, regval);

	if (((regval & info->update_mask) == info->update_val_lp) ||
	    ((regval & info->update_mask) == info->update_val_hp))
		return 1;
	else
		return 0;
}

static int ab8500_ext_regulator_set_mode(struct regulator_dev *rdev,
					 unsigned int mode)
{
	int ret = 0;
	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
	u8 regval;

	if (info == NULL) {
		dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
		return -EINVAL;
	}

	switch (mode) {
	case REGULATOR_MODE_NORMAL:
		regval = info->update_val_hp;
		break;
	case REGULATOR_MODE_IDLE:
		regval = info->update_val_lp;
		break;

	default:
		return -EINVAL;
	}

	/* If regulator is enabled and info->cfg->hwreq is set, the regulator
	   must be on in high power, so we don't need to write the register with
	   the same value.
	 */
	if (ab8500_ext_regulator_is_enabled(rdev) &&
	    !(info->cfg && info->cfg->hwreq)) {
		ret = abx500_mask_and_set_register_interruptible(info->dev,
					info->update_bank, info->update_reg,
					info->update_mask, regval);
		if (ret < 0) {
			dev_err(rdev_get_dev(rdev),
				"Could not set regulator mode.\n");
			return ret;
		}

		dev_dbg(rdev_get_dev(rdev),
			"%s-set_mode (bank, reg, mask, value): "
			"0x%x, 0x%x, 0x%x, 0x%x\n",
			info->desc.name, info->update_bank, info->update_reg,
			info->update_mask, regval);
	}

	info->update_val = regval;

	return 0;
}

static unsigned int ab8500_ext_regulator_get_mode(struct regulator_dev *rdev)
{
	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
	int ret;

	if (info == NULL) {
		dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
		return -EINVAL;
	}

	if (info->update_val == info->update_val_hp)
		ret = REGULATOR_MODE_NORMAL;
	else if (info->update_val == info->update_val_lp)
		ret = REGULATOR_MODE_IDLE;
	else
		ret = -EINVAL;

	return ret;
}

static int ab8500_ext_set_voltage(struct regulator_dev *rdev, int min_uV,
				  int max_uV, unsigned *selector)
{
	struct regulation_constraints *regu_constraints = rdev->constraints;

	if (!regu_constraints) {
		dev_err(rdev_get_dev(rdev), "No regulator constraints\n");
		return -EINVAL;
	}

	if (regu_constraints->min_uV == min_uV &&
	    regu_constraints->max_uV == max_uV)
		return 0;

	dev_err(rdev_get_dev(rdev),
		"Requested min %duV max %duV != constrained min %duV max %duV\n",
		min_uV, max_uV,
		regu_constraints->min_uV, regu_constraints->max_uV);

	return -EINVAL;
}

static int ab8500_ext_list_voltage(struct regulator_dev *rdev,
				   unsigned selector)
{
	struct regulation_constraints *regu_constraints = rdev->constraints;

	if (regu_constraints == NULL) {
		dev_err(rdev_get_dev(rdev), "regulator constraints null pointer\n");
		return -EINVAL;
	}
	/* return the uV for the fixed regulators */
	if (regu_constraints->min_uV && regu_constraints->max_uV) {
		if (regu_constraints->min_uV == regu_constraints->max_uV)
			return regu_constraints->min_uV;
	}
	return -EINVAL;
}

static struct regulator_ops ab8500_ext_regulator_ops = {
	.enable			= ab8500_ext_regulator_enable,
	.disable		= ab8500_ext_regulator_disable,
	.is_enabled		= ab8500_ext_regulator_is_enabled,
	.set_mode		= ab8500_ext_regulator_set_mode,
	.get_mode		= ab8500_ext_regulator_get_mode,
	.set_voltage		= ab8500_ext_set_voltage,
	.list_voltage		= ab8500_ext_list_voltage,
};

static struct ab8500_ext_regulator_info
		ab8500_ext_regulator_info[AB8500_NUM_EXT_REGULATORS] = {
	[AB8500_EXT_SUPPLY1] = {
		.desc = {
			.name		= "VEXTSUPPLY1",
			.ops		= &ab8500_ext_regulator_ops,
			.type		= REGULATOR_VOLTAGE,
			.id		= AB8500_EXT_SUPPLY1,
			.owner		= THIS_MODULE,
			.n_voltages	= 1,
		},
		.update_bank		= 0x04,
		.update_reg		= 0x08,
		.update_mask		= 0x03,
		.update_val		= 0x01,
		.update_val_hp		= 0x01,
		.update_val_lp		= 0x03,
		.update_val_hw		= 0x02,
	},
	[AB8500_EXT_SUPPLY2] = {
		.desc = {
			.name		= "VEXTSUPPLY2",
			.ops		= &ab8500_ext_regulator_ops,
			.type		= REGULATOR_VOLTAGE,
			.id		= AB8500_EXT_SUPPLY2,
			.owner		= THIS_MODULE,
			.n_voltages	= 1,
		},
		.update_bank		= 0x04,
		.update_reg		= 0x08,
		.update_mask		= 0x0c,
		.update_val		= 0x04,
		.update_val_hp		= 0x04,
		.update_val_lp		= 0x0c,
		.update_val_hw		= 0x08,
	},
	[AB8500_EXT_SUPPLY3] = {
		.desc = {
			.name		= "VEXTSUPPLY3",
			.ops		= &ab8500_ext_regulator_ops,
			.type		= REGULATOR_VOLTAGE,
			.id		= AB8500_EXT_SUPPLY3,
			.owner		= THIS_MODULE,
			.n_voltages	= 1,
		},
		.update_bank		= 0x04,
		.update_reg		= 0x08,
		.update_mask		= 0x30,
		.update_val		= 0x10,
		.update_val_hp		= 0x10,
		.update_val_lp		= 0x30,
		.update_val_hw		= 0x20,
	},
};

int ab8500_ext_regulator_init(struct platform_device *pdev)
{
	struct ab8500 *ab8500 = dev_get_drvdata(pdev->dev.parent);
	struct ab8500_platform_data *ppdata;
	struct ab8500_regulator_platform_data *pdata;
	struct regulator_config config = { };
	int i, err;

	if (!ab8500) {
		dev_err(&pdev->dev, "null mfd parent\n");
		return -EINVAL;
	}
	ppdata = dev_get_platdata(ab8500->dev);
	if (!ppdata) {
		dev_err(&pdev->dev, "null parent pdata\n");
		return -EINVAL;
	}

	pdata = ppdata->regulator;
	if (!pdata) {
		dev_err(&pdev->dev, "null pdata\n");
		return -EINVAL;
	}

	/* make sure the platform data has the correct size */
	if (pdata->num_ext_regulator != ARRAY_SIZE(ab8500_ext_regulator_info)) {
		dev_err(&pdev->dev, "Configuration error: size mismatch.\n");
		return -EINVAL;
	}

	/* check for AB8500 2.x */
	if (is_ab8500_2p0_or_earlier(ab8500)) {
		struct ab8500_ext_regulator_info *info;

		/* VextSupply3LPn is inverted on AB8500 2.x */
		info = &ab8500_ext_regulator_info[AB8500_EXT_SUPPLY3];
		info->update_val = 0x30;
		info->update_val_hp = 0x30;
		info->update_val_lp = 0x10;
	}

	/* register all regulators */
	for (i = 0; i < ARRAY_SIZE(ab8500_ext_regulator_info); i++) {
		struct ab8500_ext_regulator_info *info = NULL;

		/* assign per-regulator data */
		info = &ab8500_ext_regulator_info[i];
		info->dev = &pdev->dev;
		info->cfg = (struct ab8500_ext_regulator_cfg *)
			pdata->ext_regulator[i].driver_data;

		config.dev = &pdev->dev;
		config.init_data = &pdata->ext_regulator[i];
		config.driver_data = info;

		/* register regulator with framework */
		info->rdev = regulator_register(&info->desc, &config);
		if (IS_ERR(info->rdev)) {
			err = PTR_ERR(info->rdev);
			dev_err(&pdev->dev, "failed to register regulator %s\n",
					info->desc.name);
			/* when we fail, un-register all earlier regulators */
			while (--i >= 0) {
				info = &ab8500_ext_regulator_info[i];
				regulator_unregister(info->rdev);
			}
			return err;
		}

		dev_dbg(rdev_get_dev(info->rdev),
			"%s-probed\n", info->desc.name);
	}

	return 0;
}

void ab8500_ext_regulator_exit(struct platform_device *pdev)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(ab8500_ext_regulator_info); i++) {
		struct ab8500_ext_regulator_info *info = NULL;
		info = &ab8500_ext_regulator_info[i];

		dev_vdbg(rdev_get_dev(info->rdev),
			"%s-remove\n", info->desc.name);

		regulator_unregister(info->rdev);
	}
}

MODULE_LICENSE("GPL v2");
MODULE_AUTHOR("Bengt Jonsson <bengt.g.jonsson@stericsson.com>");
MODULE_DESCRIPTION("AB8500 external regulator driver");
MODULE_ALIAS("platform:ab8500-ext-regulator");
Commit	Line	Data
d1a82001 LJ	1	/*
	2	* Copyright (C) ST-Ericsson SA 2010
	3	*
	4	* License Terms: GNU General Public License v2
	5	*
	6	* Authors: Bengt Jonsson <bengt.g.jonsson@stericsson.com>
	7	*
	8	* This file is based on drivers/regulator/ab8500.c
	9	*
	10	* AB8500 external regulators
	11	*
	12	* ab8500-ext supports the following regulators:
	13	* - VextSupply3
	14	*/
	15	#include <linux/init.h>
	16	#include <linux/kernel.h>
	17	#include <linux/err.h>
	18	#include <linux/module.h>
	19	#include <linux/platform_device.h>
	20	#include <linux/regulator/driver.h>
	21	#include <linux/regulator/machine.h>
	22	#include <linux/mfd/abx500.h>
	23	#include <linux/mfd/abx500/ab8500.h>
	24	#include <linux/regulator/ab8500.h>
	25
	26	/**
	27	* struct ab8500_ext_regulator_info - ab8500 regulator information
	28	* @dev: device pointer
	29	* @desc: regulator description
	30	* @rdev: regulator device
18bc2b39	31	* @cfg: regulator configuration (extension of regulator FW configuration)
d1a82001 LJ	32	* @update_bank: bank to control on/off
	33	* @update_reg: register to control on/off
	34	* @update_mask: mask to enable/disable and set mode of regulator
	35	* @update_val: bits holding the regulator current mode
18bc2b39	36	* @update_val_hp: bits to set EN pin active (LPn pin deactive)
d1a82001	37	* normally this means high power mode
18bc2b39 BJ	38	* @update_val_lp: bits to set EN pin active and LPn pin active
	39	* normally this means low power mode
	40	* @update_val_hw: bits to set regulator pins in HW control
	41	* SysClkReq pins and logic will choose mode
d1a82001 LJ	42	*/
	43	struct ab8500_ext_regulator_info {
	44	struct device *dev;
	45	struct regulator_desc desc;
	46	struct regulator_dev *rdev;
18bc2b39	47	struct ab8500_ext_regulator_cfg *cfg;
d1a82001 LJ	48	u8 update_bank;
	49	u8 update_reg;
	50	u8 update_mask;
	51	u8 update_val;
18bc2b39 BJ	52	u8 update_val_hp;
	53	u8 update_val_lp;
	54	u8 update_val_hw;
d1a82001 LJ	55	};
d1a82001 LJ	56
7384744d	57	static int ab8500_ext_regulator_enable(struct regulator_dev *rdev)
d1a82001 LJ	58	{
d1a82001 LJ	59	int ret;
7384744d AL	60	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
7384744d AL	61	u8 regval;
d1a82001	62
7384744d AL	63	if (info == NULL) {
	64	dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
	65	return -EINVAL;
	66	}
18bc2b39 BJ	67
	68	/*
	69	* To satisfy both HW high power request and SW request, the regulator
	70	* must be on in high power.
	71	*/
	72	if (info->cfg && info->cfg->hwreq)
7384744d AL	73	regval = info->update_val_hp;
	74	else
	75	regval = info->update_val;
d1a82001 LJ	76
	77	ret = abx500_mask_and_set_register_interruptible(info->dev,
	78	info->update_bank, info->update_reg,
7384744d	79	info->update_mask, regval);
37daa8ae	80	if (ret < 0) {
d1a82001 LJ	81	dev_err(rdev_get_dev(info->rdev),
d1a82001 LJ	82	"couldn't set enable bits for regulator\n");
37daa8ae AL	83	return ret;
37daa8ae AL	84	}
d1a82001	85
7384744d AL	86	dev_dbg(rdev_get_dev(rdev),
	87	"%s-enable (bank, reg, mask, value): 0x%02x, 0x%02x, 0x%02x, 0x%02x\n",
	88	info->desc.name, info->update_bank, info->update_reg,
	89	info->update_mask, regval);
	90
	91	return 0;
d1a82001 LJ	92	}
d1a82001 LJ	93
7384744d	94	static int ab8500_ext_regulator_disable(struct regulator_dev *rdev)
d1a82001 LJ	95	{
	96	int ret;
	97	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
18bc2b39	98	u8 regval;
d1a82001 LJ	99
	100	if (info == NULL) {
	101	dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
	102	return -EINVAL;
	103	}
	104
18bc2b39 BJ	105	/*
	106	* Set the regulator in HW request mode if configured
	107	*/
	108	if (info->cfg && info->cfg->hwreq)
7384744d AL	109	regval = info->update_val_hw;
	110	else
	111	regval = 0;
18bc2b39	112
d1a82001 LJ	113	ret = abx500_mask_and_set_register_interruptible(info->dev,
d1a82001 LJ	114	info->update_bank, info->update_reg,
7384744d	115	info->update_mask, regval);
37daa8ae	116	if (ret < 0) {
d1a82001 LJ	117	dev_err(rdev_get_dev(info->rdev),
d1a82001 LJ	118	"couldn't set disable bits for regulator\n");
37daa8ae AL	119	return ret;
37daa8ae AL	120	}
d1a82001	121
d1a82001 LJ	122	dev_dbg(rdev_get_dev(rdev), "%s-disable (bank, reg, mask, value):"
	123	" 0x%02x, 0x%02x, 0x%02x, 0x%02x\n",
	124	info->desc.name, info->update_bank, info->update_reg,
18bc2b39	125	info->update_mask, regval);
d1a82001	126
7384744d	127	return 0;
d1a82001 LJ	128	}
	129
	130	static int ab8500_ext_regulator_is_enabled(struct regulator_dev *rdev)
	131	{
	132	int ret;
	133	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
	134	u8 regval;
	135
	136	if (info == NULL) {
	137	dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
	138	return -EINVAL;
	139	}
	140
	141	ret = abx500_get_register_interruptible(info->dev,
	142	info->update_bank, info->update_reg, &regval);
	143	if (ret < 0) {
	144	dev_err(rdev_get_dev(rdev),
	145	"couldn't read 0x%x register\n", info->update_reg);
	146	return ret;
	147	}
	148
	149	dev_dbg(rdev_get_dev(rdev), "%s-is_enabled (bank, reg, mask, value):"
	150	" 0x%02x, 0x%02x, 0x%02x, 0x%02x\n",
	151	info->desc.name, info->update_bank, info->update_reg,
	152	info->update_mask, regval);
	153
18bc2b39 BJ	154	if (((regval & info->update_mask) == info->update_val_lp) \|\|
18bc2b39 BJ	155	((regval & info->update_mask) == info->update_val_hp))
9ab51a0e	156	return 1;
d1a82001	157	else
9ab51a0e	158	return 0;
d1a82001 LJ	159	}
	160
	161	static int ab8500_ext_regulator_set_mode(struct regulator_dev *rdev,
	162	unsigned int mode)
	163	{
	164	int ret = 0;
	165	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
66511fa4	166	u8 regval;
d1a82001 LJ	167
	168	if (info == NULL) {
	169	dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
	170	return -EINVAL;
	171	}
	172
	173	switch (mode) {
	174	case REGULATOR_MODE_NORMAL:
66511fa4	175	regval = info->update_val_hp;
d1a82001 LJ	176	break;
d1a82001 LJ	177	case REGULATOR_MODE_IDLE:
66511fa4	178	regval = info->update_val_lp;
d1a82001 LJ	179	break;
	180
	181	default:
	182	return -EINVAL;
	183	}
	184
66511fa4 AL	185	/* If regulator is enabled and info->cfg->hwreq is set, the regulator
	186	must be on in high power, so we don't need to write the register with
	187	the same value.
	188	*/
	189	if (ab8500_ext_regulator_is_enabled(rdev) &&
	190	!(info->cfg && info->cfg->hwreq)) {
	191	ret = abx500_mask_and_set_register_interruptible(info->dev,
	192	info->update_bank, info->update_reg,
	193	info->update_mask, regval);
	194	if (ret < 0) {
d1a82001 LJ	195	dev_err(rdev_get_dev(rdev),
d1a82001 LJ	196	"Could not set regulator mode.\n");
66511fa4 AL	197	return ret;
66511fa4 AL	198	}
d1a82001 LJ	199
	200	dev_dbg(rdev_get_dev(rdev),
	201	"%s-set_mode (bank, reg, mask, value): "
	202	"0x%x, 0x%x, 0x%x, 0x%x\n",
	203	info->desc.name, info->update_bank, info->update_reg,
	204	info->update_mask, regval);
	205	}
	206
66511fa4 AL	207	info->update_val = regval;
	208
	209	return 0;
d1a82001 LJ	210	}
	211
	212	static unsigned int ab8500_ext_regulator_get_mode(struct regulator_dev *rdev)
	213	{
	214	struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
	215	int ret;
	216
	217	if (info == NULL) {
	218	dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
	219	return -EINVAL;
	220	}
	221
	222	if (info->update_val == info->update_val_hp)
	223	ret = REGULATOR_MODE_NORMAL;
	224	else if (info->update_val == info->update_val_lp)
	225	ret = REGULATOR_MODE_IDLE;
	226	else
	227	ret = -EINVAL;
	228
	229	return ret;
	230	}
	231
33fb8802 LJ	232	static int ab8500_ext_set_voltage(struct regulator_dev *rdev, int min_uV,
	233	int max_uV, unsigned *selector)
	234	{
	235	struct regulation_constraints *regu_constraints = rdev->constraints;
	236
	237	if (!regu_constraints) {
	238	dev_err(rdev_get_dev(rdev), "No regulator constraints\n");
	239	return -EINVAL;
	240	}
	241
	242	if (regu_constraints->min_uV == min_uV &&
	243	regu_constraints->max_uV == max_uV)
	244	return 0;
	245
	246	dev_err(rdev_get_dev(rdev),
	247	"Requested min %duV max %duV != constrained min %duV max %duV\n",
	248	min_uV, max_uV,
	249	regu_constraints->min_uV, regu_constraints->max_uV);
	250
	251	return -EINVAL;
	252	}
	253
d1a82001 LJ	254	static int ab8500_ext_list_voltage(struct regulator_dev *rdev,
	255	unsigned selector)
	256	{
	257	struct regulation_constraints *regu_constraints = rdev->constraints;
	258
	259	if (regu_constraints == NULL) {
	260	dev_err(rdev_get_dev(rdev), "regulator constraints null pointer\n");
	261	return -EINVAL;
	262	}
	263	/* return the uV for the fixed regulators */
	264	if (regu_constraints->min_uV && regu_constraints->max_uV) {
	265	if (regu_constraints->min_uV == regu_constraints->max_uV)
	266	return regu_constraints->min_uV;
	267	}
	268	return -EINVAL;
	269	}
	270
	271	static struct regulator_ops ab8500_ext_regulator_ops = {
	272	.enable = ab8500_ext_regulator_enable,
	273	.disable = ab8500_ext_regulator_disable,
	274	.is_enabled = ab8500_ext_regulator_is_enabled,
	275	.set_mode = ab8500_ext_regulator_set_mode,
	276	.get_mode = ab8500_ext_regulator_get_mode,
33fb8802	277	.set_voltage = ab8500_ext_set_voltage,
d1a82001 LJ	278	.list_voltage = ab8500_ext_list_voltage,
	279	};
	280
d1a82001 LJ	281	static struct ab8500_ext_regulator_info
	282	ab8500_ext_regulator_info[AB8500_NUM_EXT_REGULATORS] = {
	283	[AB8500_EXT_SUPPLY1] = {
	284	.desc = {
	285	.name = "VEXTSUPPLY1",
	286	.ops = &ab8500_ext_regulator_ops,
	287	.type = REGULATOR_VOLTAGE,
	288	.id = AB8500_EXT_SUPPLY1,
	289	.owner = THIS_MODULE,
	290	.n_voltages = 1,
	291	},
	292	.update_bank = 0x04,
	293	.update_reg = 0x08,
	294	.update_mask = 0x03,
	295	.update_val = 0x01,
	296	.update_val_hp = 0x01,
	297	.update_val_lp = 0x03,
	298	.update_val_hw = 0x02,
	299	},
	300	[AB8500_EXT_SUPPLY2] = {
	301	.desc = {
	302	.name = "VEXTSUPPLY2",
	303	.ops = &ab8500_ext_regulator_ops,
	304	.type = REGULATOR_VOLTAGE,
	305	.id = AB8500_EXT_SUPPLY2,
	306	.owner = THIS_MODULE,
	307	.n_voltages = 1,
	308	},
	309	.update_bank = 0x04,
	310	.update_reg = 0x08,
	311	.update_mask = 0x0c,
	312	.update_val = 0x04,
	313	.update_val_hp = 0x04,
	314	.update_val_lp = 0x0c,
	315	.update_val_hw = 0x08,
	316	},
	317	[AB8500_EXT_SUPPLY3] = {
	318	.desc = {
	319	.name = "VEXTSUPPLY3",
	320	.ops = &ab8500_ext_regulator_ops,
	321	.type = REGULATOR_VOLTAGE,
	322	.id = AB8500_EXT_SUPPLY3,
	323	.owner = THIS_MODULE,
	324	.n_voltages = 1,
	325	},
	326	.update_bank = 0x04,
	327	.update_reg = 0x08,
	328	.update_mask = 0x30,
	329	.update_val = 0x10,
18bc2b39 BJ	330	.update_val_hp = 0x10,
	331	.update_val_lp = 0x30,
	332	.update_val_hw = 0x20,
d1a82001 LJ	333	},
	334	};
	335
	336	int ab8500_ext_regulator_init(struct platform_device *pdev)
	337	{
	338	struct ab8500 *ab8500 = dev_get_drvdata(pdev->dev.parent);
	339	struct ab8500_platform_data *ppdata;
	340	struct ab8500_regulator_platform_data *pdata;
	341	struct regulator_config config = { };
	342	int i, err;
	343
	344	if (!ab8500) {
	345	dev_err(&pdev->dev, "null mfd parent\n");
	346	return -EINVAL;
	347	}
	348	ppdata = dev_get_platdata(ab8500->dev);
	349	if (!ppdata) {
	350	dev_err(&pdev->dev, "null parent pdata\n");
	351	return -EINVAL;
	352	}
	353
	354	pdata = ppdata->regulator;
	355	if (!pdata) {
	356	dev_err(&pdev->dev, "null pdata\n");
	357	return -EINVAL;
	358	}
	359
	360	/* make sure the platform data has the correct size */
	361	if (pdata->num_ext_regulator != ARRAY_SIZE(ab8500_ext_regulator_info)) {
	362	dev_err(&pdev->dev, "Configuration error: size mismatch.\n");
	363	return -EINVAL;
	364	}
	365
	366	/* check for AB8500 2.x */
a6324709	367	if (is_ab8500_2p0_or_earlier(ab8500)) {
d1a82001 LJ	368	struct ab8500_ext_regulator_info *info;
	369
	370	/* VextSupply3LPn is inverted on AB8500 2.x */
	371	info = &ab8500_ext_regulator_info[AB8500_EXT_SUPPLY3];
	372	info->update_val = 0x30;
18bc2b39 BJ	373	info->update_val_hp = 0x30;
18bc2b39 BJ	374	info->update_val_lp = 0x10;
d1a82001 LJ	375	}
	376
	377	/* register all regulators */
	378	for (i = 0; i < ARRAY_SIZE(ab8500_ext_regulator_info); i++) {
	379	struct ab8500_ext_regulator_info *info = NULL;
	380
	381	/* assign per-regulator data */
	382	info = &ab8500_ext_regulator_info[i];
	383	info->dev = &pdev->dev;
18bc2b39 BJ	384	info->cfg = (struct ab8500_ext_regulator_cfg *)
18bc2b39 BJ	385	pdata->ext_regulator[i].driver_data;
d1a82001 LJ	386
	387	config.dev = &pdev->dev;
	388	config.init_data = &pdata->ext_regulator[i];
	389	config.driver_data = info;
	390
	391	/* register regulator with framework */
	392	info->rdev = regulator_register(&info->desc, &config);
d1a82001 LJ	393	if (IS_ERR(info->rdev)) {
	394	err = PTR_ERR(info->rdev);
	395	dev_err(&pdev->dev, "failed to register regulator %s\n",
	396	info->desc.name);
	397	/* when we fail, un-register all earlier regulators */
	398	while (--i >= 0) {
	399	info = &ab8500_ext_regulator_info[i];
	400	regulator_unregister(info->rdev);
	401	}
	402	return err;
	403	}
	404
	405	dev_dbg(rdev_get_dev(info->rdev),
	406	"%s-probed\n", info->desc.name);
	407	}
	408
	409	return 0;
	410	}
	411
3480c0ca	412	void ab8500_ext_regulator_exit(struct platform_device *pdev)
d1a82001 LJ	413	{
	414	int i;
	415
	416	for (i = 0; i < ARRAY_SIZE(ab8500_ext_regulator_info); i++) {
	417	struct ab8500_ext_regulator_info *info = NULL;
	418	info = &ab8500_ext_regulator_info[i];
	419
	420	dev_vdbg(rdev_get_dev(info->rdev),
	421	"%s-remove\n", info->desc.name);
	422
	423	regulator_unregister(info->rdev);
	424	}
d1a82001 LJ	425	}
	426
	427	MODULE_LICENSE("GPL v2");
	428	MODULE_AUTHOR("Bengt Jonsson <bengt.g.jonsson@stericsson.com>");
	429	MODULE_DESCRIPTION("AB8500 external regulator driver");
	430	MODULE_ALIAS("platform:ab8500-ext-regulator");