[linux-2.6-block.git] / drivers / regulator / lochnagar-regulator.c

// SPDX-License-Identifier: GPL-2.0
//
// Lochnagar regulator driver
//
// Copyright (c) 2017-2018 Cirrus Logic, Inc. and
//                         Cirrus Logic International Semiconductor Ltd.
//
// Author: Charles Keepax <ckeepax@opensource.cirrus.com>

#include <linux/bitops.h>
#include <linux/device.h>
#include <linux/err.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/machine.h>
#include <linux/regulator/of_regulator.h>

#include <linux/mfd/lochnagar.h>
#include <linux/mfd/lochnagar1_regs.h>
#include <linux/mfd/lochnagar2_regs.h>

static const struct regulator_ops lochnagar_micvdd_ops = {
	.enable = regulator_enable_regmap,
	.disable = regulator_disable_regmap,
	.is_enabled = regulator_is_enabled_regmap,

	.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,
};

static const struct regulator_linear_range lochnagar_micvdd_ranges[] = {
	REGULATOR_LINEAR_RANGE(1000000, 0,    0xC, 50000),
	REGULATOR_LINEAR_RANGE(1700000, 0xD, 0x1F, 100000),
};

static int lochnagar_micbias_enable(struct regulator_dev *rdev)
{
	struct lochnagar *lochnagar = rdev_get_drvdata(rdev);
	int ret;

	mutex_lock(&lochnagar->analogue_config_lock);

	ret = regulator_enable_regmap(rdev);
	if (ret < 0)
		goto err;

	ret = lochnagar_update_config(lochnagar);

err:
	mutex_unlock(&lochnagar->analogue_config_lock);

	return ret;
}

static int lochnagar_micbias_disable(struct regulator_dev *rdev)
{
	struct lochnagar *lochnagar = rdev_get_drvdata(rdev);
	int ret;

	mutex_lock(&lochnagar->analogue_config_lock);

	ret = regulator_disable_regmap(rdev);
	if (ret < 0)
		goto err;

	ret = lochnagar_update_config(lochnagar);

err:
	mutex_unlock(&lochnagar->analogue_config_lock);

	return ret;
}

static const struct regulator_ops lochnagar_micbias_ops = {
	.enable = lochnagar_micbias_enable,
	.disable = lochnagar_micbias_disable,
	.is_enabled = regulator_is_enabled_regmap,
};

static const struct regulator_ops lochnagar_vddcore_ops = {
	.enable = regulator_enable_regmap,
	.disable = regulator_disable_regmap,
	.is_enabled = regulator_is_enabled_regmap,

	.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,
};

static const struct regulator_linear_range lochnagar_vddcore_ranges[] = {
	REGULATOR_LINEAR_RANGE(600000, 0x8, 0x41, 12500),
};

enum lochnagar_regulators {
	LOCHNAGAR_MICVDD,
	LOCHNAGAR_MIC1VDD,
	LOCHNAGAR_MIC2VDD,
	LOCHNAGAR_VDDCORE,
};

static int lochnagar_micbias_of_parse(struct device_node *np,
				      const struct regulator_desc *desc,
				      struct regulator_config *config)
{
	struct lochnagar *lochnagar = config->driver_data;
	int shift = (desc->id - LOCHNAGAR_MIC1VDD) *
		    LOCHNAGAR2_P2_MICBIAS_SRC_SHIFT;
	int mask = LOCHNAGAR2_P1_MICBIAS_SRC_MASK << shift;
	unsigned int val;
	int ret;

	ret = of_property_read_u32(np, "cirrus,micbias-input", &val);
	if (ret >= 0) {
		mutex_lock(&lochnagar->analogue_config_lock);
		ret = regmap_update_bits(lochnagar->regmap,
					 LOCHNAGAR2_ANALOGUE_PATH_CTRL2,
					 mask, val << shift);
		mutex_unlock(&lochnagar->analogue_config_lock);
		if (ret < 0) {
			dev_err(lochnagar->dev,
				"Failed to update micbias source: %d\n", ret);
			return ret;
		}
	}

	return 0;
}

static const struct regulator_desc lochnagar_regulators[] = {
	[LOCHNAGAR_MICVDD] = {
		.name = "MICVDD",
		.supply_name = "SYSVDD",
		.type = REGULATOR_VOLTAGE,
		.n_voltages = 32,
		.ops = &lochnagar_micvdd_ops,

		.id = LOCHNAGAR_MICVDD,
		.of_match = of_match_ptr("MICVDD"),

		.enable_reg = LOCHNAGAR2_MICVDD_CTRL1,
		.enable_mask = LOCHNAGAR2_MICVDD_REG_ENA_MASK,
		.vsel_reg = LOCHNAGAR2_MICVDD_CTRL2,
		.vsel_mask = LOCHNAGAR2_MICVDD_VSEL_MASK,

		.linear_ranges = lochnagar_micvdd_ranges,
		.n_linear_ranges = ARRAY_SIZE(lochnagar_micvdd_ranges),

		.enable_time = 3000,
		.ramp_delay = 1000,

		.owner = THIS_MODULE,
	},
	[LOCHNAGAR_MIC1VDD] = {
		.name = "MIC1VDD",
		.supply_name = "MICBIAS1",
		.type = REGULATOR_VOLTAGE,
		.ops = &lochnagar_micbias_ops,

		.id = LOCHNAGAR_MIC1VDD,
		.of_match = of_match_ptr("MIC1VDD"),
		.of_parse_cb = lochnagar_micbias_of_parse,

		.enable_reg = LOCHNAGAR2_ANALOGUE_PATH_CTRL2,
		.enable_mask = LOCHNAGAR2_P1_INPUT_BIAS_ENA_MASK,

		.owner = THIS_MODULE,
	},
	[LOCHNAGAR_MIC2VDD] = {
		.name = "MIC2VDD",
		.supply_name = "MICBIAS2",
		.type = REGULATOR_VOLTAGE,
		.ops = &lochnagar_micbias_ops,

		.id = LOCHNAGAR_MIC2VDD,
		.of_match = of_match_ptr("MIC2VDD"),
		.of_parse_cb = lochnagar_micbias_of_parse,

		.enable_reg = LOCHNAGAR2_ANALOGUE_PATH_CTRL2,
		.enable_mask = LOCHNAGAR2_P2_INPUT_BIAS_ENA_MASK,

		.owner = THIS_MODULE,
	},
	[LOCHNAGAR_VDDCORE] = {
		.name = "VDDCORE",
		.supply_name = "SYSVDD",
		.type = REGULATOR_VOLTAGE,
		.n_voltages = 66,
		.ops = &lochnagar_vddcore_ops,

		.id = LOCHNAGAR_VDDCORE,
		.of_match = of_match_ptr("VDDCORE"),

		.enable_reg = LOCHNAGAR2_VDDCORE_CDC_CTRL1,
		.enable_mask = LOCHNAGAR2_VDDCORE_CDC_REG_ENA_MASK,
		.vsel_reg = LOCHNAGAR2_VDDCORE_CDC_CTRL2,
		.vsel_mask = LOCHNAGAR2_VDDCORE_CDC_VSEL_MASK,

		.linear_ranges = lochnagar_vddcore_ranges,
		.n_linear_ranges = ARRAY_SIZE(lochnagar_vddcore_ranges),

		.enable_time = 3000,
		.ramp_delay = 1000,

		.owner = THIS_MODULE,
	},
};

static const struct of_device_id lochnagar_of_match[] = {
	{
		.compatible = "cirrus,lochnagar2-micvdd",
		.data = &lochnagar_regulators[LOCHNAGAR_MICVDD],
	},
	{
		.compatible = "cirrus,lochnagar2-mic1vdd",
		.data = &lochnagar_regulators[LOCHNAGAR_MIC1VDD],
	},
	{
		.compatible = "cirrus,lochnagar2-mic2vdd",
		.data = &lochnagar_regulators[LOCHNAGAR_MIC2VDD],
	},
	{
		.compatible = "cirrus,lochnagar2-vddcore",
		.data = &lochnagar_regulators[LOCHNAGAR_VDDCORE],
	},
	{}
};
MODULE_DEVICE_TABLE(of, lochnagar_of_match);

static int lochnagar_regulator_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct lochnagar *lochnagar = dev_get_drvdata(dev->parent);
	struct regulator_config config = { };
	const struct of_device_id *of_id;
	const struct regulator_desc *desc;
	struct regulator_dev *rdev;
	int ret;

	config.dev = dev;
	config.regmap = lochnagar->regmap;
	config.driver_data = lochnagar;

	of_id = of_match_device(lochnagar_of_match, dev);
	if (!of_id)
		return -EINVAL;

	desc = of_id->data;

	rdev = devm_regulator_register(dev, desc, &config);
	if (IS_ERR(rdev)) {
		ret = PTR_ERR(rdev);
		dev_err(dev, "Failed to register %s regulator: %d\n",
			desc->name, ret);
		return ret;
	}

	return 0;
}

static struct platform_driver lochnagar_regulator_driver = {
	.driver = {
		.name = "lochnagar-regulator",
		.of_match_table = of_match_ptr(lochnagar_of_match),
	},

	.probe = lochnagar_regulator_probe,
};
module_platform_driver(lochnagar_regulator_driver);

MODULE_AUTHOR("Charles Keepax <ckeepax@opensource.cirrus.com>");
MODULE_DESCRIPTION("Regulator driver for Cirrus Logic Lochnagar Board");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:lochnagar-regulator");
Commit	Line	Data
bef9391c	1	// SPDX-License-Identifier: GPL-2.0
d8b2a8e9 CK	2	//
	3	// Lochnagar regulator driver
	4	//
	5	// Copyright (c) 2017-2018 Cirrus Logic, Inc. and
	6	// Cirrus Logic International Semiconductor Ltd.
	7	//
	8	// Author: Charles Keepax <ckeepax@opensource.cirrus.com>
bef9391c CK	9
	10	#include <linux/bitops.h>
	11	#include <linux/device.h>
	12	#include <linux/err.h>
	13	#include <linux/module.h>
	14	#include <linux/mutex.h>
	15	#include <linux/of.h>
d90acbc4	16	#include <linux/of_device.h>
bef9391c CK	17	#include <linux/platform_device.h>
	18	#include <linux/regmap.h>
	19	#include <linux/regulator/driver.h>
	20	#include <linux/regulator/machine.h>
	21	#include <linux/regulator/of_regulator.h>
	22
	23	#include <linux/mfd/lochnagar.h>
fa2bb8b9 CK	24	#include <linux/mfd/lochnagar1_regs.h>
fa2bb8b9 CK	25	#include <linux/mfd/lochnagar2_regs.h>
bef9391c CK	26
	27	static const struct regulator_ops lochnagar_micvdd_ops = {
	28	.enable = regulator_enable_regmap,
	29	.disable = regulator_disable_regmap,
	30	.is_enabled = regulator_is_enabled_regmap,
	31
	32	.list_voltage = regulator_list_voltage_linear_range,
	33	.map_voltage = regulator_map_voltage_linear_range,
	34
	35	.get_voltage_sel = regulator_get_voltage_sel_regmap,
	36	.set_voltage_sel = regulator_set_voltage_sel_regmap,
	37	};
	38
	39	static const struct regulator_linear_range lochnagar_micvdd_ranges[] = {
	40	REGULATOR_LINEAR_RANGE(1000000, 0, 0xC, 50000),
	41	REGULATOR_LINEAR_RANGE(1700000, 0xD, 0x1F, 100000),
	42	};
	43
	44	static int lochnagar_micbias_enable(struct regulator_dev *rdev)
	45	{
	46	struct lochnagar *lochnagar = rdev_get_drvdata(rdev);
	47	int ret;
	48
	49	mutex_lock(&lochnagar->analogue_config_lock);
	50
	51	ret = regulator_enable_regmap(rdev);
	52	if (ret < 0)
	53	goto err;
	54
	55	ret = lochnagar_update_config(lochnagar);
	56
	57	err:
	58	mutex_unlock(&lochnagar->analogue_config_lock);
	59
	60	return ret;
	61	}
	62
	63	static int lochnagar_micbias_disable(struct regulator_dev *rdev)
	64	{
	65	struct lochnagar *lochnagar = rdev_get_drvdata(rdev);
	66	int ret;
	67
	68	mutex_lock(&lochnagar->analogue_config_lock);
	69
	70	ret = regulator_disable_regmap(rdev);
	71	if (ret < 0)
	72	goto err;
	73
	74	ret = lochnagar_update_config(lochnagar);
	75
	76	err:
	77	mutex_unlock(&lochnagar->analogue_config_lock);
	78
	79	return ret;
	80	}
	81
	82	static const struct regulator_ops lochnagar_micbias_ops = {
	83	.enable = lochnagar_micbias_enable,
	84	.disable = lochnagar_micbias_disable,
	85	.is_enabled = regulator_is_enabled_regmap,
	86	};
	87
	88	static const struct regulator_ops lochnagar_vddcore_ops = {
	89	.enable = regulator_enable_regmap,
90	.disable = regulator_disable_regmap,
91	.is_enabled = regulator_is_enabled_regmap,
92
93	.list_voltage = regulator_list_voltage_linear_range,
94	.map_voltage = regulator_map_voltage_linear_range,
95
96	.get_voltage_sel = regulator_get_voltage_sel_regmap,
97	.set_voltage_sel = regulator_set_voltage_sel_regmap,
98	};
99
100	static const struct regulator_linear_range lochnagar_vddcore_ranges[] = {
101	REGULATOR_LINEAR_RANGE(600000, 0x8, 0x41, 12500),
102	};
103
104	enum lochnagar_regulators {
105	LOCHNAGAR_MICVDD,
106	LOCHNAGAR_MIC1VDD,
107	LOCHNAGAR_MIC2VDD,
108	LOCHNAGAR_VDDCORE,
109	};
110
111	static int lochnagar_micbias_of_parse(struct device_node *np,
112	const struct regulator_desc *desc,
113	struct regulator_config *config)
114	{
115	struct lochnagar *lochnagar = config->driver_data;
116	int shift = (desc->id - LOCHNAGAR_MIC1VDD) *
117	LOCHNAGAR2_P2_MICBIAS_SRC_SHIFT;
118	int mask = LOCHNAGAR2_P1_MICBIAS_SRC_MASK << shift;
119	unsigned int val;
120	int ret;
121
122	ret = of_property_read_u32(np, "cirrus,micbias-input", &val);
123	if (ret >= 0) {
124	mutex_lock(&lochnagar->analogue_config_lock);
125	ret = regmap_update_bits(lochnagar->regmap,
126	LOCHNAGAR2_ANALOGUE_PATH_CTRL2,
127	mask, val << shift);
128	mutex_unlock(&lochnagar->analogue_config_lock);
129	if (ret < 0) {
130	dev_err(lochnagar->dev,
131	"Failed to update micbias source: %d\n", ret);
132	return ret;
133	}
134	}
135
136	return 0;
137	}
138
139	static const struct regulator_desc lochnagar_regulators[] = {
140	[LOCHNAGAR_MICVDD] = {
141	.name = "MICVDD",
142	.supply_name = "SYSVDD",
143	.type = REGULATOR_VOLTAGE,
144	.n_voltages = 32,
145	.ops = &lochnagar_micvdd_ops,
146
147	.id = LOCHNAGAR_MICVDD,
148	.of_match = of_match_ptr("MICVDD"),
149
150	.enable_reg = LOCHNAGAR2_MICVDD_CTRL1,
151	.enable_mask = LOCHNAGAR2_MICVDD_REG_ENA_MASK,
152	.vsel_reg = LOCHNAGAR2_MICVDD_CTRL2,
153	.vsel_mask = LOCHNAGAR2_MICVDD_VSEL_MASK,
154
155	.linear_ranges = lochnagar_micvdd_ranges,
156	.n_linear_ranges = ARRAY_SIZE(lochnagar_micvdd_ranges),
157
158	.enable_time = 3000,
159	.ramp_delay = 1000,
160
161	.owner = THIS_MODULE,
162	},
163	[LOCHNAGAR_MIC1VDD] = {
164	.name = "MIC1VDD",
165	.supply_name = "MICBIAS1",
166	.type = REGULATOR_VOLTAGE,
167	.ops = &lochnagar_micbias_ops,
168
169	.id = LOCHNAGAR_MIC1VDD,
170	.of_match = of_match_ptr("MIC1VDD"),
171	.of_parse_cb = lochnagar_micbias_of_parse,
172
173	.enable_reg = LOCHNAGAR2_ANALOGUE_PATH_CTRL2,
174	.enable_mask = LOCHNAGAR2_P1_INPUT_BIAS_ENA_MASK,
175
176	.owner = THIS_MODULE,
177	},
178	[LOCHNAGAR_MIC2VDD] = {
179	.name = "MIC2VDD",
180	.supply_name = "MICBIAS2",
181	.type = REGULATOR_VOLTAGE,
182	.ops = &lochnagar_micbias_ops,
183
184	.id = LOCHNAGAR_MIC2VDD,
185	.of_match = of_match_ptr("MIC2VDD"),
186	.of_parse_cb = lochnagar_micbias_of_parse,
187
188	.enable_reg = LOCHNAGAR2_ANALOGUE_PATH_CTRL2,
189	.enable_mask = LOCHNAGAR2_P2_INPUT_BIAS_ENA_MASK,
190
191	.owner = THIS_MODULE,
192	},
193	[LOCHNAGAR_VDDCORE] = {
194	.name = "VDDCORE",
195	.supply_name = "SYSVDD",
196	.type = REGULATOR_VOLTAGE,
9df3bb31	197	.n_voltages = 66,
bef9391c CK	198	.ops = &lochnagar_vddcore_ops,
	199
	200	.id = LOCHNAGAR_VDDCORE,
	201	.of_match = of_match_ptr("VDDCORE"),
	202
	203	.enable_reg = LOCHNAGAR2_VDDCORE_CDC_CTRL1,
	204	.enable_mask = LOCHNAGAR2_VDDCORE_CDC_REG_ENA_MASK,
	205	.vsel_reg = LOCHNAGAR2_VDDCORE_CDC_CTRL2,
	206	.vsel_mask = LOCHNAGAR2_VDDCORE_CDC_VSEL_MASK,
	207
	208	.linear_ranges = lochnagar_vddcore_ranges,
	209	.n_linear_ranges = ARRAY_SIZE(lochnagar_vddcore_ranges),
	210
	211	.enable_time = 3000,
	212	.ramp_delay = 1000,
	213
	214	.owner = THIS_MODULE,
	215	},
	216	};
	217
d90acbc4 CK	218	static const struct of_device_id lochnagar_of_match[] = {
	219	{
	220	.compatible = "cirrus,lochnagar2-micvdd",
	221	.data = &lochnagar_regulators[LOCHNAGAR_MICVDD],
	222	},
	223	{
	224	.compatible = "cirrus,lochnagar2-mic1vdd",
	225	.data = &lochnagar_regulators[LOCHNAGAR_MIC1VDD],
	226	},
	227	{
	228	.compatible = "cirrus,lochnagar2-mic2vdd",
4cac31e2	229	.data = &lochnagar_regulators[LOCHNAGAR_MIC2VDD],
d90acbc4 CK	230	},
	231	{
	232	.compatible = "cirrus,lochnagar2-vddcore",
	233	.data = &lochnagar_regulators[LOCHNAGAR_VDDCORE],
	234	},
692f8b56	235	{}
d90acbc4	236	};
692f8b56	237	MODULE_DEVICE_TABLE(of, lochnagar_of_match);
d90acbc4	238
bef9391c CK	239	static int lochnagar_regulator_probe(struct platform_device *pdev)
	240	{
	241	struct device *dev = &pdev->dev;
	242	struct lochnagar *lochnagar = dev_get_drvdata(dev->parent);
	243	struct regulator_config config = { };
d90acbc4 CK	244	const struct of_device_id *of_id;
d90acbc4 CK	245	const struct regulator_desc *desc;
bef9391c	246	struct regulator_dev *rdev;
d90acbc4	247	int ret;
bef9391c	248
d90acbc4	249	config.dev = dev;
bef9391c CK	250	config.regmap = lochnagar->regmap;
	251	config.driver_data = lochnagar;
	252
d90acbc4 CK	253	of_id = of_match_device(lochnagar_of_match, dev);
	254	if (!of_id)
	255	return -EINVAL;
bef9391c	256
d90acbc4 CK	257	desc = of_id->data;
	258
	259	rdev = devm_regulator_register(dev, desc, &config);
	260	if (IS_ERR(rdev)) {
	261	ret = PTR_ERR(rdev);
	262	dev_err(dev, "Failed to register %s regulator: %d\n",
	263	desc->name, ret);
	264	return ret;
bef9391c CK	265	}
	266
	267	return 0;
	268	}
	269
	270	static struct platform_driver lochnagar_regulator_driver = {
	271	.driver = {
	272	.name = "lochnagar-regulator",
d90acbc4	273	.of_match_table = of_match_ptr(lochnagar_of_match),
bef9391c CK	274	},
	275
	276	.probe = lochnagar_regulator_probe,
	277	};
	278	module_platform_driver(lochnagar_regulator_driver);
	279
	280	MODULE_AUTHOR("Charles Keepax <ckeepax@opensource.cirrus.com>");
	281	MODULE_DESCRIPTION("Regulator driver for Cirrus Logic Lochnagar Board");
	282	MODULE_LICENSE("GPL v2");
	283	MODULE_ALIAS("platform:lochnagar-regulator");