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

/*
 * Broadcom BCM590xx regulator driver
 *
 * Copyright 2014 Linaro Limited
 * Author: Matt Porter <mporter@linaro.org>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under  the terms of the GNU General  Public License as published by the
 * Free Software Foundation;  either version 2 of the License, or (at your
 * option) any later version.
 */

#include <linux/err.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/mfd/bcm590xx.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/machine.h>
#include <linux/regulator/of_regulator.h>
#include <linux/slab.h>

/* Register defs */
#define BCM590XX_RFLDOPMCTRL1	0x60
#define BCM590XX_IOSR1PMCTRL1	0x7a
#define BCM590XX_IOSR2PMCTRL1	0x7c
#define BCM590XX_CSRPMCTRL1	0x7e
#define BCM590XX_SDSR1PMCTRL1	0x82
#define BCM590XX_SDSR2PMCTRL1	0x86
#define BCM590XX_MSRPMCTRL1	0x8a
#define BCM590XX_VSRPMCTRL1	0x8e
#define BCM590XX_REG_ENABLE	BIT(7)

#define BCM590XX_RFLDOCTRL	0x96
#define BCM590XX_CSRVOUT1	0xc0
#define BCM590XX_LDO_VSEL_MASK	GENMASK(5, 3)
#define BCM590XX_SR_VSEL_MASK	GENMASK(5, 0)

/* LDO regulator IDs */
#define BCM590XX_REG_RFLDO	0
#define BCM590XX_REG_CAMLDO1	1
#define BCM590XX_REG_CAMLDO2	2
#define BCM590XX_REG_SIMLDO1	3
#define BCM590XX_REG_SIMLDO2	4
#define BCM590XX_REG_SDLDO	5
#define BCM590XX_REG_SDXLDO	6
#define BCM590XX_REG_MMCLDO1	7
#define BCM590XX_REG_MMCLDO2	8
#define BCM590XX_REG_AUDLDO	9
#define BCM590XX_REG_MICLDO	10
#define BCM590XX_REG_USBLDO	11
#define BCM590XX_REG_VIBLDO	12

/* DCDC regulator IDs */
#define BCM590XX_REG_CSR	13
#define BCM590XX_REG_IOSR1	14
#define BCM590XX_REG_IOSR2	15
#define BCM590XX_REG_MSR	16
#define BCM590XX_REG_SDSR1	17
#define BCM590XX_REG_SDSR2	18
#define BCM590XX_REG_VSR	19

#define BCM590XX_NUM_REGS	20

#define BCM590XX_REG_IS_LDO(n)	(n < BCM590XX_REG_CSR)

struct bcm590xx_board {
	struct regulator_init_data *bcm590xx_pmu_init_data[BCM590XX_NUM_REGS];
};

/* LDO group A: supported voltages in microvolts */
static const unsigned int ldo_a_table[] = {
	1200000, 1800000, 2500000, 2700000, 2800000,
	2900000, 3000000, 3300000,
};

/* LDO group C: supported voltages in microvolts */
static const unsigned int ldo_c_table[] = {
	3100000, 1800000, 2500000, 2700000, 2800000,
	2900000, 3000000, 3300000,
};

/* DCDC group CSR: supported voltages in microvolts */
static const struct regulator_linear_range dcdc_csr_ranges[] = {
	REGULATOR_LINEAR_RANGE(860000, 2, 50, 10000),
	REGULATOR_LINEAR_RANGE(1360000, 51, 55, 20000),
	REGULATOR_LINEAR_RANGE(900000, 56, 63, 0),
};

/* DCDC group IOSR1: supported voltages in microvolts */
static const struct regulator_linear_range dcdc_iosr1_ranges[] = {
	REGULATOR_LINEAR_RANGE(860000, 2, 51, 10000),
	REGULATOR_LINEAR_RANGE(1500000, 52, 52, 0),
	REGULATOR_LINEAR_RANGE(1800000, 53, 53, 0),
	REGULATOR_LINEAR_RANGE(900000, 54, 63, 0),
};

/* DCDC group SDSR1: supported voltages in microvolts */
static const struct regulator_linear_range dcdc_sdsr1_ranges[] = {
	REGULATOR_LINEAR_RANGE(860000, 2, 50, 10000),
	REGULATOR_LINEAR_RANGE(1340000, 51, 51, 0),
	REGULATOR_LINEAR_RANGE(900000, 52, 63, 0),
};

struct bcm590xx_info {
	const char *name;
	const char *vin_name;
	u8 n_voltages;
	const unsigned int *volt_table;
	u8 n_linear_ranges;
	const struct regulator_linear_range *linear_ranges;
};

#define BCM590XX_REG_TABLE(_name, _table) \
	{ \
		.name = #_name, \
		.n_voltages = ARRAY_SIZE(_table), \
		.volt_table = _table, \
	}

#define BCM590XX_REG_RANGES(_name, _ranges) \
	{ \
		.name = #_name, \
		.n_linear_ranges = ARRAY_SIZE(_ranges), \
		.linear_ranges = _ranges, \
	}

static struct bcm590xx_info bcm590xx_regs[] = {
	BCM590XX_REG_TABLE(rfldo, ldo_a_table),
	BCM590XX_REG_TABLE(camldo1, ldo_c_table),
	BCM590XX_REG_TABLE(camldo2, ldo_c_table),
	BCM590XX_REG_TABLE(simldo1, ldo_a_table),
	BCM590XX_REG_TABLE(simldo2, ldo_a_table),
	BCM590XX_REG_TABLE(sdldo, ldo_c_table),
	BCM590XX_REG_TABLE(sdxldo, ldo_a_table),
	BCM590XX_REG_TABLE(mmcldo1, ldo_a_table),
	BCM590XX_REG_TABLE(mmcldo2, ldo_a_table),
	BCM590XX_REG_TABLE(audldo, ldo_a_table),
	BCM590XX_REG_TABLE(micldo, ldo_a_table),
	BCM590XX_REG_TABLE(usbldo, ldo_a_table),
	BCM590XX_REG_TABLE(vibldo, ldo_c_table),
	BCM590XX_REG_RANGES(csr, dcdc_csr_ranges),
	BCM590XX_REG_RANGES(iosr1, dcdc_iosr1_ranges),
	BCM590XX_REG_RANGES(iosr2, dcdc_iosr1_ranges),
	BCM590XX_REG_RANGES(msr, dcdc_iosr1_ranges),
	BCM590XX_REG_RANGES(sdsr1, dcdc_sdsr1_ranges),
	BCM590XX_REG_RANGES(sdsr2, dcdc_iosr1_ranges),
	BCM590XX_REG_RANGES(vsr, dcdc_iosr1_ranges),
};

struct bcm590xx_reg {
	struct regulator_desc *desc;
	struct bcm590xx *mfd;
	struct regulator_dev **rdev;
	struct bcm590xx_info **info;
};

static int bcm590xx_get_vsel_register(int id)
{
	if (BCM590XX_REG_IS_LDO(id))
		return BCM590XX_RFLDOCTRL + id;
	else
		return BCM590XX_CSRVOUT1 + (id - BCM590XX_REG_CSR) * 3;
}

static int bcm590xx_get_enable_register(int id)
{
	int reg = 0;

	if (BCM590XX_REG_IS_LDO(id))
		reg = BCM590XX_RFLDOPMCTRL1 + id * 2;
	else
		switch (id) {
		case BCM590XX_REG_CSR:
			reg = BCM590XX_CSRPMCTRL1;
			break;
		case BCM590XX_REG_IOSR1:
			reg = BCM590XX_IOSR1PMCTRL1;
			break;
		case BCM590XX_REG_IOSR2:
			reg = BCM590XX_IOSR2PMCTRL1;
			break;
		case BCM590XX_REG_MSR:
			reg = BCM590XX_MSRPMCTRL1;
			break;
		case BCM590XX_REG_SDSR1:
			reg = BCM590XX_SDSR1PMCTRL1;
			break;
		case BCM590XX_REG_SDSR2:
			reg = BCM590XX_SDSR2PMCTRL1;
			break;
		};

	return reg;
}

static struct regulator_ops bcm590xx_ops_ldo = {
	.is_enabled		= regulator_is_enabled_regmap,
	.enable			= regulator_enable_regmap,
	.disable		= regulator_disable_regmap,
	.get_voltage_sel	= regulator_get_voltage_sel_regmap,
	.set_voltage_sel	= regulator_set_voltage_sel_regmap,
	.list_voltage		= regulator_list_voltage_table,
	.map_voltage		= regulator_map_voltage_iterate,
};

static struct regulator_ops bcm590xx_ops_dcdc = {
	.is_enabled		= regulator_is_enabled_regmap,
	.enable			= regulator_enable_regmap,
	.disable		= regulator_disable_regmap,
	.get_voltage_sel	= regulator_get_voltage_sel_regmap,
	.set_voltage_sel	= regulator_set_voltage_sel_regmap,
	.list_voltage		= regulator_list_voltage_linear_range,
	.map_voltage		= regulator_map_voltage_linear_range,
};

#define BCM590XX_MATCH(_name, _id) \
	{ \
		.name = #_name, \
		.driver_data = (void *)&bcm590xx_regs[BCM590XX_REG_##_id], \
	}

static struct of_regulator_match bcm590xx_matches[] = {
	BCM590XX_MATCH(rfldo, RFLDO),
	BCM590XX_MATCH(camldo1, CAMLDO1),
	BCM590XX_MATCH(camldo2, CAMLDO2),
	BCM590XX_MATCH(simldo1, SIMLDO1),
	BCM590XX_MATCH(simldo2, SIMLDO2),
	BCM590XX_MATCH(sdldo, SDLDO),
	BCM590XX_MATCH(sdxldo, SDXLDO),
	BCM590XX_MATCH(mmcldo1, MMCLDO1),
	BCM590XX_MATCH(mmcldo2, MMCLDO2),
	BCM590XX_MATCH(audldo, AUDLDO),
	BCM590XX_MATCH(micldo, MICLDO),
	BCM590XX_MATCH(usbldo, USBLDO),
	BCM590XX_MATCH(vibldo, VIBLDO),
	BCM590XX_MATCH(csr, CSR),
	BCM590XX_MATCH(iosr1, IOSR1),
	BCM590XX_MATCH(iosr2, IOSR2),
	BCM590XX_MATCH(msr, MSR),
	BCM590XX_MATCH(sdsr1, SDSR1),
	BCM590XX_MATCH(sdsr2, SDSR2),
	BCM590XX_MATCH(vsr, VSR),
};

static struct bcm590xx_board *bcm590xx_parse_dt_reg_data(
		struct platform_device *pdev,
		struct of_regulator_match **bcm590xx_reg_matches)
{
	struct bcm590xx_board *data;
	struct device_node *np = pdev->dev.parent->of_node;
	struct device_node *regulators;
	struct of_regulator_match *matches = bcm590xx_matches;
	int count = ARRAY_SIZE(bcm590xx_matches);
	int idx = 0;
	int ret;

	if (!np) {
		dev_err(&pdev->dev, "of node not found\n");
		return NULL;
	}

	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
	if (!data) {
		dev_err(&pdev->dev, "failed to allocate regulator board data\n");
		return NULL;
	}

	np = of_node_get(np);
	regulators = of_get_child_by_name(np, "regulators");
	if (!regulators) {
		dev_warn(&pdev->dev, "regulator node not found\n");
		return NULL;
	}

	ret = of_regulator_match(&pdev->dev, regulators, matches, count);
	of_node_put(regulators);
	if (ret < 0) {
		dev_err(&pdev->dev, "Error parsing regulator init data: %d\n",
			ret);
		return NULL;
	}

	*bcm590xx_reg_matches = matches;

	for (idx = 0; idx < count; idx++) {
		if (!matches[idx].init_data || !matches[idx].of_node)
			continue;

		data->bcm590xx_pmu_init_data[idx] = matches[idx].init_data;
	}

	return data;
}

static int bcm590xx_probe(struct platform_device *pdev)
{
	struct bcm590xx *bcm590xx = dev_get_drvdata(pdev->dev.parent);
	struct bcm590xx_board *pmu_data = NULL;
	struct bcm590xx_reg *pmu;
	struct regulator_config config = { };
	struct bcm590xx_info *info;
	struct regulator_init_data *reg_data;
	struct regulator_dev *rdev;
	struct of_regulator_match *bcm590xx_reg_matches = NULL;
	int i;

	pmu_data = bcm590xx_parse_dt_reg_data(pdev,
					      &bcm590xx_reg_matches);

	pmu = devm_kzalloc(&pdev->dev, sizeof(*pmu), GFP_KERNEL);
	if (!pmu) {
		dev_err(&pdev->dev, "Memory allocation failed for pmu\n");
		return -ENOMEM;
	}

	pmu->mfd = bcm590xx;

	platform_set_drvdata(pdev, pmu);

	pmu->desc = devm_kzalloc(&pdev->dev, BCM590XX_NUM_REGS *
			sizeof(struct regulator_desc), GFP_KERNEL);
	if (!pmu->desc) {
		dev_err(&pdev->dev, "Memory alloc fails for desc\n");
		return -ENOMEM;
	}

	pmu->info = devm_kzalloc(&pdev->dev, BCM590XX_NUM_REGS *
			sizeof(struct bcm590xx_info *), GFP_KERNEL);
	if (!pmu->info) {
		dev_err(&pdev->dev, "Memory alloc fails for info\n");
		return -ENOMEM;
	}

	pmu->rdev = devm_kzalloc(&pdev->dev, BCM590XX_NUM_REGS *
			sizeof(struct regulator_dev *), GFP_KERNEL);
	if (!pmu->rdev) {
		dev_err(&pdev->dev, "Memory alloc fails for rdev\n");
		return -ENOMEM;
	}

	info = bcm590xx_regs;

	for (i = 0; i < BCM590XX_NUM_REGS; i++, info++) {
		if (pmu_data)
			reg_data = pmu_data->bcm590xx_pmu_init_data[i];
		else
			reg_data = NULL;

		/* Register the regulators */
		pmu->info[i] = info;

		pmu->desc[i].name = info->name;
		pmu->desc[i].supply_name = info->vin_name;
		pmu->desc[i].id = i;
		pmu->desc[i].volt_table = info->volt_table;
		pmu->desc[i].n_voltages = info->n_voltages;
		pmu->desc[i].linear_ranges = info->linear_ranges;
		pmu->desc[i].n_linear_ranges = info->n_linear_ranges;

		if (BCM590XX_REG_IS_LDO(i)) {
			pmu->desc[i].ops = &bcm590xx_ops_ldo;
			pmu->desc[i].vsel_mask = BCM590XX_LDO_VSEL_MASK;
		} else {
			pmu->desc[i].ops = &bcm590xx_ops_dcdc;
			pmu->desc[i].vsel_mask = BCM590XX_SR_VSEL_MASK;
		}

		pmu->desc[i].vsel_reg = bcm590xx_get_vsel_register(i);
		pmu->desc[i].enable_is_inverted = true;
		pmu->desc[i].enable_mask = BCM590XX_REG_ENABLE;
		pmu->desc[i].enable_reg = bcm590xx_get_enable_register(i);
		pmu->desc[i].type = REGULATOR_VOLTAGE;
		pmu->desc[i].owner = THIS_MODULE;

		config.dev = bcm590xx->dev;
		config.init_data = reg_data;
		config.driver_data = pmu;
		config.regmap = bcm590xx->regmap;

		if (bcm590xx_reg_matches)
			config.of_node = bcm590xx_reg_matches[i].of_node;

		rdev = devm_regulator_register(&pdev->dev, &pmu->desc[i],
					       &config);
		if (IS_ERR(rdev)) {
			dev_err(bcm590xx->dev,
				"failed to register %s regulator\n",
				pdev->name);
			return PTR_ERR(rdev);
		}

		pmu->rdev[i] = rdev;
	}

	return 0;
}

static struct platform_driver bcm590xx_regulator_driver = {
	.driver = {
		.name = "bcm590xx-vregs",
		.owner = THIS_MODULE,
	},
	.probe = bcm590xx_probe,
};
module_platform_driver(bcm590xx_regulator_driver);

MODULE_AUTHOR("Matt Porter <mporter@linaro.org>");
MODULE_DESCRIPTION("BCM590xx voltage regulator driver");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:bcm590xx-regulator");
Commit	Line	Data
462c9fc5 MP	1	/*
	2	* Broadcom BCM590xx regulator driver
	3	*
	4	* Copyright 2014 Linaro Limited
	5	* Author: Matt Porter <mporter@linaro.org>
	6	*
	7	* This program is free software; you can redistribute it and/or modify it
	8	* under the terms of the GNU General Public License as published by the
	9	* Free Software Foundation; either version 2 of the License, or (at your
	10	* option) any later version.
	11	*/
	12
	13	#include <linux/err.h>
	14	#include <linux/init.h>
	15	#include <linux/kernel.h>
	16	#include <linux/mfd/bcm590xx.h>
	17	#include <linux/module.h>
	18	#include <linux/of.h>
	19	#include <linux/platform_device.h>
	20	#include <linux/regulator/driver.h>
	21	#include <linux/regulator/machine.h>
	22	#include <linux/regulator/of_regulator.h>
	23	#include <linux/slab.h>
	24
	25	/* Register defs */
	26	#define BCM590XX_RFLDOPMCTRL1 0x60
	27	#define BCM590XX_IOSR1PMCTRL1 0x7a
	28	#define BCM590XX_IOSR2PMCTRL1 0x7c
	29	#define BCM590XX_CSRPMCTRL1 0x7e
	30	#define BCM590XX_SDSR1PMCTRL1 0x82
	31	#define BCM590XX_SDSR2PMCTRL1 0x86
	32	#define BCM590XX_MSRPMCTRL1 0x8a
	33	#define BCM590XX_VSRPMCTRL1 0x8e
	34	#define BCM590XX_REG_ENABLE BIT(7)
	35
	36	#define BCM590XX_RFLDOCTRL 0x96
	37	#define BCM590XX_CSRVOUT1 0xc0
	38	#define BCM590XX_LDO_VSEL_MASK GENMASK(5, 3)
	39	#define BCM590XX_SR_VSEL_MASK GENMASK(5, 0)
	40
	41	/* LDO regulator IDs */
	42	#define BCM590XX_REG_RFLDO 0
	43	#define BCM590XX_REG_CAMLDO1 1
	44	#define BCM590XX_REG_CAMLDO2 2
	45	#define BCM590XX_REG_SIMLDO1 3
	46	#define BCM590XX_REG_SIMLDO2 4
	47	#define BCM590XX_REG_SDLDO 5
	48	#define BCM590XX_REG_SDXLDO 6
	49	#define BCM590XX_REG_MMCLDO1 7
	50	#define BCM590XX_REG_MMCLDO2 8
	51	#define BCM590XX_REG_AUDLDO 9
	52	#define BCM590XX_REG_MICLDO 10
	53	#define BCM590XX_REG_USBLDO 11
	54	#define BCM590XX_REG_VIBLDO 12
	55
	56	/* DCDC regulator IDs */
	57	#define BCM590XX_REG_CSR 13
	58	#define BCM590XX_REG_IOSR1 14
	59	#define BCM590XX_REG_IOSR2 15
	60	#define BCM590XX_REG_MSR 16
	61	#define BCM590XX_REG_SDSR1 17
	62	#define BCM590XX_REG_SDSR2 18
	63	#define BCM590XX_REG_VSR 19
	64
65	#define BCM590XX_NUM_REGS 20
66
67	#define BCM590XX_REG_IS_LDO(n) (n < BCM590XX_REG_CSR)
68
69	struct bcm590xx_board {
70	struct regulator_init_data *bcm590xx_pmu_init_data[BCM590XX_NUM_REGS];
71	};
72
73	/* LDO group A: supported voltages in microvolts */
74	static const unsigned int ldo_a_table[] = {
75	1200000, 1800000, 2500000, 2700000, 2800000,
76	2900000, 3000000, 3300000,
77	};
78
79	/* LDO group C: supported voltages in microvolts */
80	static const unsigned int ldo_c_table[] = {
81	3100000, 1800000, 2500000, 2700000, 2800000,
82	2900000, 3000000, 3300000,
83	};
84
85	/* DCDC group CSR: supported voltages in microvolts */
86	static const struct regulator_linear_range dcdc_csr_ranges[] = {
87	REGULATOR_LINEAR_RANGE(860000, 2, 50, 10000),
88	REGULATOR_LINEAR_RANGE(1360000, 51, 55, 20000),
89	REGULATOR_LINEAR_RANGE(900000, 56, 63, 0),
90	};
91
92	/* DCDC group IOSR1: supported voltages in microvolts */
93	static const struct regulator_linear_range dcdc_iosr1_ranges[] = {
94	REGULATOR_LINEAR_RANGE(860000, 2, 51, 10000),
95	REGULATOR_LINEAR_RANGE(1500000, 52, 52, 0),
96	REGULATOR_LINEAR_RANGE(1800000, 53, 53, 0),
97	REGULATOR_LINEAR_RANGE(900000, 54, 63, 0),
98	};
99
100	/* DCDC group SDSR1: supported voltages in microvolts */
101	static const struct regulator_linear_range dcdc_sdsr1_ranges[] = {
102	REGULATOR_LINEAR_RANGE(860000, 2, 50, 10000),
103	REGULATOR_LINEAR_RANGE(1340000, 51, 51, 0),
104	REGULATOR_LINEAR_RANGE(900000, 52, 63, 0),
105	};
106
107	struct bcm590xx_info {
108	const char *name;
109	const char *vin_name;
110	u8 n_voltages;
111	const unsigned int *volt_table;
112	u8 n_linear_ranges;
113	const struct regulator_linear_range *linear_ranges;
114	};
115
116	#define BCM590XX_REG_TABLE(_name, _table) \
117	{ \
118	.name = #_name, \
119	.n_voltages = ARRAY_SIZE(_table), \
120	.volt_table = _table, \
121	}
122
123	#define BCM590XX_REG_RANGES(_name, _ranges) \
124	{ \
125	.name = #_name, \
126	.n_linear_ranges = ARRAY_SIZE(_ranges), \
127	.linear_ranges = _ranges, \
128	}
129
130	static struct bcm590xx_info bcm590xx_regs[] = {
131	BCM590XX_REG_TABLE(rfldo, ldo_a_table),
132	BCM590XX_REG_TABLE(camldo1, ldo_c_table),
133	BCM590XX_REG_TABLE(camldo2, ldo_c_table),
134	BCM590XX_REG_TABLE(simldo1, ldo_a_table),
135	BCM590XX_REG_TABLE(simldo2, ldo_a_table),
136	BCM590XX_REG_TABLE(sdldo, ldo_c_table),
137	BCM590XX_REG_TABLE(sdxldo, ldo_a_table),
138	BCM590XX_REG_TABLE(mmcldo1, ldo_a_table),
139	BCM590XX_REG_TABLE(mmcldo2, ldo_a_table),
140	BCM590XX_REG_TABLE(audldo, ldo_a_table),
141	BCM590XX_REG_TABLE(micldo, ldo_a_table),
142	BCM590XX_REG_TABLE(usbldo, ldo_a_table),
143	BCM590XX_REG_TABLE(vibldo, ldo_c_table),
144	BCM590XX_REG_RANGES(csr, dcdc_csr_ranges),
145	BCM590XX_REG_RANGES(iosr1, dcdc_iosr1_ranges),
146	BCM590XX_REG_RANGES(iosr2, dcdc_iosr1_ranges),
147	BCM590XX_REG_RANGES(msr, dcdc_iosr1_ranges),
148	BCM590XX_REG_RANGES(sdsr1, dcdc_sdsr1_ranges),
149	BCM590XX_REG_RANGES(sdsr2, dcdc_iosr1_ranges),
150	BCM590XX_REG_RANGES(vsr, dcdc_iosr1_ranges),
151	};
152
153	struct bcm590xx_reg {
154	struct regulator_desc *desc;
155	struct bcm590xx *mfd;
156	struct regulator_dev **rdev;
157	struct bcm590xx_info **info;
158	};
159
160	static int bcm590xx_get_vsel_register(int id)
161	{
162	if (BCM590XX_REG_IS_LDO(id))
163	return BCM590XX_RFLDOCTRL + id;
164	else
165	return BCM590XX_CSRVOUT1 + (id - BCM590XX_REG_CSR) * 3;
166	}
167
168	static int bcm590xx_get_enable_register(int id)
169	{
170	int reg = 0;
171
172	if (BCM590XX_REG_IS_LDO(id))
173	reg = BCM590XX_RFLDOPMCTRL1 + id * 2;
174	else
175	switch (id) {
176	case BCM590XX_REG_CSR:
177	reg = BCM590XX_CSRPMCTRL1;
178	break;
179	case BCM590XX_REG_IOSR1:
180	reg = BCM590XX_IOSR1PMCTRL1;
181	break;
182	case BCM590XX_REG_IOSR2:
183	reg = BCM590XX_IOSR2PMCTRL1;
184	break;
185	case BCM590XX_REG_MSR:
186	reg = BCM590XX_MSRPMCTRL1;
187	break;
188	case BCM590XX_REG_SDSR1:
189	reg = BCM590XX_SDSR1PMCTRL1;
190	break;
191	case BCM590XX_REG_SDSR2:
192	reg = BCM590XX_SDSR2PMCTRL1;
193	break;
194	};
195
196	return reg;
197	}
198
199	static struct regulator_ops bcm590xx_ops_ldo = {
200	.is_enabled = regulator_is_enabled_regmap,
201	.enable = regulator_enable_regmap,
202	.disable = regulator_disable_regmap,
203	.get_voltage_sel = regulator_get_voltage_sel_regmap,
204	.set_voltage_sel = regulator_set_voltage_sel_regmap,
205	.list_voltage = regulator_list_voltage_table,
206	.map_voltage = regulator_map_voltage_iterate,
207	};
208
209	static struct regulator_ops bcm590xx_ops_dcdc = {
210	.is_enabled = regulator_is_enabled_regmap,
211	.enable = regulator_enable_regmap,
212	.disable = regulator_disable_regmap,
213	.get_voltage_sel = regulator_get_voltage_sel_regmap,
214	.set_voltage_sel = regulator_set_voltage_sel_regmap,
215	.list_voltage = regulator_list_voltage_linear_range,
216	.map_voltage = regulator_map_voltage_linear_range,
217	};
218
219	#define BCM590XX_MATCH(_name, _id) \
220	{ \
221	.name = #_name, \
222	.driver_data = (void *)&bcm590xx_regs[BCM590XX_REG_##_id], \
223	}
224
225	static struct of_regulator_match bcm590xx_matches[] = {
226	BCM590XX_MATCH(rfldo, RFLDO),
227	BCM590XX_MATCH(camldo1, CAMLDO1),
228	BCM590XX_MATCH(camldo2, CAMLDO2),
229	BCM590XX_MATCH(simldo1, SIMLDO1),
230	BCM590XX_MATCH(simldo2, SIMLDO2),
231	BCM590XX_MATCH(sdldo, SDLDO),
232	BCM590XX_MATCH(sdxldo, SDXLDO),
233	BCM590XX_MATCH(mmcldo1, MMCLDO1),
234	BCM590XX_MATCH(mmcldo2, MMCLDO2),
235	BCM590XX_MATCH(audldo, AUDLDO),
236	BCM590XX_MATCH(micldo, MICLDO),
237	BCM590XX_MATCH(usbldo, USBLDO),
238	BCM590XX_MATCH(vibldo, VIBLDO),
239	BCM590XX_MATCH(csr, CSR),
240	BCM590XX_MATCH(iosr1, IOSR1),
241	BCM590XX_MATCH(iosr2, IOSR2),
242	BCM590XX_MATCH(msr, MSR),
243	BCM590XX_MATCH(sdsr1, SDSR1),
244	BCM590XX_MATCH(sdsr2, SDSR2),
245	BCM590XX_MATCH(vsr, VSR),
246	};
247
248	static struct bcm590xx_board *bcm590xx_parse_dt_reg_data(
249	struct platform_device *pdev,
250	struct of_regulator_match **bcm590xx_reg_matches)
251	{
252	struct bcm590xx_board *data;
253	struct device_node *np = pdev->dev.parent->of_node;
254	struct device_node *regulators;
255	struct of_regulator_match *matches = bcm590xx_matches;
256	int count = ARRAY_SIZE(bcm590xx_matches);
257	int idx = 0;
258	int ret;
259
260	if (!np) {
261	dev_err(&pdev->dev, "of node not found\n");
262	return NULL;
263	}
264
265	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
266	if (!data) {
267	dev_err(&pdev->dev, "failed to allocate regulator board data\n");
268	return NULL;
269	}
270
271	np = of_node_get(np);
272	regulators = of_get_child_by_name(np, "regulators");
273	if (!regulators) {
274	dev_warn(&pdev->dev, "regulator node not found\n");
275	return NULL;
276	}
277
278	ret = of_regulator_match(&pdev->dev, regulators, matches, count);
279	of_node_put(regulators);
280	if (ret < 0) {
281	dev_err(&pdev->dev, "Error parsing regulator init data: %d\n",
282	ret);
283	return NULL;
284	}
285
286	*bcm590xx_reg_matches = matches;
287
288	for (idx = 0; idx < count; idx++) {
289	if (!matches[idx].init_data \|\| !matches[idx].of_node)
290	continue;
291
292	data->bcm590xx_pmu_init_data[idx] = matches[idx].init_data;
293	}
294
295	return data;
296	}
297
298	static int bcm590xx_probe(struct platform_device *pdev)
299	{
300	struct bcm590xx *bcm590xx = dev_get_drvdata(pdev->dev.parent);
301	struct bcm590xx_board *pmu_data = NULL;
302	struct bcm590xx_reg *pmu;
303	struct regulator_config config = { };
304	struct bcm590xx_info *info;
305	struct regulator_init_data *reg_data;
306	struct regulator_dev *rdev;
307	struct of_regulator_match *bcm590xx_reg_matches = NULL;
308	int i;
309
310	pmu_data = bcm590xx_parse_dt_reg_data(pdev,
311	&bcm590xx_reg_matches);
312
313	pmu = devm_kzalloc(&pdev->dev, sizeof(*pmu), GFP_KERNEL);
314	if (!pmu) {
315	dev_err(&pdev->dev, "Memory allocation failed for pmu\n");
316	return -ENOMEM;
317	}
318
319	pmu->mfd = bcm590xx;
320
321	platform_set_drvdata(pdev, pmu);
322
323	pmu->desc = devm_kzalloc(&pdev->dev, BCM590XX_NUM_REGS *
324	sizeof(struct regulator_desc), GFP_KERNEL);
325	if (!pmu->desc) {
326	dev_err(&pdev->dev, "Memory alloc fails for desc\n");
327	return -ENOMEM;
328	}
329
330	pmu->info = devm_kzalloc(&pdev->dev, BCM590XX_NUM_REGS *
331	sizeof(struct bcm590xx_info *), GFP_KERNEL);
332	if (!pmu->info) {
333	dev_err(&pdev->dev, "Memory alloc fails for info\n");
334	return -ENOMEM;
335	}
336
337	pmu->rdev = devm_kzalloc(&pdev->dev, BCM590XX_NUM_REGS *
338	sizeof(struct regulator_dev *), GFP_KERNEL);
339	if (!pmu->rdev) {
340	dev_err(&pdev->dev, "Memory alloc fails for rdev\n");
341	return -ENOMEM;
342	}
343
344	info = bcm590xx_regs;
345
346	for (i = 0; i < BCM590XX_NUM_REGS; i++, info++) {
347	if (pmu_data)
348	reg_data = pmu_data->bcm590xx_pmu_init_data[i];
349	else
350	reg_data = NULL;
351
352	/* Register the regulators */
353	pmu->info[i] = info;
354
355	pmu->desc[i].name = info->name;
356	pmu->desc[i].supply_name = info->vin_name;
357	pmu->desc[i].id = i;
358	pmu->desc[i].volt_table = info->volt_table;
359	pmu->desc[i].n_voltages = info->n_voltages;
360	pmu->desc[i].linear_ranges = info->linear_ranges;
361	pmu->desc[i].n_linear_ranges = info->n_linear_ranges;
362
363	if (BCM590XX_REG_IS_LDO(i)) {
364	pmu->desc[i].ops = &bcm590xx_ops_ldo;
365	pmu->desc[i].vsel_mask = BCM590XX_LDO_VSEL_MASK;
366	} else {
367	pmu->desc[i].ops = &bcm590xx_ops_dcdc;
368	pmu->desc[i].vsel_mask = BCM590XX_SR_VSEL_MASK;
369	}
370
371	pmu->desc[i].vsel_reg = bcm590xx_get_vsel_register(i);
372	pmu->desc[i].enable_is_inverted = true;
373	pmu->desc[i].enable_mask = BCM590XX_REG_ENABLE;
374	pmu->desc[i].enable_reg = bcm590xx_get_enable_register(i);
375	pmu->desc[i].type = REGULATOR_VOLTAGE;
376	pmu->desc[i].owner = THIS_MODULE;
377
378	config.dev = bcm590xx->dev;
379	config.init_data = reg_data;
380	config.driver_data = pmu;
381	config.regmap = bcm590xx->regmap;
382
383	if (bcm590xx_reg_matches)
384	config.of_node = bcm590xx_reg_matches[i].of_node;
385
386	rdev = devm_regulator_register(&pdev->dev, &pmu->desc[i],
387	&config);
388	if (IS_ERR(rdev)) {
389	dev_err(bcm590xx->dev,
390	"failed to register %s regulator\n",
391	pdev->name);
392	return PTR_ERR(rdev);
393	}
394
395	pmu->rdev[i] = rdev;
396	}
397
398	return 0;
399	}
400
401	static struct platform_driver bcm590xx_regulator_driver = {
402	.driver = {
403	.name = "bcm590xx-vregs",
404	.owner = THIS_MODULE,
405	},
406	.probe = bcm590xx_probe,
407	};
408	module_platform_driver(bcm590xx_regulator_driver);
409
410	MODULE_AUTHOR("Matt Porter <mporter@linaro.org>");
411	MODULE_DESCRIPTION("BCM590xx voltage regulator driver");
412	MODULE_LICENSE("GPL v2");
413	MODULE_ALIAS("platform:bcm590xx-regulator");