]>
Commit | Line | Data |
---|---|---|
0b83ddeb | 1 | /* |
4fe5668b PU |
2 | * MFD driver for twl4030 audio submodule, which contains an audio codec, and |
3 | * the vibra control. | |
0b83ddeb | 4 | * |
4a7c00cd | 5 | * Author: Peter Ujfalusi <peter.ujfalusi@ti.com> |
0b83ddeb PU |
6 | * |
7 | * Copyright: (C) 2009 Nokia Corporation | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License version 2 as | |
11 | * published by the Free Software Foundation. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, but | |
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
16 | * General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; if not, write to the Free Software | |
20 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA | |
21 | * 02110-1301 USA | |
22 | * | |
23 | */ | |
24 | ||
25 | #include <linux/module.h> | |
26 | #include <linux/types.h> | |
5a0e3ad6 | 27 | #include <linux/slab.h> |
0b83ddeb PU |
28 | #include <linux/kernel.h> |
29 | #include <linux/fs.h> | |
30 | #include <linux/platform_device.h> | |
019a7e6b PU |
31 | #include <linux/of.h> |
32 | #include <linux/of_platform.h> | |
8bea8672 | 33 | #include <linux/i2c/twl.h> |
0b83ddeb | 34 | #include <linux/mfd/core.h> |
57fe7251 | 35 | #include <linux/mfd/twl4030-audio.h> |
0b83ddeb | 36 | |
4fe5668b | 37 | #define TWL4030_AUDIO_CELLS 2 |
0b83ddeb | 38 | |
4fe5668b | 39 | static struct platform_device *twl4030_audio_dev; |
0b83ddeb | 40 | |
4fe5668b | 41 | struct twl4030_audio_resource { |
0b83ddeb PU |
42 | int request_count; |
43 | u8 reg; | |
44 | u8 mask; | |
45 | }; | |
46 | ||
4fe5668b | 47 | struct twl4030_audio { |
f9b4639e | 48 | unsigned int audio_mclk; |
0b83ddeb | 49 | struct mutex mutex; |
57fe7251 | 50 | struct twl4030_audio_resource resource[TWL4030_AUDIO_RES_MAX]; |
4fe5668b | 51 | struct mfd_cell cells[TWL4030_AUDIO_CELLS]; |
0b83ddeb PU |
52 | }; |
53 | ||
54 | /* | |
55 | * Modify the resource, the function returns the content of the register | |
56 | * after the modification. | |
57 | */ | |
57fe7251 | 58 | static int twl4030_audio_set_resource(enum twl4030_audio_res id, int enable) |
0b83ddeb | 59 | { |
4fe5668b | 60 | struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev); |
0b83ddeb PU |
61 | u8 val; |
62 | ||
8bea8672 | 63 | twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &val, |
4fe5668b | 64 | audio->resource[id].reg); |
0b83ddeb PU |
65 | |
66 | if (enable) | |
4fe5668b | 67 | val |= audio->resource[id].mask; |
0b83ddeb | 68 | else |
4fe5668b | 69 | val &= ~audio->resource[id].mask; |
0b83ddeb | 70 | |
8bea8672 | 71 | twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, |
4fe5668b | 72 | val, audio->resource[id].reg); |
0b83ddeb PU |
73 | |
74 | return val; | |
75 | } | |
76 | ||
57fe7251 | 77 | static inline int twl4030_audio_get_resource(enum twl4030_audio_res id) |
0b83ddeb | 78 | { |
4fe5668b | 79 | struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev); |
0b83ddeb PU |
80 | u8 val; |
81 | ||
8bea8672 | 82 | twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &val, |
4fe5668b | 83 | audio->resource[id].reg); |
0b83ddeb PU |
84 | |
85 | return val; | |
86 | } | |
87 | ||
88 | /* | |
89 | * Enable the resource. | |
90 | * The function returns with error or the content of the register | |
91 | */ | |
57fe7251 | 92 | int twl4030_audio_enable_resource(enum twl4030_audio_res id) |
0b83ddeb | 93 | { |
4fe5668b | 94 | struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev); |
0b83ddeb PU |
95 | int val; |
96 | ||
57fe7251 | 97 | if (id >= TWL4030_AUDIO_RES_MAX) { |
4fe5668b | 98 | dev_err(&twl4030_audio_dev->dev, |
0b83ddeb PU |
99 | "Invalid resource ID (%u)\n", id); |
100 | return -EINVAL; | |
101 | } | |
102 | ||
4fe5668b PU |
103 | mutex_lock(&audio->mutex); |
104 | if (!audio->resource[id].request_count) | |
0b83ddeb | 105 | /* Resource was disabled, enable it */ |
4fe5668b | 106 | val = twl4030_audio_set_resource(id, 1); |
0b83ddeb | 107 | else |
4fe5668b | 108 | val = twl4030_audio_get_resource(id); |
0b83ddeb | 109 | |
4fe5668b PU |
110 | audio->resource[id].request_count++; |
111 | mutex_unlock(&audio->mutex); | |
0b83ddeb PU |
112 | |
113 | return val; | |
114 | } | |
57fe7251 | 115 | EXPORT_SYMBOL_GPL(twl4030_audio_enable_resource); |
0b83ddeb PU |
116 | |
117 | /* | |
118 | * Disable the resource. | |
119 | * The function returns with error or the content of the register | |
120 | */ | |
6049bcef | 121 | int twl4030_audio_disable_resource(enum twl4030_audio_res id) |
0b83ddeb | 122 | { |
4fe5668b | 123 | struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev); |
0b83ddeb PU |
124 | int val; |
125 | ||
57fe7251 | 126 | if (id >= TWL4030_AUDIO_RES_MAX) { |
4fe5668b | 127 | dev_err(&twl4030_audio_dev->dev, |
0b83ddeb PU |
128 | "Invalid resource ID (%u)\n", id); |
129 | return -EINVAL; | |
130 | } | |
131 | ||
4fe5668b PU |
132 | mutex_lock(&audio->mutex); |
133 | if (!audio->resource[id].request_count) { | |
134 | dev_err(&twl4030_audio_dev->dev, | |
0b83ddeb | 135 | "Resource has been disabled already (%u)\n", id); |
4fe5668b | 136 | mutex_unlock(&audio->mutex); |
0b83ddeb PU |
137 | return -EPERM; |
138 | } | |
4fe5668b | 139 | audio->resource[id].request_count--; |
0b83ddeb | 140 | |
4fe5668b | 141 | if (!audio->resource[id].request_count) |
0b83ddeb | 142 | /* Resource can be disabled now */ |
4fe5668b | 143 | val = twl4030_audio_set_resource(id, 0); |
0b83ddeb | 144 | else |
4fe5668b | 145 | val = twl4030_audio_get_resource(id); |
0b83ddeb | 146 | |
4fe5668b | 147 | mutex_unlock(&audio->mutex); |
0b83ddeb PU |
148 | |
149 | return val; | |
150 | } | |
57fe7251 | 151 | EXPORT_SYMBOL_GPL(twl4030_audio_disable_resource); |
0b83ddeb | 152 | |
57fe7251 | 153 | unsigned int twl4030_audio_get_mclk(void) |
f9b4639e | 154 | { |
4fe5668b | 155 | struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev); |
f9b4639e | 156 | |
4fe5668b | 157 | return audio->audio_mclk; |
f9b4639e | 158 | } |
57fe7251 | 159 | EXPORT_SYMBOL_GPL(twl4030_audio_get_mclk); |
f9b4639e | 160 | |
019a7e6b PU |
161 | static bool twl4030_audio_has_codec(struct twl4030_audio_data *pdata, |
162 | struct device_node *node) | |
163 | { | |
164 | if (pdata && pdata->codec) | |
165 | return true; | |
166 | ||
167 | if (of_find_node_by_name(node, "codec")) | |
168 | return true; | |
169 | ||
170 | return false; | |
171 | } | |
172 | ||
173 | static bool twl4030_audio_has_vibra(struct twl4030_audio_data *pdata, | |
174 | struct device_node *node) | |
175 | { | |
176 | int vibra; | |
177 | ||
178 | if (pdata && pdata->vibra) | |
179 | return true; | |
180 | ||
181 | if (!of_property_read_u32(node, "ti,enable-vibra", &vibra) && vibra) | |
182 | return true; | |
183 | ||
184 | return false; | |
185 | } | |
186 | ||
f791be49 | 187 | static int twl4030_audio_probe(struct platform_device *pdev) |
0b83ddeb | 188 | { |
4fe5668b | 189 | struct twl4030_audio *audio; |
4ae6df5e | 190 | struct twl4030_audio_data *pdata = pdev->dev.platform_data; |
019a7e6b | 191 | struct device_node *node = pdev->dev.of_node; |
0b83ddeb PU |
192 | struct mfd_cell *cell = NULL; |
193 | int ret, childs = 0; | |
f9b4639e PU |
194 | u8 val; |
195 | ||
019a7e6b | 196 | if (!pdata && !node) { |
f9b4639e PU |
197 | dev_err(&pdev->dev, "Platform data is missing\n"); |
198 | return -EINVAL; | |
199 | } | |
200 | ||
cdf4b670 PU |
201 | audio = devm_kzalloc(&pdev->dev, sizeof(struct twl4030_audio), |
202 | GFP_KERNEL); | |
203 | if (!audio) | |
204 | return -ENOMEM; | |
205 | ||
206 | mutex_init(&audio->mutex); | |
c531241d | 207 | audio->audio_mclk = twl_get_hfclk_rate(); |
cdf4b670 | 208 | |
f9b4639e | 209 | /* Configure APLL_INFREQ and disable APLL if enabled */ |
cdf4b670 | 210 | switch (audio->audio_mclk) { |
f9b4639e | 211 | case 19200000: |
cdf4b670 | 212 | val = TWL4030_APLL_INFREQ_19200KHZ; |
f9b4639e PU |
213 | break; |
214 | case 26000000: | |
cdf4b670 | 215 | val = TWL4030_APLL_INFREQ_26000KHZ; |
f9b4639e PU |
216 | break; |
217 | case 38400000: | |
cdf4b670 | 218 | val = TWL4030_APLL_INFREQ_38400KHZ; |
f9b4639e PU |
219 | break; |
220 | default: | |
221 | dev_err(&pdev->dev, "Invalid audio_mclk\n"); | |
222 | return -EINVAL; | |
223 | } | |
cdf4b670 | 224 | twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, val, TWL4030_REG_APLL_CTL); |
0b83ddeb PU |
225 | |
226 | /* Codec power */ | |
57fe7251 PU |
227 | audio->resource[TWL4030_AUDIO_RES_POWER].reg = TWL4030_REG_CODEC_MODE; |
228 | audio->resource[TWL4030_AUDIO_RES_POWER].mask = TWL4030_CODECPDZ; | |
0b83ddeb PU |
229 | |
230 | /* PLL */ | |
57fe7251 PU |
231 | audio->resource[TWL4030_AUDIO_RES_APLL].reg = TWL4030_REG_APLL_CTL; |
232 | audio->resource[TWL4030_AUDIO_RES_APLL].mask = TWL4030_APLL_EN; | |
0b83ddeb | 233 | |
019a7e6b | 234 | if (twl4030_audio_has_codec(pdata, node)) { |
4fe5668b | 235 | cell = &audio->cells[childs]; |
f0fba2ad | 236 | cell->name = "twl4030-codec"; |
019a7e6b PU |
237 | if (pdata) { |
238 | cell->platform_data = pdata->codec; | |
239 | cell->pdata_size = sizeof(*pdata->codec); | |
240 | } | |
0b83ddeb PU |
241 | childs++; |
242 | } | |
019a7e6b | 243 | if (twl4030_audio_has_vibra(pdata, node)) { |
4fe5668b | 244 | cell = &audio->cells[childs]; |
f0fba2ad | 245 | cell->name = "twl4030-vibra"; |
019a7e6b PU |
246 | if (pdata) { |
247 | cell->platform_data = pdata->vibra; | |
248 | cell->pdata_size = sizeof(*pdata->vibra); | |
249 | } | |
0b83ddeb PU |
250 | childs++; |
251 | } | |
252 | ||
cdf4b670 PU |
253 | platform_set_drvdata(pdev, audio); |
254 | twl4030_audio_dev = pdev; | |
255 | ||
0b83ddeb | 256 | if (childs) |
4fe5668b | 257 | ret = mfd_add_devices(&pdev->dev, pdev->id, audio->cells, |
55692af5 | 258 | childs, NULL, 0, NULL); |
0b83ddeb PU |
259 | else { |
260 | dev_err(&pdev->dev, "No platform data found for childs\n"); | |
261 | ret = -ENODEV; | |
262 | } | |
263 | ||
96ac2d1a | 264 | if (ret) |
39c1421d | 265 | twl4030_audio_dev = NULL; |
0b83ddeb | 266 | |
0b83ddeb PU |
267 | return ret; |
268 | } | |
269 | ||
4740f73f | 270 | static int twl4030_audio_remove(struct platform_device *pdev) |
0b83ddeb | 271 | { |
0b83ddeb | 272 | mfd_remove_devices(&pdev->dev); |
4fe5668b | 273 | twl4030_audio_dev = NULL; |
0b83ddeb PU |
274 | |
275 | return 0; | |
276 | } | |
277 | ||
019a7e6b PU |
278 | static const struct of_device_id twl4030_audio_of_match[] = { |
279 | {.compatible = "ti,twl4030-audio", }, | |
280 | { }, | |
281 | }; | |
282 | MODULE_DEVICE_TABLE(of, twl4030_audio_of_match); | |
283 | ||
4fe5668b | 284 | static struct platform_driver twl4030_audio_driver = { |
0b83ddeb PU |
285 | .driver = { |
286 | .owner = THIS_MODULE, | |
f0fba2ad | 287 | .name = "twl4030-audio", |
019a7e6b | 288 | .of_match_table = twl4030_audio_of_match, |
0b83ddeb | 289 | }, |
41569a16 | 290 | .probe = twl4030_audio_probe, |
84449216 | 291 | .remove = twl4030_audio_remove, |
0b83ddeb PU |
292 | }; |
293 | ||
65349d60 | 294 | module_platform_driver(twl4030_audio_driver); |
0b83ddeb | 295 | |
4a7c00cd | 296 | MODULE_AUTHOR("Peter Ujfalusi <peter.ujfalusi@ti.com>"); |
41569a16 | 297 | MODULE_DESCRIPTION("TWL4030 audio block MFD driver"); |
0b83ddeb | 298 | MODULE_LICENSE("GPL"); |
41569a16 | 299 | MODULE_ALIAS("platform:twl4030-audio"); |