[mirror_ubuntu-hirsute-kernel.git] / drivers / regulator / wm831x-ldo.c

// SPDX-License-Identifier: GPL-2.0+
//
// wm831x-ldo.c  --  LDO driver for the WM831x series
//
// Copyright 2009 Wolfson Microelectronics PLC.
//
// Author: Mark Brown <broonie@opensource.wolfsonmicro.com>

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/init.h>
#include <linux/bitops.h>
#include <linux/err.h>
#include <linux/i2c.h>
#include <linux/platform_device.h>
#include <linux/regulator/driver.h>
#include <linux/slab.h>

#include <linux/mfd/wm831x/core.h>
#include <linux/mfd/wm831x/regulator.h>
#include <linux/mfd/wm831x/pdata.h>

#define WM831X_LDO_MAX_NAME 9

#define WM831X_LDO_CONTROL       0
#define WM831X_LDO_ON_CONTROL    1
#define WM831X_LDO_SLEEP_CONTROL 2

#define WM831X_ALIVE_LDO_ON_CONTROL    0
#define WM831X_ALIVE_LDO_SLEEP_CONTROL 1

struct wm831x_ldo {
	char name[WM831X_LDO_MAX_NAME];
	char supply_name[WM831X_LDO_MAX_NAME];
	struct regulator_desc desc;
	int base;
	struct wm831x *wm831x;
	struct regulator_dev *regulator;
};

/*
 * Shared
 */

static irqreturn_t wm831x_ldo_uv_irq(int irq, void *data)
{
	struct wm831x_ldo *ldo = data;

	regulator_notifier_call_chain(ldo->regulator,
				      REGULATOR_EVENT_UNDER_VOLTAGE,
				      NULL);

	return IRQ_HANDLED;
}

/*
 * General purpose LDOs
 */

static const struct linear_range wm831x_gp_ldo_ranges[] = {
	REGULATOR_LINEAR_RANGE(900000, 0, 14, 50000),
	REGULATOR_LINEAR_RANGE(1700000, 15, 31, 100000),
};

static int wm831x_gp_ldo_set_suspend_voltage(struct regulator_dev *rdev,
					     int uV)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;

	sel = regulator_map_voltage_linear_range(rdev, uV, uV);
	if (sel < 0)
		return sel;

	return wm831x_set_bits(wm831x, reg, WM831X_LDO1_ON_VSEL_MASK, sel);
}

static unsigned int wm831x_gp_ldo_get_mode(struct regulator_dev *rdev)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
	int ret;

	ret = wm831x_reg_read(wm831x, on_reg);
	if (ret < 0)
		return ret;

	if (!(ret & WM831X_LDO1_ON_MODE))
		return REGULATOR_MODE_NORMAL;

	ret = wm831x_reg_read(wm831x, ctrl_reg);
	if (ret < 0)
		return ret;

	if (ret & WM831X_LDO1_LP_MODE)
		return REGULATOR_MODE_STANDBY;
	else
		return REGULATOR_MODE_IDLE;
}

static int wm831x_gp_ldo_set_mode(struct regulator_dev *rdev,
				  unsigned int mode)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
	int ret;


	switch (mode) {
	case REGULATOR_MODE_NORMAL:
		ret = wm831x_set_bits(wm831x, on_reg,
				      WM831X_LDO1_ON_MODE, 0);
		if (ret < 0)
			return ret;
		break;

	case REGULATOR_MODE_IDLE:
		ret = wm831x_set_bits(wm831x, ctrl_reg,
				      WM831X_LDO1_LP_MODE, 0);
		if (ret < 0)
			return ret;

		ret = wm831x_set_bits(wm831x, on_reg,
				      WM831X_LDO1_ON_MODE,
				      WM831X_LDO1_ON_MODE);
		if (ret < 0)
			return ret;
		break;

	case REGULATOR_MODE_STANDBY:
		ret = wm831x_set_bits(wm831x, ctrl_reg,
				      WM831X_LDO1_LP_MODE,
				      WM831X_LDO1_LP_MODE);
		if (ret < 0)
			return ret;

		ret = wm831x_set_bits(wm831x, on_reg,
				      WM831X_LDO1_ON_MODE,
				      WM831X_LDO1_ON_MODE);
		if (ret < 0)
			return ret;
		break;

	default:
		return -EINVAL;
	}

	return 0;
}

static int wm831x_gp_ldo_get_status(struct regulator_dev *rdev)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int mask = 1 << rdev_get_id(rdev);
	int ret;

	/* Is the regulator on? */
	ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
	if (ret < 0)
		return ret;
	if (!(ret & mask))
		return REGULATOR_STATUS_OFF;

	/* Is it reporting under voltage? */
	ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
	if (ret < 0)
		return ret;
	if (ret & mask)
		return REGULATOR_STATUS_ERROR;

	ret = wm831x_gp_ldo_get_mode(rdev);
	if (ret < 0)
		return ret;
	else
		return regulator_mode_to_status(ret);
}

static unsigned int wm831x_gp_ldo_get_optimum_mode(struct regulator_dev *rdev,
						   int input_uV,
						   int output_uV, int load_uA)
{
	if (load_uA < 20000)
		return REGULATOR_MODE_STANDBY;
	if (load_uA < 50000)
		return REGULATOR_MODE_IDLE;
	return REGULATOR_MODE_NORMAL;
}


static const struct regulator_ops wm831x_gp_ldo_ops = {
	.list_voltage = regulator_list_voltage_linear_range,
	.map_voltage = regulator_map_voltage_linear_range,
	.get_voltage_sel = regulator_get_voltage_sel_regmap,
	.set_voltage_sel = regulator_set_voltage_sel_regmap,
	.set_suspend_voltage = wm831x_gp_ldo_set_suspend_voltage,
	.get_mode = wm831x_gp_ldo_get_mode,
	.set_mode = wm831x_gp_ldo_set_mode,
	.get_status = wm831x_gp_ldo_get_status,
	.get_optimum_mode = wm831x_gp_ldo_get_optimum_mode,
	.get_bypass = regulator_get_bypass_regmap,
	.set_bypass = regulator_set_bypass_regmap,

	.is_enabled = regulator_is_enabled_regmap,
	.enable = regulator_enable_regmap,
	.disable = regulator_disable_regmap,
};

static int wm831x_gp_ldo_probe(struct platform_device *pdev)
{
	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
	struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
	struct regulator_config config = { };
	int id;
	struct wm831x_ldo *ldo;
	struct resource *res;
	int ret, irq;

	if (pdata && pdata->wm831x_num)
		id = (pdata->wm831x_num * 10) + 1;
	else
		id = 0;
	id = pdev->id - id;

	dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);

	ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
	if (!ldo)
		return -ENOMEM;

	ldo->wm831x = wm831x;

	res = platform_get_resource(pdev, IORESOURCE_REG, 0);
	if (res == NULL) {
		dev_err(&pdev->dev, "No REG resource\n");
		ret = -EINVAL;
		goto err;
	}
	ldo->base = res->start;

	snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
	ldo->desc.name = ldo->name;

	snprintf(ldo->supply_name, sizeof(ldo->supply_name),
		 "LDO%dVDD", id + 1);
	ldo->desc.supply_name = ldo->supply_name;

	ldo->desc.id = id;
	ldo->desc.type = REGULATOR_VOLTAGE;
	ldo->desc.n_voltages = 32;
	ldo->desc.ops = &wm831x_gp_ldo_ops;
	ldo->desc.owner = THIS_MODULE;
	ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
	ldo->desc.vsel_mask = WM831X_LDO1_ON_VSEL_MASK;
	ldo->desc.enable_reg = WM831X_LDO_ENABLE;
	ldo->desc.enable_mask = 1 << id;
	ldo->desc.bypass_reg = ldo->base;
	ldo->desc.bypass_mask = WM831X_LDO1_SWI;
	ldo->desc.linear_ranges = wm831x_gp_ldo_ranges;
	ldo->desc.n_linear_ranges = ARRAY_SIZE(wm831x_gp_ldo_ranges);

	config.dev = pdev->dev.parent;
	if (pdata)
		config.init_data = pdata->ldo[id];
	config.driver_data = ldo;
	config.regmap = wm831x->regmap;

	ldo->regulator = devm_regulator_register(&pdev->dev, &ldo->desc,
						 &config);
	if (IS_ERR(ldo->regulator)) {
		ret = PTR_ERR(ldo->regulator);
		dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
			id + 1, ret);
		goto err;
	}

	irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
	ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
					wm831x_ldo_uv_irq,
					IRQF_TRIGGER_RISING | IRQF_ONESHOT,
					ldo->name,
					ldo);
	if (ret != 0) {
		dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
			irq, ret);
		goto err;
	}

	platform_set_drvdata(pdev, ldo);

	return 0;

err:
	return ret;
}

static struct platform_driver wm831x_gp_ldo_driver = {
	.probe = wm831x_gp_ldo_probe,
	.driver		= {
		.name	= "wm831x-ldo",
	},
};

/*
 * Analogue LDOs
 */

static const struct linear_range wm831x_aldo_ranges[] = {
	REGULATOR_LINEAR_RANGE(1000000, 0, 12, 50000),
	REGULATOR_LINEAR_RANGE(1700000, 13, 31, 100000),
};

static int wm831x_aldo_set_suspend_voltage(struct regulator_dev *rdev,
					     int uV)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;

	sel = regulator_map_voltage_linear_range(rdev, uV, uV);
	if (sel < 0)
		return sel;

	return wm831x_set_bits(wm831x, reg, WM831X_LDO7_ON_VSEL_MASK, sel);
}

static unsigned int wm831x_aldo_get_mode(struct regulator_dev *rdev)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
	int ret;

	ret = wm831x_reg_read(wm831x, on_reg);
	if (ret < 0)
		return 0;

	if (ret & WM831X_LDO7_ON_MODE)
		return REGULATOR_MODE_IDLE;
	else
		return REGULATOR_MODE_NORMAL;
}

static int wm831x_aldo_set_mode(struct regulator_dev *rdev,
				  unsigned int mode)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
	int ret;


	switch (mode) {
	case REGULATOR_MODE_NORMAL:
		ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE, 0);
		if (ret < 0)
			return ret;
		break;

	case REGULATOR_MODE_IDLE:
		ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE,
				      WM831X_LDO7_ON_MODE);
		if (ret < 0)
			return ret;
		break;

	default:
		return -EINVAL;
	}

	return 0;
}

static int wm831x_aldo_get_status(struct regulator_dev *rdev)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int mask = 1 << rdev_get_id(rdev);
	int ret;

	/* Is the regulator on? */
	ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
	if (ret < 0)
		return ret;
	if (!(ret & mask))
		return REGULATOR_STATUS_OFF;

	/* Is it reporting under voltage? */
	ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
	if (ret < 0)
		return ret;
	if (ret & mask)
		return REGULATOR_STATUS_ERROR;

	ret = wm831x_aldo_get_mode(rdev);
	if (ret < 0)
		return ret;
	else
		return regulator_mode_to_status(ret);
}

static const struct regulator_ops wm831x_aldo_ops = {
	.list_voltage = regulator_list_voltage_linear_range,
	.map_voltage = regulator_map_voltage_linear_range,
	.get_voltage_sel = regulator_get_voltage_sel_regmap,
	.set_voltage_sel = regulator_set_voltage_sel_regmap,
	.set_suspend_voltage = wm831x_aldo_set_suspend_voltage,
	.get_mode = wm831x_aldo_get_mode,
	.set_mode = wm831x_aldo_set_mode,
	.get_status = wm831x_aldo_get_status,
	.set_bypass = regulator_set_bypass_regmap,
	.get_bypass = regulator_get_bypass_regmap,

	.is_enabled = regulator_is_enabled_regmap,
	.enable = regulator_enable_regmap,
	.disable = regulator_disable_regmap,
};

static int wm831x_aldo_probe(struct platform_device *pdev)
{
	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
	struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
	struct regulator_config config = { };
	int id;
	struct wm831x_ldo *ldo;
	struct resource *res;
	int ret, irq;

	if (pdata && pdata->wm831x_num)
		id = (pdata->wm831x_num * 10) + 1;
	else
		id = 0;
	id = pdev->id - id;

	dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);

	ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
	if (!ldo)
		return -ENOMEM;

	ldo->wm831x = wm831x;

	res = platform_get_resource(pdev, IORESOURCE_REG, 0);
	if (res == NULL) {
		dev_err(&pdev->dev, "No REG resource\n");
		ret = -EINVAL;
		goto err;
	}
	ldo->base = res->start;

	snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
	ldo->desc.name = ldo->name;

	snprintf(ldo->supply_name, sizeof(ldo->supply_name),
		 "LDO%dVDD", id + 1);
	ldo->desc.supply_name = ldo->supply_name;

	ldo->desc.id = id;
	ldo->desc.type = REGULATOR_VOLTAGE;
	ldo->desc.n_voltages = 32;
	ldo->desc.linear_ranges = wm831x_aldo_ranges;
	ldo->desc.n_linear_ranges = ARRAY_SIZE(wm831x_aldo_ranges);
	ldo->desc.ops = &wm831x_aldo_ops;
	ldo->desc.owner = THIS_MODULE;
	ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
	ldo->desc.vsel_mask = WM831X_LDO7_ON_VSEL_MASK;
	ldo->desc.enable_reg = WM831X_LDO_ENABLE;
	ldo->desc.enable_mask = 1 << id;
	ldo->desc.bypass_reg = ldo->base;
	ldo->desc.bypass_mask = WM831X_LDO7_SWI;

	config.dev = pdev->dev.parent;
	if (pdata)
		config.init_data = pdata->ldo[id];
	config.driver_data = ldo;
	config.regmap = wm831x->regmap;

	ldo->regulator = devm_regulator_register(&pdev->dev, &ldo->desc,
						 &config);
	if (IS_ERR(ldo->regulator)) {
		ret = PTR_ERR(ldo->regulator);
		dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
			id + 1, ret);
		goto err;
	}

	irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
	ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
					wm831x_ldo_uv_irq,
					IRQF_TRIGGER_RISING | IRQF_ONESHOT,
					ldo->name, ldo);
	if (ret != 0) {
		dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
			irq, ret);
		goto err;
	}

	platform_set_drvdata(pdev, ldo);

	return 0;

err:
	return ret;
}

static struct platform_driver wm831x_aldo_driver = {
	.probe = wm831x_aldo_probe,
	.driver		= {
		.name	= "wm831x-aldo",
	},
};

/*
 * Alive LDO
 */

#define WM831X_ALIVE_LDO_MAX_SELECTOR 0xf

static int wm831x_alive_ldo_set_suspend_voltage(struct regulator_dev *rdev,
					     int uV)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int sel, reg = ldo->base + WM831X_ALIVE_LDO_SLEEP_CONTROL;

	sel = regulator_map_voltage_linear(rdev, uV, uV);
	if (sel < 0)
		return sel;

	return wm831x_set_bits(wm831x, reg, WM831X_LDO11_ON_VSEL_MASK, sel);
}

static int wm831x_alive_ldo_get_status(struct regulator_dev *rdev)
{
	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	struct wm831x *wm831x = ldo->wm831x;
	int mask = 1 << rdev_get_id(rdev);
	int ret;

	/* Is the regulator on? */
	ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
	if (ret < 0)
		return ret;
	if (ret & mask)
		return REGULATOR_STATUS_ON;
	else
		return REGULATOR_STATUS_OFF;
}

static const struct regulator_ops wm831x_alive_ldo_ops = {
	.list_voltage = regulator_list_voltage_linear,
	.map_voltage = regulator_map_voltage_linear,
	.get_voltage_sel = regulator_get_voltage_sel_regmap,
	.set_voltage_sel = regulator_set_voltage_sel_regmap,
	.set_suspend_voltage = wm831x_alive_ldo_set_suspend_voltage,
	.get_status = wm831x_alive_ldo_get_status,

	.is_enabled = regulator_is_enabled_regmap,
	.enable = regulator_enable_regmap,
	.disable = regulator_disable_regmap,
};

static int wm831x_alive_ldo_probe(struct platform_device *pdev)
{
	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
	struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
	struct regulator_config config = { };
	int id;
	struct wm831x_ldo *ldo;
	struct resource *res;
	int ret;

	if (pdata && pdata->wm831x_num)
		id = (pdata->wm831x_num * 10) + 1;
	else
		id = 0;
	id = pdev->id - id;


	dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);

	ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
	if (!ldo)
		return -ENOMEM;

	ldo->wm831x = wm831x;

	res = platform_get_resource(pdev, IORESOURCE_REG, 0);
	if (res == NULL) {
		dev_err(&pdev->dev, "No REG resource\n");
		ret = -EINVAL;
		goto err;
	}
	ldo->base = res->start;

	snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
	ldo->desc.name = ldo->name;

	snprintf(ldo->supply_name, sizeof(ldo->supply_name),
		 "LDO%dVDD", id + 1);
	ldo->desc.supply_name = ldo->supply_name;

	ldo->desc.id = id;
	ldo->desc.type = REGULATOR_VOLTAGE;
	ldo->desc.n_voltages = WM831X_ALIVE_LDO_MAX_SELECTOR + 1;
	ldo->desc.ops = &wm831x_alive_ldo_ops;
	ldo->desc.owner = THIS_MODULE;
	ldo->desc.vsel_reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
	ldo->desc.vsel_mask = WM831X_LDO11_ON_VSEL_MASK;
	ldo->desc.enable_reg = WM831X_LDO_ENABLE;
	ldo->desc.enable_mask = 1 << id;
	ldo->desc.min_uV = 800000;
	ldo->desc.uV_step = 50000;
	ldo->desc.enable_time = 1000;

	config.dev = pdev->dev.parent;
	if (pdata)
		config.init_data = pdata->ldo[id];
	config.driver_data = ldo;
	config.regmap = wm831x->regmap;

	ldo->regulator = devm_regulator_register(&pdev->dev, &ldo->desc,
						 &config);
	if (IS_ERR(ldo->regulator)) {
		ret = PTR_ERR(ldo->regulator);
		dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
			id + 1, ret);
		goto err;
	}

	platform_set_drvdata(pdev, ldo);

	return 0;

err:
	return ret;
}

static struct platform_driver wm831x_alive_ldo_driver = {
	.probe = wm831x_alive_ldo_probe,
	.driver		= {
		.name	= "wm831x-alive-ldo",
	},
};

static struct platform_driver * const drivers[] = {
	&wm831x_gp_ldo_driver,
	&wm831x_aldo_driver,
	&wm831x_alive_ldo_driver,
};

static int __init wm831x_ldo_init(void)
{
	return platform_register_drivers(drivers, ARRAY_SIZE(drivers));
}
subsys_initcall(wm831x_ldo_init);

static void __exit wm831x_ldo_exit(void)
{
	platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));
}
module_exit(wm831x_ldo_exit);

/* Module information */
MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
MODULE_DESCRIPTION("WM831x LDO driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:wm831x-ldo");
MODULE_ALIAS("platform:wm831x-aldo");
MODULE_ALIAS("platform:wm831x-aliveldo");
Commit	Line	Data
3cad5fc8 AL	1	// SPDX-License-Identifier: GPL-2.0+
	2	//
	3	// wm831x-ldo.c -- LDO driver for the WM831x series
	4	//
	5	// Copyright 2009 Wolfson Microelectronics PLC.
	6	//
	7	// Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
d1c6b4fe MB	8
	9	#include <linux/module.h>
	10	#include <linux/moduleparam.h>
	11	#include <linux/init.h>
	12	#include <linux/bitops.h>
	13	#include <linux/err.h>
	14	#include <linux/i2c.h>
	15	#include <linux/platform_device.h>
	16	#include <linux/regulator/driver.h>
5a0e3ad6	17	#include <linux/slab.h>
d1c6b4fe MB	18
	19	#include <linux/mfd/wm831x/core.h>
	20	#include <linux/mfd/wm831x/regulator.h>
	21	#include <linux/mfd/wm831x/pdata.h>
	22
f1aba13f	23	#define WM831X_LDO_MAX_NAME 9
d1c6b4fe MB	24
	25	#define WM831X_LDO_CONTROL 0
	26	#define WM831X_LDO_ON_CONTROL 1
	27	#define WM831X_LDO_SLEEP_CONTROL 2
	28
	29	#define WM831X_ALIVE_LDO_ON_CONTROL 0
	30	#define WM831X_ALIVE_LDO_SLEEP_CONTROL 1
	31
	32	struct wm831x_ldo {
	33	char name[WM831X_LDO_MAX_NAME];
f1aba13f	34	char supply_name[WM831X_LDO_MAX_NAME];
d1c6b4fe MB	35	struct regulator_desc desc;
	36	int base;
	37	struct wm831x *wm831x;
	38	struct regulator_dev *regulator;
	39	};
	40
	41	/*
	42	* Shared
	43	*/
	44
d1c6b4fe MB	45	static irqreturn_t wm831x_ldo_uv_irq(int irq, void *data)
	46	{
	47	struct wm831x_ldo *ldo = data;
	48
	49	regulator_notifier_call_chain(ldo->regulator,
	50	REGULATOR_EVENT_UNDER_VOLTAGE,
	51	NULL);
	52
	53	return IRQ_HANDLED;
	54	}
	55
	56	/*
	57	* General purpose LDOs
	58	*/
	59
60ab7f41	60	static const struct linear_range wm831x_gp_ldo_ranges[] = {
8828bae4 AL	61	REGULATOR_LINEAR_RANGE(900000, 0, 14, 50000),
8828bae4 AL	62	REGULATOR_LINEAR_RANGE(1700000, 15, 31, 100000),
5ff26a14	63	};
d1c6b4fe MB	64
	65	static int wm831x_gp_ldo_set_suspend_voltage(struct regulator_dev *rdev,
	66	int uV)
	67	{
	68	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
0a479689 AL	69	struct wm831x *wm831x = ldo->wm831x;
0a479689 AL	70	int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
d1c6b4fe	71
5ff26a14	72	sel = regulator_map_voltage_linear_range(rdev, uV, uV);
0a479689 AL	73	if (sel < 0)
	74	return sel;
	75
	76	return wm831x_set_bits(wm831x, reg, WM831X_LDO1_ON_VSEL_MASK, sel);
d1c6b4fe MB	77	}
d1c6b4fe MB	78
d1c6b4fe MB	79	static unsigned int wm831x_gp_ldo_get_mode(struct regulator_dev *rdev)
	80	{
	81	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	82	struct wm831x *wm831x = ldo->wm831x;
	83	int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
	84	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
9a767d43	85	int ret;
d1c6b4fe MB	86
	87	ret = wm831x_reg_read(wm831x, on_reg);
	88	if (ret < 0)
9a767d43	89	return ret;
d1c6b4fe MB	90
	91	if (!(ret & WM831X_LDO1_ON_MODE))
	92	return REGULATOR_MODE_NORMAL;
	93
	94	ret = wm831x_reg_read(wm831x, ctrl_reg);
	95	if (ret < 0)
9a767d43	96	return ret;
d1c6b4fe MB	97
	98	if (ret & WM831X_LDO1_LP_MODE)
	99	return REGULATOR_MODE_STANDBY;
	100	else
	101	return REGULATOR_MODE_IDLE;
	102	}
	103
	104	static int wm831x_gp_ldo_set_mode(struct regulator_dev *rdev,
	105	unsigned int mode)
	106	{
	107	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	108	struct wm831x *wm831x = ldo->wm831x;
	109	int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
	110	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
	111	int ret;
	112
	113
	114	switch (mode) {
	115	case REGULATOR_MODE_NORMAL:
	116	ret = wm831x_set_bits(wm831x, on_reg,
	117	WM831X_LDO1_ON_MODE, 0);
	118	if (ret < 0)
	119	return ret;
	120	break;
	121
	122	case REGULATOR_MODE_IDLE:
	123	ret = wm831x_set_bits(wm831x, ctrl_reg,
e260999c	124	WM831X_LDO1_LP_MODE, 0);
d1c6b4fe MB	125	if (ret < 0)
	126	return ret;
	127
	128	ret = wm831x_set_bits(wm831x, on_reg,
	129	WM831X_LDO1_ON_MODE,
	130	WM831X_LDO1_ON_MODE);
	131	if (ret < 0)
	132	return ret;
e260999c	133	break;
d1c6b4fe MB	134
	135	case REGULATOR_MODE_STANDBY:
	136	ret = wm831x_set_bits(wm831x, ctrl_reg,
e260999c AL	137	WM831X_LDO1_LP_MODE,
e260999c AL	138	WM831X_LDO1_LP_MODE);
d1c6b4fe MB	139	if (ret < 0)
	140	return ret;
	141
	142	ret = wm831x_set_bits(wm831x, on_reg,
	143	WM831X_LDO1_ON_MODE,
	144	WM831X_LDO1_ON_MODE);
	145	if (ret < 0)
	146	return ret;
	147	break;
	148
	149	default:
	150	return -EINVAL;
	151	}
	152
	153	return 0;
	154	}
	155
	156	static int wm831x_gp_ldo_get_status(struct regulator_dev *rdev)
	157	{
	158	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	159	struct wm831x *wm831x = ldo->wm831x;
	160	int mask = 1 << rdev_get_id(rdev);
	161	int ret;
	162
	163	/* Is the regulator on? */
	164	ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
	165	if (ret < 0)
	166	return ret;
	167	if (!(ret & mask))
	168	return REGULATOR_STATUS_OFF;
	169
	170	/* Is it reporting under voltage? */
	171	ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
363506cd AL	172	if (ret < 0)
363506cd AL	173	return ret;
d1c6b4fe MB	174	if (ret & mask)
	175	return REGULATOR_STATUS_ERROR;
	176
	177	ret = wm831x_gp_ldo_get_mode(rdev);
	178	if (ret < 0)
	179	return ret;
	180	else
	181	return regulator_mode_to_status(ret);
	182	}
	183
	184	static unsigned int wm831x_gp_ldo_get_optimum_mode(struct regulator_dev *rdev,
	185	int input_uV,
	186	int output_uV, int load_uA)
	187	{
	188	if (load_uA < 20000)
	189	return REGULATOR_MODE_STANDBY;
	190	if (load_uA < 50000)
	191	return REGULATOR_MODE_IDLE;
	192	return REGULATOR_MODE_NORMAL;
	193	}
	194
	195
b0d6dd3b	196	static const struct regulator_ops wm831x_gp_ldo_ops = {
5ff26a14 MB	197	.list_voltage = regulator_list_voltage_linear_range,
5ff26a14 MB	198	.map_voltage = regulator_map_voltage_linear_range,
ac663b47	199	.get_voltage_sel = regulator_get_voltage_sel_regmap,
0a479689	200	.set_voltage_sel = regulator_set_voltage_sel_regmap,
d1c6b4fe MB	201	.set_suspend_voltage = wm831x_gp_ldo_set_suspend_voltage,
	202	.get_mode = wm831x_gp_ldo_get_mode,
	203	.set_mode = wm831x_gp_ldo_set_mode,
	204	.get_status = wm831x_gp_ldo_get_status,
	205	.get_optimum_mode = wm831x_gp_ldo_get_optimum_mode,
22c5fb6a MB	206	.get_bypass = regulator_get_bypass_regmap,
22c5fb6a MB	207	.set_bypass = regulator_set_bypass_regmap,
d1c6b4fe	208
ca8c361b MB	209	.is_enabled = regulator_is_enabled_regmap,
	210	.enable = regulator_enable_regmap,
	211	.disable = regulator_disable_regmap,
d1c6b4fe MB	212	};
d1c6b4fe MB	213
a5023574	214	static int wm831x_gp_ldo_probe(struct platform_device *pdev)
d1c6b4fe MB	215	{
d1c6b4fe MB	216	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
dff91d0b	217	struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
c172708d	218	struct regulator_config config = { };
137a6354	219	int id;
d1c6b4fe MB	220	struct wm831x_ldo *ldo;
	221	struct resource *res;
	222	int ret, irq;
	223
137a6354 MB	224	if (pdata && pdata->wm831x_num)
	225	id = (pdata->wm831x_num * 10) + 1;
	226	else
	227	id = 0;
	228	id = pdev->id - id;
	229
d1c6b4fe MB	230	dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
d1c6b4fe MB	231
fded2f4f	232	ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
fae3b836	233	if (!ldo)
d1c6b4fe	234	return -ENOMEM;
d1c6b4fe MB	235
	236	ldo->wm831x = wm831x;
	237
5656098e	238	res = platform_get_resource(pdev, IORESOURCE_REG, 0);
d1c6b4fe	239	if (res == NULL) {
5656098e	240	dev_err(&pdev->dev, "No REG resource\n");
d1c6b4fe MB	241	ret = -EINVAL;
	242	goto err;
	243	}
	244	ldo->base = res->start;
	245
	246	snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
	247	ldo->desc.name = ldo->name;
f1aba13f MB	248
	249	snprintf(ldo->supply_name, sizeof(ldo->supply_name),
	250	"LDO%dVDD", id + 1);
	251	ldo->desc.supply_name = ldo->supply_name;
	252
d1c6b4fe MB	253	ldo->desc.id = id;
d1c6b4fe MB	254	ldo->desc.type = REGULATOR_VOLTAGE;
5ff26a14	255	ldo->desc.n_voltages = 32;
d1c6b4fe MB	256	ldo->desc.ops = &wm831x_gp_ldo_ops;
d1c6b4fe MB	257	ldo->desc.owner = THIS_MODULE;
ac663b47 MB	258	ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
ac663b47 MB	259	ldo->desc.vsel_mask = WM831X_LDO1_ON_VSEL_MASK;
ca8c361b MB	260	ldo->desc.enable_reg = WM831X_LDO_ENABLE;
ca8c361b MB	261	ldo->desc.enable_mask = 1 << id;
22c5fb6a MB	262	ldo->desc.bypass_reg = ldo->base;
22c5fb6a MB	263	ldo->desc.bypass_mask = WM831X_LDO1_SWI;
5ff26a14 MB	264	ldo->desc.linear_ranges = wm831x_gp_ldo_ranges;
5ff26a14 MB	265	ldo->desc.n_linear_ranges = ARRAY_SIZE(wm831x_gp_ldo_ranges);
d1c6b4fe	266
c172708d	267	config.dev = pdev->dev.parent;
b7ca8788 MB	268	if (pdata)
b7ca8788 MB	269	config.init_data = pdata->ldo[id];
c172708d	270	config.driver_data = ldo;
ac663b47	271	config.regmap = wm831x->regmap;
c172708d	272
fc7c60e3 MB	273	ldo->regulator = devm_regulator_register(&pdev->dev, &ldo->desc,
fc7c60e3 MB	274	&config);
d1c6b4fe MB	275	if (IS_ERR(ldo->regulator)) {
	276	ret = PTR_ERR(ldo->regulator);
	277	dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
	278	id + 1, ret);
	279	goto err;
	280	}
	281
cd99758b	282	irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
41c7a879 MB	283	ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
41c7a879 MB	284	wm831x_ldo_uv_irq,
29454738 FE	285	IRQF_TRIGGER_RISING \| IRQF_ONESHOT,
29454738 FE	286	ldo->name,
41c7a879	287	ldo);
d1c6b4fe MB	288	if (ret != 0) {
	289	dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
	290	irq, ret);
fc7c60e3	291	goto err;
d1c6b4fe MB	292	}
	293
	294	platform_set_drvdata(pdev, ldo);
	295
	296	return 0;
	297
d1c6b4fe	298	err:
d1c6b4fe MB	299	return ret;
	300	}
	301
d1c6b4fe MB	302	static struct platform_driver wm831x_gp_ldo_driver = {
d1c6b4fe MB	303	.probe = wm831x_gp_ldo_probe,
d1c6b4fe MB	304	.driver = {
	305	.name = "wm831x-ldo",
	306	},
	307	};
	308
	309	/*
	310	* Analogue LDOs
	311	*/
	312
60ab7f41	313	static const struct linear_range wm831x_aldo_ranges[] = {
8828bae4 AL	314	REGULATOR_LINEAR_RANGE(1000000, 0, 12, 50000),
8828bae4 AL	315	REGULATOR_LINEAR_RANGE(1700000, 13, 31, 100000),
5ff26a14	316	};
d1c6b4fe MB	317
	318	static int wm831x_aldo_set_suspend_voltage(struct regulator_dev *rdev,
	319	int uV)
	320	{
	321	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
0a479689 AL	322	struct wm831x *wm831x = ldo->wm831x;
	323	int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
	324
5ff26a14	325	sel = regulator_map_voltage_linear_range(rdev, uV, uV);
0a479689 AL	326	if (sel < 0)
0a479689 AL	327	return sel;
d1c6b4fe	328
0a479689	329	return wm831x_set_bits(wm831x, reg, WM831X_LDO7_ON_VSEL_MASK, sel);
d1c6b4fe MB	330	}
d1c6b4fe MB	331
d1c6b4fe MB	332	static unsigned int wm831x_aldo_get_mode(struct regulator_dev *rdev)
	333	{
	334	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	335	struct wm831x *wm831x = ldo->wm831x;
	336	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
6f17c652	337	int ret;
d1c6b4fe MB	338
	339	ret = wm831x_reg_read(wm831x, on_reg);
	340	if (ret < 0)
	341	return 0;
	342
	343	if (ret & WM831X_LDO7_ON_MODE)
	344	return REGULATOR_MODE_IDLE;
	345	else
	346	return REGULATOR_MODE_NORMAL;
	347	}
	348
	349	static int wm831x_aldo_set_mode(struct regulator_dev *rdev,
	350	unsigned int mode)
	351	{
	352	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	353	struct wm831x *wm831x = ldo->wm831x;
d1c6b4fe MB	354	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
	355	int ret;
	356
	357
	358	switch (mode) {
	359	case REGULATOR_MODE_NORMAL:
e841a36a	360	ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE, 0);
d1c6b4fe MB	361	if (ret < 0)
	362	return ret;
	363	break;
	364
	365	case REGULATOR_MODE_IDLE:
e841a36a	366	ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE,
d1c6b4fe MB	367	WM831X_LDO7_ON_MODE);
	368	if (ret < 0)
	369	return ret;
	370	break;
	371
	372	default:
	373	return -EINVAL;
	374	}
	375
	376	return 0;
	377	}
	378
	379	static int wm831x_aldo_get_status(struct regulator_dev *rdev)
	380	{
	381	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	382	struct wm831x *wm831x = ldo->wm831x;
	383	int mask = 1 << rdev_get_id(rdev);
	384	int ret;
	385
	386	/* Is the regulator on? */
	387	ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
	388	if (ret < 0)
	389	return ret;
	390	if (!(ret & mask))
	391	return REGULATOR_STATUS_OFF;
	392
	393	/* Is it reporting under voltage? */
	394	ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
363506cd AL	395	if (ret < 0)
363506cd AL	396	return ret;
d1c6b4fe MB	397	if (ret & mask)
	398	return REGULATOR_STATUS_ERROR;
	399
	400	ret = wm831x_aldo_get_mode(rdev);
	401	if (ret < 0)
	402	return ret;
	403	else
	404	return regulator_mode_to_status(ret);
	405	}
	406
b0d6dd3b	407	static const struct regulator_ops wm831x_aldo_ops = {
5ff26a14 MB	408	.list_voltage = regulator_list_voltage_linear_range,
5ff26a14 MB	409	.map_voltage = regulator_map_voltage_linear_range,
ac663b47	410	.get_voltage_sel = regulator_get_voltage_sel_regmap,
0a479689	411	.set_voltage_sel = regulator_set_voltage_sel_regmap,
d1c6b4fe MB	412	.set_suspend_voltage = wm831x_aldo_set_suspend_voltage,
	413	.get_mode = wm831x_aldo_get_mode,
	414	.set_mode = wm831x_aldo_set_mode,
	415	.get_status = wm831x_aldo_get_status,
22c5fb6a MB	416	.set_bypass = regulator_set_bypass_regmap,
22c5fb6a MB	417	.get_bypass = regulator_get_bypass_regmap,
d1c6b4fe	418
ca8c361b MB	419	.is_enabled = regulator_is_enabled_regmap,
	420	.enable = regulator_enable_regmap,
	421	.disable = regulator_disable_regmap,
d1c6b4fe MB	422	};
d1c6b4fe MB	423
a5023574	424	static int wm831x_aldo_probe(struct platform_device *pdev)
d1c6b4fe MB	425	{
d1c6b4fe MB	426	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
dff91d0b	427	struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
c172708d	428	struct regulator_config config = { };
137a6354	429	int id;
d1c6b4fe MB	430	struct wm831x_ldo *ldo;
	431	struct resource *res;
	432	int ret, irq;
	433
137a6354 MB	434	if (pdata && pdata->wm831x_num)
	435	id = (pdata->wm831x_num * 10) + 1;
	436	else
	437	id = 0;
	438	id = pdev->id - id;
	439
d1c6b4fe MB	440	dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
d1c6b4fe MB	441
fded2f4f	442	ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
fae3b836	443	if (!ldo)
d1c6b4fe	444	return -ENOMEM;
d1c6b4fe MB	445
	446	ldo->wm831x = wm831x;
	447
5656098e	448	res = platform_get_resource(pdev, IORESOURCE_REG, 0);
d1c6b4fe	449	if (res == NULL) {
5656098e	450	dev_err(&pdev->dev, "No REG resource\n");
d1c6b4fe MB	451	ret = -EINVAL;
	452	goto err;
	453	}
	454	ldo->base = res->start;
	455
	456	snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
	457	ldo->desc.name = ldo->name;
f1aba13f MB	458
	459	snprintf(ldo->supply_name, sizeof(ldo->supply_name),
	460	"LDO%dVDD", id + 1);
	461	ldo->desc.supply_name = ldo->supply_name;
	462
d1c6b4fe MB	463	ldo->desc.id = id;
d1c6b4fe MB	464	ldo->desc.type = REGULATOR_VOLTAGE;
5ff26a14 MB	465	ldo->desc.n_voltages = 32;
	466	ldo->desc.linear_ranges = wm831x_aldo_ranges;
	467	ldo->desc.n_linear_ranges = ARRAY_SIZE(wm831x_aldo_ranges);
d1c6b4fe MB	468	ldo->desc.ops = &wm831x_aldo_ops;
d1c6b4fe MB	469	ldo->desc.owner = THIS_MODULE;
ac663b47 MB	470	ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
ac663b47 MB	471	ldo->desc.vsel_mask = WM831X_LDO7_ON_VSEL_MASK;
ca8c361b MB	472	ldo->desc.enable_reg = WM831X_LDO_ENABLE;
ca8c361b MB	473	ldo->desc.enable_mask = 1 << id;
22c5fb6a MB	474	ldo->desc.bypass_reg = ldo->base;
22c5fb6a MB	475	ldo->desc.bypass_mask = WM831X_LDO7_SWI;
d1c6b4fe	476
c172708d	477	config.dev = pdev->dev.parent;
b7ca8788 MB	478	if (pdata)
b7ca8788 MB	479	config.init_data = pdata->ldo[id];
c172708d	480	config.driver_data = ldo;
ac663b47	481	config.regmap = wm831x->regmap;
c172708d	482
fc7c60e3 MB	483	ldo->regulator = devm_regulator_register(&pdev->dev, &ldo->desc,
fc7c60e3 MB	484	&config);
d1c6b4fe MB	485	if (IS_ERR(ldo->regulator)) {
	486	ret = PTR_ERR(ldo->regulator);
	487	dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
	488	id + 1, ret);
	489	goto err;
	490	}
	491
cd99758b	492	irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
41c7a879 MB	493	ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
41c7a879 MB	494	wm831x_ldo_uv_irq,
29454738 FE	495	IRQF_TRIGGER_RISING \| IRQF_ONESHOT,
29454738 FE	496	ldo->name, ldo);
d1c6b4fe MB	497	if (ret != 0) {
	498	dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
	499	irq, ret);
fc7c60e3	500	goto err;
d1c6b4fe MB	501	}
	502
	503	platform_set_drvdata(pdev, ldo);
	504
	505	return 0;
	506
d1c6b4fe	507	err:
d1c6b4fe MB	508	return ret;
	509	}
	510
d1c6b4fe MB	511	static struct platform_driver wm831x_aldo_driver = {
d1c6b4fe MB	512	.probe = wm831x_aldo_probe,
d1c6b4fe MB	513	.driver = {
	514	.name = "wm831x-aldo",
	515	},
	516	};
	517
	518	/*
	519	* Alive LDO
	520	*/
	521
	522	#define WM831X_ALIVE_LDO_MAX_SELECTOR 0xf
	523
d1c6b4fe MB	524	static int wm831x_alive_ldo_set_suspend_voltage(struct regulator_dev *rdev,
	525	int uV)
	526	{
	527	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
0a479689 AL	528	struct wm831x *wm831x = ldo->wm831x;
	529	int sel, reg = ldo->base + WM831X_ALIVE_LDO_SLEEP_CONTROL;
	530
	531	sel = regulator_map_voltage_linear(rdev, uV, uV);
	532	if (sel < 0)
	533	return sel;
d1c6b4fe	534
0a479689	535	return wm831x_set_bits(wm831x, reg, WM831X_LDO11_ON_VSEL_MASK, sel);
d1c6b4fe MB	536	}
d1c6b4fe MB	537
d1c6b4fe MB	538	static int wm831x_alive_ldo_get_status(struct regulator_dev *rdev)
	539	{
	540	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
	541	struct wm831x *wm831x = ldo->wm831x;
	542	int mask = 1 << rdev_get_id(rdev);
	543	int ret;
	544
	545	/* Is the regulator on? */
	546	ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
	547	if (ret < 0)
	548	return ret;
	549	if (ret & mask)
	550	return REGULATOR_STATUS_ON;
	551	else
	552	return REGULATOR_STATUS_OFF;
	553	}
	554
b0d6dd3b	555	static const struct regulator_ops wm831x_alive_ldo_ops = {
d31e954e	556	.list_voltage = regulator_list_voltage_linear,
c2543b5f	557	.map_voltage = regulator_map_voltage_linear,
ac663b47	558	.get_voltage_sel = regulator_get_voltage_sel_regmap,
0a479689	559	.set_voltage_sel = regulator_set_voltage_sel_regmap,
d1c6b4fe MB	560	.set_suspend_voltage = wm831x_alive_ldo_set_suspend_voltage,
	561	.get_status = wm831x_alive_ldo_get_status,
	562
ca8c361b MB	563	.is_enabled = regulator_is_enabled_regmap,
	564	.enable = regulator_enable_regmap,
	565	.disable = regulator_disable_regmap,
d1c6b4fe MB	566	};
d1c6b4fe MB	567
a5023574	568	static int wm831x_alive_ldo_probe(struct platform_device *pdev)
d1c6b4fe MB	569	{
d1c6b4fe MB	570	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
dff91d0b	571	struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
c172708d	572	struct regulator_config config = { };
137a6354	573	int id;
d1c6b4fe MB	574	struct wm831x_ldo *ldo;
	575	struct resource *res;
	576	int ret;
	577
137a6354 MB	578	if (pdata && pdata->wm831x_num)
	579	id = (pdata->wm831x_num * 10) + 1;
	580	else
	581	id = 0;
	582	id = pdev->id - id;
	583
	584
d1c6b4fe MB	585	dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
d1c6b4fe MB	586
fded2f4f	587	ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
fae3b836	588	if (!ldo)
d1c6b4fe	589	return -ENOMEM;
d1c6b4fe MB	590
	591	ldo->wm831x = wm831x;
	592
5656098e	593	res = platform_get_resource(pdev, IORESOURCE_REG, 0);
d1c6b4fe	594	if (res == NULL) {
5656098e	595	dev_err(&pdev->dev, "No REG resource\n");
d1c6b4fe MB	596	ret = -EINVAL;
	597	goto err;
	598	}
	599	ldo->base = res->start;
	600
	601	snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
	602	ldo->desc.name = ldo->name;
f1aba13f MB	603
	604	snprintf(ldo->supply_name, sizeof(ldo->supply_name),
	605	"LDO%dVDD", id + 1);
	606	ldo->desc.supply_name = ldo->supply_name;
	607
d1c6b4fe MB	608	ldo->desc.id = id;
	609	ldo->desc.type = REGULATOR_VOLTAGE;
	610	ldo->desc.n_voltages = WM831X_ALIVE_LDO_MAX_SELECTOR + 1;
	611	ldo->desc.ops = &wm831x_alive_ldo_ops;
	612	ldo->desc.owner = THIS_MODULE;
ac663b47 MB	613	ldo->desc.vsel_reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
ac663b47 MB	614	ldo->desc.vsel_mask = WM831X_LDO11_ON_VSEL_MASK;
ca8c361b MB	615	ldo->desc.enable_reg = WM831X_LDO_ENABLE;
ca8c361b MB	616	ldo->desc.enable_mask = 1 << id;
d31e954e MB	617	ldo->desc.min_uV = 800000;
d31e954e MB	618	ldo->desc.uV_step = 50000;
eefaa3c6	619	ldo->desc.enable_time = 1000;
d1c6b4fe	620
c172708d	621	config.dev = pdev->dev.parent;
b7ca8788 MB	622	if (pdata)
b7ca8788 MB	623	config.init_data = pdata->ldo[id];
c172708d	624	config.driver_data = ldo;
ac663b47	625	config.regmap = wm831x->regmap;
c172708d	626
fc7c60e3 MB	627	ldo->regulator = devm_regulator_register(&pdev->dev, &ldo->desc,
fc7c60e3 MB	628	&config);
d1c6b4fe MB	629	if (IS_ERR(ldo->regulator)) {
	630	ret = PTR_ERR(ldo->regulator);
	631	dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
	632	id + 1, ret);
	633	goto err;
	634	}
	635
	636	platform_set_drvdata(pdev, ldo);
	637
	638	return 0;
	639
	640	err:
d1c6b4fe MB	641	return ret;
	642	}
	643
d1c6b4fe MB	644	static struct platform_driver wm831x_alive_ldo_driver = {
d1c6b4fe MB	645	.probe = wm831x_alive_ldo_probe,
d1c6b4fe MB	646	.driver = {
	647	.name = "wm831x-alive-ldo",
	648	},
	649	};
	650
92a513b7 TR	651	static struct platform_driver * const drivers[] = {
	652	&wm831x_gp_ldo_driver,
	653	&wm831x_aldo_driver,
	654	&wm831x_alive_ldo_driver,
	655	};
	656
d1c6b4fe MB	657	static int __init wm831x_ldo_init(void)
d1c6b4fe MB	658	{
92a513b7	659	return platform_register_drivers(drivers, ARRAY_SIZE(drivers));
d1c6b4fe MB	660	}
	661	subsys_initcall(wm831x_ldo_init);
	662
	663	static void __exit wm831x_ldo_exit(void)
	664	{
92a513b7	665	platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));
d1c6b4fe MB	666	}
	667	module_exit(wm831x_ldo_exit);
	668
	669	/* Module information */
	670	MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
	671	MODULE_DESCRIPTION("WM831x LDO driver");
	672	MODULE_LICENSE("GPL");
	673	MODULE_ALIAS("platform:wm831x-ldo");
	674	MODULE_ALIAS("platform:wm831x-aldo");
	675	MODULE_ALIAS("platform:wm831x-aliveldo");