[mirror_ubuntu-jammy-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_lock(ldo->regulator);
	regulator_notifier_call_chain(ldo->regulator,
				      REGULATOR_EVENT_UNDER_VOLTAGE,
				      NULL);
	regulator_unlock(ldo->regulator);

	return IRQ_HANDLED;
}

/*
 * General purpose LDOs
 */

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