tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
1/*
2 * arizona-micsupp.c -- Microphone supply for Arizona devices
3 *
4 * Copyright 2012 Wolfson Microelectronics PLC.
5 *
6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
12 */
13
14#include <linux/module.h>
15#include <linux/moduleparam.h>
16#include <linux/init.h>
17#include <linux/bitops.h>
18#include <linux/err.h>
19#include <linux/platform_device.h>
20#include <linux/regulator/driver.h>
21#include <linux/regulator/machine.h>
22#include <linux/gpio.h>
23#include <linux/slab.h>
24
25#include <linux/mfd/arizona/core.h>
26#include <linux/mfd/arizona/pdata.h>
27#include <linux/mfd/arizona/registers.h>
28
29#define ARIZONA_MICSUPP_MAX_SELECTOR 0x1f
30
31struct arizona_micsupp {
32 struct regulator_dev *regulator;
33 struct arizona *arizona;
34
35 struct regulator_consumer_supply supply;
36 struct regulator_init_data init_data;
37};
38
39static int arizona_micsupp_list_voltage(struct regulator_dev *rdev,
40 unsigned int selector)
41{
42 if (selector > ARIZONA_MICSUPP_MAX_SELECTOR)
43 return -EINVAL;
44
45 if (selector == ARIZONA_MICSUPP_MAX_SELECTOR)
46 return 3300000;
47 else
48 return (selector * 50000) + 1700000;
49}
50
51static int arizona_micsupp_map_voltage(struct regulator_dev *rdev,
52 int min_uV, int max_uV)
53{
54 unsigned int voltage;
55 int selector;
56
57 if (min_uV < 1700000)
58 min_uV = 1700000;
59
60 if (min_uV > 3200000)
61 selector = ARIZONA_MICSUPP_MAX_SELECTOR;
62 else
63 selector = DIV_ROUND_UP(min_uV - 1700000, 50000);
64
65 if (selector < 0)
66 return -EINVAL;
67
68 voltage = arizona_micsupp_list_voltage(rdev, selector);
69 if (voltage < min_uV || voltage > max_uV)
70 return -EINVAL;
71
72 return selector;
73}
74
75static struct regulator_ops arizona_micsupp_ops = {
76 .enable = regulator_enable_regmap,
77 .disable = regulator_disable_regmap,
78 .is_enabled = regulator_is_enabled_regmap,
79
80 .list_voltage = arizona_micsupp_list_voltage,
81 .map_voltage = arizona_micsupp_map_voltage,
82
83 .get_voltage_sel = regulator_get_voltage_sel_regmap,
84 .set_voltage_sel = regulator_set_voltage_sel_regmap,
85
86 .get_bypass = regulator_get_bypass_regmap,
87 .set_bypass = regulator_set_bypass_regmap,
88};
89
90static const struct regulator_desc arizona_micsupp = {
91 .name = "MICVDD",
92 .supply_name = "CPVDD",
93 .type = REGULATOR_VOLTAGE,
94 .n_voltages = ARIZONA_MICSUPP_MAX_SELECTOR + 1,
95 .ops = &arizona_micsupp_ops,
96
97 .vsel_reg = ARIZONA_LDO2_CONTROL_1,
98 .vsel_mask = ARIZONA_LDO2_VSEL_MASK,
99 .enable_reg = ARIZONA_MIC_CHARGE_PUMP_1,
100 .enable_mask = ARIZONA_CPMIC_ENA,
101 .bypass_reg = ARIZONA_MIC_CHARGE_PUMP_1,
102 .bypass_mask = ARIZONA_CPMIC_BYPASS,
103
104 .enable_time = 3000,
105
106 .owner = THIS_MODULE,
107};
108
109static const struct regulator_init_data arizona_micsupp_default = {
110 .constraints = {
111 .valid_ops_mask = REGULATOR_CHANGE_STATUS |
112 REGULATOR_CHANGE_VOLTAGE,
113 .min_uV = 1700000,
114 .max_uV = 3300000,
115 },
116
117 .num_consumer_supplies = 1,
118};
119
120static int arizona_micsupp_probe(struct platform_device *pdev)
121{
122 struct arizona *arizona = dev_get_drvdata(pdev->dev.parent);
123 struct regulator_config config = { };
124 struct arizona_micsupp *micsupp;
125 int ret;
126
127 micsupp = devm_kzalloc(&pdev->dev, sizeof(*micsupp), GFP_KERNEL);
128 if (micsupp == NULL) {
129 dev_err(&pdev->dev, "Unable to allocate private data\n");
130 return -ENOMEM;
131 }
132
133 micsupp->arizona = arizona;
134
135 /*
136 * Since the chip usually supplies itself we provide some
137 * default init_data for it. This will be overridden with
138 * platform data if provided.
139 */
140 micsupp->init_data = arizona_micsupp_default;
141 micsupp->init_data.consumer_supplies = &micsupp->supply;
142 micsupp->supply.supply = "MICVDD";
143 micsupp->supply.dev_name = dev_name(arizona->dev);
144
145 config.dev = arizona->dev;
146 config.driver_data = micsupp;
147 config.regmap = arizona->regmap;
148
149 if (arizona->pdata.micvdd)
150 config.init_data = arizona->pdata.micvdd;
151 else
152 config.init_data = &micsupp->init_data;
153
154 /* Default to regulated mode until the API supports bypass */
155 regmap_update_bits(arizona->regmap, ARIZONA_MIC_CHARGE_PUMP_1,
156 ARIZONA_CPMIC_BYPASS, 0);
157
158 micsupp->regulator = regulator_register(&arizona_micsupp, &config);
159 if (IS_ERR(micsupp->regulator)) {
160 ret = PTR_ERR(micsupp->regulator);
161 dev_err(arizona->dev, "Failed to register mic supply: %d\n",
162 ret);
163 return ret;
164 }
165
166 platform_set_drvdata(pdev, micsupp);
167
168 return 0;
169}
170
171static int arizona_micsupp_remove(struct platform_device *pdev)
172{
173 struct arizona_micsupp *micsupp = platform_get_drvdata(pdev);
174
175 regulator_unregister(micsupp->regulator);
176
177 return 0;
178}
179
180static struct platform_driver arizona_micsupp_driver = {
181 .probe = arizona_micsupp_probe,
182 .remove = arizona_micsupp_remove,
183 .driver = {
184 .name = "arizona-micsupp",
185 .owner = THIS_MODULE,
186 },
187};
188
189module_platform_driver(arizona_micsupp_driver);
190
191/* Module information */
192MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
193MODULE_DESCRIPTION("Arizona microphone supply driver");
194MODULE_LICENSE("GPL");
195MODULE_ALIAS("platform:arizona-micsupp");