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

/*
 * 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>

/* 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,
						&regval);
	if (err) {
		dev_warn(&reg->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(&reg->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(&reg->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,
						&regval);
	if (err) {
		dev_err(&reg->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,
						&regval);
	if (err) {
		dev_err(&reg->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, &regval);
	if (err) {
		dev_warn(&reg->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(&reg->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, &regval);
	if (err) {
		dev_warn(&reg->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(&reg->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, &regval);
	if (err) {
		dev_warn(&reg->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(&reg->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);

	return abreg->plfdata->external_voltage;
}

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  = &regulator_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  = &regulator_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  = &regulator_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  = &regulator_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  = &regulator_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  = &regulator_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  = &regulator_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  = &regulator_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  = &regulator_ops_external,
		.type = REGULATOR_VOLTAGE,
		.owner = THIS_MODULE,
	},
	{
		.name = "BUCK",
		.id   = AB3100_BUCK,
		.ops  = &regulator_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,
	},
};

/*
 * NOTE: the following functions are regulators pluralis - it is the
 * binding to the AB3100 core driver and the parent platform device
 * for all the different regulators.
 */

static int ab3100_regulators_probe(struct platform_device *pdev)
{
	struct ab3100_platform_data *plfdata = pdev->dev.platform_data;
	struct regulator_config config = { };
	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");

	/* 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 ab3100_regulator *reg = &ab3100_regulators[i];
		struct regulator_dev *rdev;

		/*
		 * 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;
		reg->plfdata = plfdata;

		config.dev = &pdev->dev;
		config.driver_data = reg;
		config.init_data = &plfdata->reg_constraints[i];

		/*
		 * Register the regulator, pass around
		 * the ab3100_regulator struct
		 */
		rdev = regulator_register(&ab3100_regulator_desc[i], &config);
		if (IS_ERR(rdev)) {
			err = PTR_ERR(rdev);
			dev_err(&pdev->dev,
				"%s: failed to register regulator %s err %d\n",
				__func__, ab3100_regulator_desc[i].name,
				err);
			/* remove the already registered regulators */
			while (--i >= 0)
				regulator_unregister(ab3100_regulators[i].rdev);
			return err;
		}

		/* Then set a pointer back to the registered regulator */
		reg->rdev = rdev;
	}

	return 0;
}

static int __devexit ab3100_regulators_remove(struct platform_device *pdev)
{
	int i;

	for (i = 0; i < AB3100_NUM_REGULATORS; i++) {
		struct ab3100_regulator *reg = &ab3100_regulators[i];

		regulator_unregister(reg->rdev);
	}
	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");
Commit	Line	Data
d619bc14 LW	1	/*
	2	* drivers/regulator/ab3100.c
	3	*
	4	* Copyright (C) 2008-2009 ST-Ericsson AB
	5	* License terms: GNU General Public License (GPL) version 2
	6	* Low-level control of the AB3100 IC Low Dropout (LDO)
	7	* regulators, external regulator and buck converter
	8	* Author: Mattias Wallin <mattias.wallin@stericsson.com>
	9	* Author: Linus Walleij <linus.walleij@stericsson.com>
	10	*/
	11
	12	#include <linux/module.h>
	13	#include <linux/kernel.h>
	14	#include <linux/init.h>
	15	#include <linux/err.h>
d619bc14 LW	16	#include <linux/platform_device.h>
d619bc14 LW	17	#include <linux/regulator/driver.h>
0fd0013c	18	#include <linux/mfd/ab3100.h>
812f9e9d	19	#include <linux/mfd/abx500.h>
d619bc14 LW	20
	21	/* LDO registers and some handy masking definitions for AB3100 */
	22	#define AB3100_LDO_A 0x40
	23	#define AB3100_LDO_C 0x41
	24	#define AB3100_LDO_D 0x42
	25	#define AB3100_LDO_E 0x43
	26	#define AB3100_LDO_E_SLEEP 0x44
	27	#define AB3100_LDO_F 0x45
	28	#define AB3100_LDO_G 0x46
	29	#define AB3100_LDO_H 0x47
	30	#define AB3100_LDO_H_SLEEP_MODE 0
	31	#define AB3100_LDO_H_SLEEP_EN 2
	32	#define AB3100_LDO_ON 4
	33	#define AB3100_LDO_H_VSEL_AC 5
	34	#define AB3100_LDO_K 0x48
	35	#define AB3100_LDO_EXT 0x49
	36	#define AB3100_BUCK 0x4A
	37	#define AB3100_BUCK_SLEEP 0x4B
	38	#define AB3100_REG_ON_MASK 0x10
	39
	40	/**
	41	* struct ab3100_regulator
	42	* A struct passed around the individual regulator functions
	43	* @platform_device: platform device holding this regulator
fa661258	44	* @dev: handle to the device
d619bc14 LW	45	* @plfdata: AB3100 platform data passed in at probe time
d619bc14 LW	46	* @regreg: regulator register number in the AB3100
d619bc14 LW	47	*/
	48	struct ab3100_regulator {
	49	struct regulator_dev *rdev;
fa661258	50	struct device *dev;
d619bc14 LW	51	struct ab3100_platform_data *plfdata;
d619bc14 LW	52	u8 regreg;
d619bc14 LW	53	};
	54
	55	/* The order in which registers are initialized */
	56	static const u8 ab3100_reg_init_order[AB3100_NUM_REGULATORS+2] = {
	57	AB3100_LDO_A,
	58	AB3100_LDO_C,
	59	AB3100_LDO_E,
	60	AB3100_LDO_E_SLEEP,
	61	AB3100_LDO_F,
	62	AB3100_LDO_G,
	63	AB3100_LDO_H,
	64	AB3100_LDO_K,
	65	AB3100_LDO_EXT,
	66	AB3100_BUCK,
	67	AB3100_BUCK_SLEEP,
	68	AB3100_LDO_D,
	69	};
	70
	71	/* Preset (hardware defined) voltages for these regulators */
	72	#define LDO_A_VOLTAGE 2750000
	73	#define LDO_C_VOLTAGE 2650000
	74	#define LDO_D_VOLTAGE 2650000
	75
a3beb742	76	static const unsigned int ldo_e_buck_typ_voltages[] = {
d619bc14 LW	77	1800000,
	78	1400000,
	79	1300000,
	80	1200000,
	81	1100000,
	82	1050000,
	83	900000,
	84	};
	85
a3beb742	86	static const unsigned int ldo_f_typ_voltages[] = {
d619bc14 LW	87	1800000,
	88	1400000,
	89	1300000,
	90	1200000,
	91	1100000,
	92	1050000,
	93	2500000,
	94	2650000,
	95	};
	96
a3beb742	97	static const unsigned int ldo_g_typ_voltages[] = {
d619bc14 LW	98	2850000,
	99	2750000,
	100	1800000,
	101	1500000,
	102	};
	103
a3beb742	104	static const unsigned int ldo_h_typ_voltages[] = {
d619bc14 LW	105	2750000,
	106	1800000,
	107	1500000,
	108	1200000,
	109	};
	110
a3beb742	111	static const unsigned int ldo_k_typ_voltages[] = {
d619bc14 LW	112	2750000,
	113	1800000,
	114	};
	115
	116
	117	/* The regulator devices */
	118	static struct ab3100_regulator
	119	ab3100_regulators[AB3100_NUM_REGULATORS] = {
	120	{
	121	.regreg = AB3100_LDO_A,
d619bc14 LW	122	},
	123	{
	124	.regreg = AB3100_LDO_C,
d619bc14 LW	125	},
	126	{
	127	.regreg = AB3100_LDO_D,
d619bc14 LW	128	},
	129	{
	130	.regreg = AB3100_LDO_E,
d619bc14 LW	131	},
	132	{
	133	.regreg = AB3100_LDO_F,
d619bc14 LW	134	},
	135	{
	136	.regreg = AB3100_LDO_G,
d619bc14 LW	137	},
	138	{
	139	.regreg = AB3100_LDO_H,
d619bc14 LW	140	},
	141	{
	142	.regreg = AB3100_LDO_K,
d619bc14 LW	143	},
	144	{
	145	.regreg = AB3100_LDO_EXT,
	146	/* No voltages for the external regulator */
	147	},
	148	{
	149	.regreg = AB3100_BUCK,
d619bc14 LW	150	},
	151	};
	152
	153	/*
	154	* General functions for enable, disable and is_enabled used for
	155	* LDO: A,C,E,F,G,H,K,EXT and BUCK
	156	*/
	157	static int ab3100_enable_regulator(struct regulator_dev *reg)
	158	{
6c3b956b	159	struct ab3100_regulator *abreg = rdev_get_drvdata(reg);
d619bc14 LW	160	int err;
	161	u8 regval;
	162
fa661258	163	err = abx500_get_register_interruptible(abreg->dev, 0, abreg->regreg,
d619bc14 LW	164	&regval);
	165	if (err) {
	166	dev_warn(&reg->dev, "failed to get regid %d value\n",
	167	abreg->regreg);
	168	return err;
	169	}
	170
	171	/* The regulator is already on, no reason to go further */
	172	if (regval & AB3100_REG_ON_MASK)
	173	return 0;
	174
	175	regval \|= AB3100_REG_ON_MASK;
	176
fa661258	177	err = abx500_set_register_interruptible(abreg->dev, 0, abreg->regreg,
d619bc14 LW	178	regval);
	179	if (err) {
	180	dev_warn(&reg->dev, "failed to set regid %d value\n",
	181	abreg->regreg);
	182	return err;
	183	}
	184
d619bc14 LW	185	return 0;
	186	}
	187
	188	static int ab3100_disable_regulator(struct regulator_dev *reg)
	189	{
6c3b956b	190	struct ab3100_regulator *abreg = rdev_get_drvdata(reg);
d619bc14 LW	191	int err;
	192	u8 regval;
	193
	194	/*
	195	* LDO D is a special regulator. When it is disabled, the entire
	196	* system is shut down. So this is handled specially.
	197	*/
176f45b9	198	pr_info("Called ab3100_disable_regulator\n");
d619bc14	199	if (abreg->regreg == AB3100_LDO_D) {
d619bc14	200	dev_info(&reg->dev, "disabling LDO D - shut down system\n");
d619bc14	201	/* Setting LDO D to 0x00 cuts the power to the SoC */
fa661258	202	return abx500_set_register_interruptible(abreg->dev, 0,
d619bc14	203	AB3100_LDO_D, 0x00U);
d619bc14 LW	204	}
	205
	206	/*
	207	* All other regulators are handled here
	208	*/
fa661258	209	err = abx500_get_register_interruptible(abreg->dev, 0, abreg->regreg,
d619bc14 LW	210	&regval);
	211	if (err) {
	212	dev_err(&reg->dev, "unable to get register 0x%x\n",
	213	abreg->regreg);
	214	return err;
	215	}
	216	regval &= ~AB3100_REG_ON_MASK;
fa661258	217	return abx500_set_register_interruptible(abreg->dev, 0, abreg->regreg,
d619bc14 LW	218	regval);
	219	}
	220
	221	static int ab3100_is_enabled_regulator(struct regulator_dev *reg)
	222	{
6c3b956b	223	struct ab3100_regulator *abreg = rdev_get_drvdata(reg);
d619bc14 LW	224	u8 regval;
	225	int err;
	226
fa661258	227	err = abx500_get_register_interruptible(abreg->dev, 0, abreg->regreg,
d619bc14 LW	228	&regval);
	229	if (err) {
	230	dev_err(&reg->dev, "unable to get register 0x%x\n",
	231	abreg->regreg);
	232	return err;
	233	}
	234
	235	return regval & AB3100_REG_ON_MASK;
	236	}
	237
d619bc14 LW	238	static int ab3100_get_voltage_regulator(struct regulator_dev *reg)
d619bc14 LW	239	{
6c3b956b	240	struct ab3100_regulator *abreg = rdev_get_drvdata(reg);
d619bc14 LW	241	u8 regval;
	242	int err;
	243
d619bc14 LW	244	/*
	245	* For variable types, read out setting and index into
	246	* supplied voltage list.
	247	*/
fa661258	248	err = abx500_get_register_interruptible(abreg->dev, 0,
d619bc14 LW	249	abreg->regreg, &regval);
	250	if (err) {
	251	dev_warn(&reg->dev,
	252	"failed to get regulator value in register %02x\n",
	253	abreg->regreg);
	254	return err;
	255	}
	256
	257	/* The 3 highest bits index voltages */
	258	regval &= 0xE0;
	259	regval >>= 5;
	260
a3beb742	261	if (regval >= reg->desc->n_voltages) {
d619bc14 LW	262	dev_err(&reg->dev,
	263	"regulator register %02x contains an illegal voltage setting\n",
	264	abreg->regreg);
	265	return -EINVAL;
	266	}
	267
a3beb742	268	return reg->desc->volt_table[regval];
d619bc14 LW	269	}
d619bc14 LW	270
1f793ff2 AL	271	static int ab3100_set_voltage_regulator_sel(struct regulator_dev *reg,
1f793ff2 AL	272	unsigned selector)
d619bc14	273	{
6c3b956b	274	struct ab3100_regulator *abreg = rdev_get_drvdata(reg);
d619bc14 LW	275	u8 regval;
d619bc14 LW	276	int err;
3a93f2a9	277
fa661258	278	err = abx500_get_register_interruptible(abreg->dev, 0,
d619bc14 LW	279	abreg->regreg, &regval);
	280	if (err) {
	281	dev_warn(&reg->dev,
	282	"failed to get regulator register %02x\n",
	283	abreg->regreg);
	284	return err;
	285	}
	286
	287	/* The highest three bits control the variable regulators */
	288	regval &= ~0xE0;
1f793ff2	289	regval \|= (selector << 5);
d619bc14	290
fa661258	291	err = abx500_set_register_interruptible(abreg->dev, 0,
d619bc14 LW	292	abreg->regreg, regval);
	293	if (err)
	294	dev_warn(&reg->dev, "failed to set regulator register %02x\n",
	295	abreg->regreg);
	296
	297	return err;
	298	}
	299
	300	static int ab3100_set_suspend_voltage_regulator(struct regulator_dev *reg,
	301	int uV)
	302	{
6c3b956b	303	struct ab3100_regulator *abreg = rdev_get_drvdata(reg);
d619bc14 LW	304	u8 regval;
	305	int err;
	306	int bestindex;
	307	u8 targetreg;
	308
	309	if (abreg->regreg == AB3100_LDO_E)
	310	targetreg = AB3100_LDO_E_SLEEP;
	311	else if (abreg->regreg == AB3100_BUCK)
	312	targetreg = AB3100_BUCK_SLEEP;
	313	else
	314	return -EINVAL;
	315
	316	/* LDO E and BUCK have special suspend voltages you can set */
b13296d0	317	bestindex = regulator_map_voltage_iterate(reg, uV, uV);
d619bc14	318
fa661258	319	err = abx500_get_register_interruptible(abreg->dev, 0,
d619bc14 LW	320	targetreg, &regval);
	321	if (err) {
	322	dev_warn(&reg->dev,
	323	"failed to get regulator register %02x\n",
	324	targetreg);
	325	return err;
	326	}
	327
	328	/* The highest three bits control the variable regulators */
	329	regval &= ~0xE0;
	330	regval \|= (bestindex << 5);
	331
fa661258	332	err = abx500_set_register_interruptible(abreg->dev, 0,
d619bc14 LW	333	targetreg, regval);
	334	if (err)
	335	dev_warn(&reg->dev, "failed to set regulator register %02x\n",
	336	abreg->regreg);
	337
	338	return err;
	339	}
	340
	341	/*
	342	* The external regulator can just define a fixed voltage.
	343	*/
	344	static int ab3100_get_voltage_regulator_external(struct regulator_dev *reg)
	345	{
6c3b956b	346	struct ab3100_regulator *abreg = rdev_get_drvdata(reg);
d619bc14 LW	347
	348	return abreg->plfdata->external_voltage;
	349	}
	350
	351	static struct regulator_ops regulator_ops_fixed = {
1bd1955a	352	.list_voltage = regulator_list_voltage_linear,
d619bc14 LW	353	.enable = ab3100_enable_regulator,
	354	.disable = ab3100_disable_regulator,
	355	.is_enabled = ab3100_is_enabled_regulator,
d619bc14 LW	356	};
	357
	358	static struct regulator_ops regulator_ops_variable = {
	359	.enable = ab3100_enable_regulator,
	360	.disable = ab3100_disable_regulator,
	361	.is_enabled = ab3100_is_enabled_regulator,
	362	.get_voltage = ab3100_get_voltage_regulator,
1f793ff2	363	.set_voltage_sel = ab3100_set_voltage_regulator_sel,
a3beb742	364	.list_voltage = regulator_list_voltage_table,
d619bc14 LW	365	};
	366
	367	static struct regulator_ops regulator_ops_variable_sleepable = {
	368	.enable = ab3100_enable_regulator,
	369	.disable = ab3100_disable_regulator,
	370	.is_enabled = ab3100_is_enabled_regulator,
	371	.get_voltage = ab3100_get_voltage_regulator,
1f793ff2	372	.set_voltage_sel = ab3100_set_voltage_regulator_sel,
d619bc14	373	.set_suspend_voltage = ab3100_set_suspend_voltage_regulator,
a3beb742	374	.list_voltage = regulator_list_voltage_table,
d619bc14 LW	375	};
	376
	377	/*
	378	* LDO EXT is an external regulator so it is really
	379	* not possible to set any voltage locally here, AB3100
	380	* is an on/off switch plain an simple. The external
	381	* voltage is defined in the board set-up if any.
	382	*/
	383	static struct regulator_ops regulator_ops_external = {
	384	.enable = ab3100_enable_regulator,
	385	.disable = ab3100_disable_regulator,
	386	.is_enabled = ab3100_is_enabled_regulator,
	387	.get_voltage = ab3100_get_voltage_regulator_external,
	388	};
	389
	390	static struct regulator_desc
	391	ab3100_regulator_desc[AB3100_NUM_REGULATORS] = {
	392	{
	393	.name = "LDO_A",
	394	.id = AB3100_LDO_A,
	395	.ops = &regulator_ops_fixed,
1bd1955a	396	.n_voltages = 1,
d619bc14	397	.type = REGULATOR_VOLTAGE,
64714354	398	.owner = THIS_MODULE,
1bd1955a	399	.min_uV = LDO_A_VOLTAGE,
f8568cbd	400	.enable_time = 200,
d619bc14 LW	401	},
	402	{
	403	.name = "LDO_C",
	404	.id = AB3100_LDO_C,
	405	.ops = &regulator_ops_fixed,
1bd1955a	406	.n_voltages = 1,
d619bc14	407	.type = REGULATOR_VOLTAGE,
64714354	408	.owner = THIS_MODULE,
1bd1955a	409	.min_uV = LDO_C_VOLTAGE,
f8568cbd	410	.enable_time = 200,
d619bc14 LW	411	},
	412	{
	413	.name = "LDO_D",
	414	.id = AB3100_LDO_D,
	415	.ops = &regulator_ops_fixed,
1bd1955a	416	.n_voltages = 1,
d619bc14	417	.type = REGULATOR_VOLTAGE,
64714354	418	.owner = THIS_MODULE,
1bd1955a	419	.min_uV = LDO_D_VOLTAGE,
f8568cbd	420	.enable_time = 200,
d619bc14 LW	421	},
	422	{
	423	.name = "LDO_E",
	424	.id = AB3100_LDO_E,
	425	.ops = &regulator_ops_variable_sleepable,
75f2ba8f	426	.n_voltages = ARRAY_SIZE(ldo_e_buck_typ_voltages),
a3beb742	427	.volt_table = ldo_e_buck_typ_voltages,
d619bc14	428	.type = REGULATOR_VOLTAGE,
64714354	429	.owner = THIS_MODULE,
f8568cbd	430	.enable_time = 200,
d619bc14 LW	431	},
	432	{
	433	.name = "LDO_F",
	434	.id = AB3100_LDO_F,
	435	.ops = &regulator_ops_variable,
75f2ba8f	436	.n_voltages = ARRAY_SIZE(ldo_f_typ_voltages),
a3beb742	437	.volt_table = ldo_f_typ_voltages,
d619bc14	438	.type = REGULATOR_VOLTAGE,
64714354	439	.owner = THIS_MODULE,
f8568cbd	440	.enable_time = 600,
d619bc14 LW	441	},
	442	{
	443	.name = "LDO_G",
	444	.id = AB3100_LDO_G,
	445	.ops = &regulator_ops_variable,
75f2ba8f	446	.n_voltages = ARRAY_SIZE(ldo_g_typ_voltages),
a3beb742	447	.volt_table = ldo_g_typ_voltages,
d619bc14	448	.type = REGULATOR_VOLTAGE,
64714354	449	.owner = THIS_MODULE,
f8568cbd	450	.enable_time = 400,
d619bc14 LW	451	},
	452	{
	453	.name = "LDO_H",
	454	.id = AB3100_LDO_H,
	455	.ops = &regulator_ops_variable,
75f2ba8f	456	.n_voltages = ARRAY_SIZE(ldo_h_typ_voltages),
a3beb742	457	.volt_table = ldo_h_typ_voltages,
d619bc14	458	.type = REGULATOR_VOLTAGE,
64714354	459	.owner = THIS_MODULE,
f8568cbd	460	.enable_time = 200,
d619bc14 LW	461	},
	462	{
	463	.name = "LDO_K",
	464	.id = AB3100_LDO_K,
	465	.ops = &regulator_ops_variable,
75f2ba8f	466	.n_voltages = ARRAY_SIZE(ldo_k_typ_voltages),
a3beb742	467	.volt_table = ldo_k_typ_voltages,
d619bc14	468	.type = REGULATOR_VOLTAGE,
64714354	469	.owner = THIS_MODULE,
f8568cbd	470	.enable_time = 200,
d619bc14 LW	471	},
	472	{
	473	.name = "LDO_EXT",
	474	.id = AB3100_LDO_EXT,
	475	.ops = &regulator_ops_external,
	476	.type = REGULATOR_VOLTAGE,
64714354	477	.owner = THIS_MODULE,
d619bc14 LW	478	},
	479	{
	480	.name = "BUCK",
	481	.id = AB3100_BUCK,
	482	.ops = &regulator_ops_variable_sleepable,
75f2ba8f	483	.n_voltages = ARRAY_SIZE(ldo_e_buck_typ_voltages),
cfa9cfbc	484	.volt_table = ldo_e_buck_typ_voltages,
d619bc14	485	.type = REGULATOR_VOLTAGE,
64714354	486	.owner = THIS_MODULE,
f8568cbd	487	.enable_time = 1000,
d619bc14 LW	488	},
	489	};
	490
	491	/*
	492	* NOTE: the following functions are regulators pluralis - it is the
	493	* binding to the AB3100 core driver and the parent platform device
	494	* for all the different regulators.
	495	*/
	496
a5023574	497	static int ab3100_regulators_probe(struct platform_device *pdev)
d619bc14	498	{
a771e36e	499	struct ab3100_platform_data *plfdata = pdev->dev.platform_data;
c172708d	500	struct regulator_config config = { };
d619bc14 LW	501	int err = 0;
	502	u8 data;
	503	int i;
	504
	505	/* Check chip state */
fa661258	506	err = abx500_get_register_interruptible(&pdev->dev, 0,
d619bc14 LW	507	AB3100_LDO_D, &data);
	508	if (err) {
	509	dev_err(&pdev->dev, "could not read initial status of LDO_D\n");
	510	return err;
	511	}
	512	if (data & 0x10)
	513	dev_notice(&pdev->dev,
	514	"chip is already in active mode (Warm start)\n");
	515	else
	516	dev_notice(&pdev->dev,
	517	"chip is in inactive mode (Cold start)\n");
	518
	519	/* Set up regulators */
	520	for (i = 0; i < ARRAY_SIZE(ab3100_reg_init_order); i++) {
fa661258	521	err = abx500_set_register_interruptible(&pdev->dev, 0,
d619bc14 LW	522	ab3100_reg_init_order[i],
	523	plfdata->reg_initvals[i]);
	524	if (err) {
	525	dev_err(&pdev->dev, "regulator initialization failed with error %d\n",
	526	err);
	527	return err;
	528	}
	529	}
	530
d619bc14 LW	531	/* Register the regulators */
	532	for (i = 0; i < AB3100_NUM_REGULATORS; i++) {
	533	struct ab3100_regulator *reg = &ab3100_regulators[i];
	534	struct regulator_dev *rdev;
	535
	536	/*
	537	* Initialize per-regulator struct.
	538	* Inherit platform data, this comes down from the
	539	* i2c boarddata, from the machine. So if you want to
	540	* see what it looks like for a certain machine, go
	541	* into the machine I2C setup.
	542	*/
fa661258	543	reg->dev = &pdev->dev;
d619bc14 LW	544	reg->plfdata = plfdata;
d619bc14 LW	545
c172708d MB	546	config.dev = &pdev->dev;
	547	config.driver_data = reg;
	548	config.init_data = &plfdata->reg_constraints[i];
	549
d619bc14 LW	550	/*
	551	* Register the regulator, pass around
	552	* the ab3100_regulator struct
	553	*/
c172708d	554	rdev = regulator_register(&ab3100_regulator_desc[i], &config);
d619bc14 LW	555	if (IS_ERR(rdev)) {
	556	err = PTR_ERR(rdev);
	557	dev_err(&pdev->dev,
	558	"%s: failed to register regulator %s err %d\n",
	559	__func__, ab3100_regulator_desc[i].name,
	560	err);
d619bc14	561	/* remove the already registered regulators */
b3fcf3e5	562	while (--i >= 0)
d619bc14	563	regulator_unregister(ab3100_regulators[i].rdev);
d619bc14 LW	564	return err;
	565	}
	566
	567	/* Then set a pointer back to the registered regulator */
	568	reg->rdev = rdev;
	569	}
	570
	571	return 0;
	572	}
	573
98bf7c05	574	static int __devexit ab3100_regulators_remove(struct platform_device *pdev)
d619bc14 LW	575	{
	576	int i;
	577
	578	for (i = 0; i < AB3100_NUM_REGULATORS; i++) {
	579	struct ab3100_regulator *reg = &ab3100_regulators[i];
	580
	581	regulator_unregister(reg->rdev);
	582	}
	583	return 0;
	584	}
	585
	586	static struct platform_driver ab3100_regulators_driver = {
	587	.driver = {
	588	.name = "ab3100-regulators",
	589	.owner = THIS_MODULE,
	590	},
	591	.probe = ab3100_regulators_probe,
5eb9f2b9	592	.remove = ab3100_regulators_remove,
d619bc14 LW	593	};
	594
	595	static __init int ab3100_regulators_init(void)
	596	{
	597	return platform_driver_register(&ab3100_regulators_driver);
	598	}
	599
	600	static __exit void ab3100_regulators_exit(void)
	601	{
176f45b9	602	platform_driver_unregister(&ab3100_regulators_driver);
d619bc14 LW	603	}
	604
	605	subsys_initcall(ab3100_regulators_init);
	606	module_exit(ab3100_regulators_exit);
	607
	608	MODULE_AUTHOR("Mattias Wallin <mattias.wallin@stericsson.com>");
	609	MODULE_DESCRIPTION("AB3100 Regulator driver");
	610	MODULE_LICENSE("GPL");
	611	MODULE_ALIAS("platform:ab3100-regulators");