Commit | Line | Data |
---|---|---|
9b0a25f0 LPC |
1 | /* |
2 | * LM4857 AMP driver | |
3 | * | |
4 | * Copyright 2007 Wolfson Microelectronics PLC. | |
5 | * Author: Graeme Gregory | |
9a185b9a | 6 | * graeme.gregory@wolfsonmicro.com |
9b0a25f0 LPC |
7 | * Copyright 2011 Lars-Peter Clausen <lars@metafoo.de> |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify it | |
10 | * under the terms of the GNU General Public License as published by the | |
11 | * Free Software Foundation; either version 2 of the License, or (at your | |
12 | * option) any later version. | |
13 | * | |
14 | */ | |
15 | ||
16 | #include <linux/init.h> | |
17 | #include <linux/module.h> | |
18 | #include <linux/i2c.h> | |
19 | #include <linux/slab.h> | |
20 | ||
21 | #include <sound/core.h> | |
22 | #include <sound/soc.h> | |
23 | #include <sound/tlv.h> | |
24 | ||
25 | struct lm4857 { | |
26 | struct i2c_client *i2c; | |
27 | uint8_t mode; | |
28 | }; | |
29 | ||
30 | static const uint8_t lm4857_default_regs[] = { | |
31 | 0x00, 0x00, 0x00, 0x00, | |
32 | }; | |
33 | ||
34 | /* The register offsets in the cache array */ | |
35 | #define LM4857_MVOL 0 | |
36 | #define LM4857_LVOL 1 | |
37 | #define LM4857_RVOL 2 | |
38 | #define LM4857_CTRL 3 | |
39 | ||
40 | /* the shifts required to set these bits */ | |
41 | #define LM4857_3D 5 | |
42 | #define LM4857_WAKEUP 5 | |
43 | #define LM4857_EPGAIN 4 | |
44 | ||
45 | static int lm4857_write(struct snd_soc_codec *codec, unsigned int reg, | |
46 | unsigned int value) | |
47 | { | |
48 | uint8_t data; | |
49 | int ret; | |
50 | ||
51 | ret = snd_soc_cache_write(codec, reg, value); | |
52 | if (ret < 0) | |
53 | return ret; | |
54 | ||
55 | data = (reg << 6) | value; | |
56 | ret = i2c_master_send(codec->control_data, &data, 1); | |
57 | if (ret != 1) { | |
58 | dev_err(codec->dev, "Failed to write register: %d\n", ret); | |
59 | return ret; | |
60 | } | |
61 | ||
62 | return 0; | |
63 | } | |
64 | ||
65 | static unsigned int lm4857_read(struct snd_soc_codec *codec, | |
66 | unsigned int reg) | |
67 | { | |
68 | unsigned int val; | |
69 | int ret; | |
70 | ||
71 | ret = snd_soc_cache_read(codec, reg, &val); | |
72 | if (ret) | |
73 | return -1; | |
74 | ||
75 | return val; | |
76 | } | |
77 | ||
78 | static int lm4857_get_mode(struct snd_kcontrol *kcontrol, | |
79 | struct snd_ctl_elem_value *ucontrol) | |
80 | { | |
81 | struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); | |
82 | struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec); | |
83 | ||
84 | ucontrol->value.integer.value[0] = lm4857->mode; | |
85 | ||
86 | return 0; | |
87 | } | |
88 | ||
89 | static int lm4857_set_mode(struct snd_kcontrol *kcontrol, | |
90 | struct snd_ctl_elem_value *ucontrol) | |
91 | { | |
92 | struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); | |
93 | struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec); | |
94 | uint8_t value = ucontrol->value.integer.value[0]; | |
95 | ||
96 | lm4857->mode = value; | |
97 | ||
98 | if (codec->dapm.bias_level == SND_SOC_BIAS_ON) | |
99 | snd_soc_update_bits(codec, LM4857_CTRL, 0x0F, value + 6); | |
100 | ||
101 | return 1; | |
102 | } | |
103 | ||
104 | static int lm4857_set_bias_level(struct snd_soc_codec *codec, | |
105 | enum snd_soc_bias_level level) | |
106 | { | |
107 | struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec); | |
108 | ||
109 | switch (level) { | |
110 | case SND_SOC_BIAS_ON: | |
111 | snd_soc_update_bits(codec, LM4857_CTRL, 0x0F, lm4857->mode + 6); | |
112 | break; | |
113 | case SND_SOC_BIAS_STANDBY: | |
114 | snd_soc_update_bits(codec, LM4857_CTRL, 0x0F, 0); | |
115 | break; | |
116 | default: | |
117 | break; | |
118 | } | |
119 | ||
120 | codec->dapm.bias_level = level; | |
121 | ||
122 | return 0; | |
123 | } | |
124 | ||
125 | static const char *lm4857_mode[] = { | |
126 | "Earpiece", | |
127 | "Loudspeaker", | |
128 | "Loudspeaker + Headphone", | |
129 | "Headphone", | |
130 | }; | |
131 | ||
132 | static const struct soc_enum lm4857_mode_enum = | |
133 | SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(lm4857_mode), lm4857_mode); | |
134 | ||
135 | static const struct snd_soc_dapm_widget lm4857_dapm_widgets[] = { | |
136 | SND_SOC_DAPM_INPUT("IN"), | |
137 | ||
138 | SND_SOC_DAPM_OUTPUT("LS"), | |
139 | SND_SOC_DAPM_OUTPUT("HP"), | |
140 | SND_SOC_DAPM_OUTPUT("EP"), | |
141 | }; | |
142 | ||
143 | static const DECLARE_TLV_DB_SCALE(stereo_tlv, -4050, 150, 0); | |
144 | static const DECLARE_TLV_DB_SCALE(mono_tlv, -3450, 150, 0); | |
145 | ||
146 | static const struct snd_kcontrol_new lm4857_controls[] = { | |
147 | SOC_SINGLE_TLV("Left Playback Volume", LM4857_LVOL, 0, 31, 0, | |
148 | stereo_tlv), | |
149 | SOC_SINGLE_TLV("Right Playback Volume", LM4857_RVOL, 0, 31, 0, | |
150 | stereo_tlv), | |
151 | SOC_SINGLE_TLV("Mono Playback Volume", LM4857_MVOL, 0, 31, 0, | |
152 | mono_tlv), | |
153 | SOC_SINGLE("Spk 3D Playback Switch", LM4857_LVOL, LM4857_3D, 1, 0), | |
154 | SOC_SINGLE("HP 3D Playback Switch", LM4857_RVOL, LM4857_3D, 1, 0), | |
155 | SOC_SINGLE("Fast Wakeup Playback Switch", LM4857_CTRL, | |
156 | LM4857_WAKEUP, 1, 0), | |
157 | SOC_SINGLE("Earpiece 6dB Playback Switch", LM4857_CTRL, | |
158 | LM4857_EPGAIN, 1, 0), | |
159 | ||
160 | SOC_ENUM_EXT("Mode", lm4857_mode_enum, | |
161 | lm4857_get_mode, lm4857_set_mode), | |
162 | }; | |
163 | ||
25985edc | 164 | /* There is a demux between the input signal and the output signals. |
9b0a25f0 LPC |
165 | * Currently there is no easy way to model it in ASoC and since it does not make |
166 | * much of a difference in practice simply connect the input direclty to the | |
167 | * outputs. */ | |
168 | static const struct snd_soc_dapm_route lm4857_routes[] = { | |
169 | {"LS", NULL, "IN"}, | |
170 | {"HP", NULL, "IN"}, | |
171 | {"EP", NULL, "IN"}, | |
172 | }; | |
173 | ||
174 | static int lm4857_probe(struct snd_soc_codec *codec) | |
175 | { | |
176 | struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec); | |
9b0a25f0 LPC |
177 | |
178 | codec->control_data = lm4857->i2c; | |
179 | ||
9b0a25f0 LPC |
180 | return 0; |
181 | } | |
182 | ||
183 | static struct snd_soc_codec_driver soc_codec_dev_lm4857 = { | |
184 | .write = lm4857_write, | |
185 | .read = lm4857_read, | |
186 | .probe = lm4857_probe, | |
187 | .reg_cache_size = ARRAY_SIZE(lm4857_default_regs), | |
188 | .reg_word_size = sizeof(uint8_t), | |
189 | .reg_cache_default = lm4857_default_regs, | |
190 | .set_bias_level = lm4857_set_bias_level, | |
07ccc0f4 LPC |
191 | |
192 | .controls = lm4857_controls, | |
193 | .num_controls = ARRAY_SIZE(lm4857_controls), | |
194 | .dapm_widgets = lm4857_dapm_widgets, | |
195 | .num_dapm_widgets = ARRAY_SIZE(lm4857_dapm_widgets), | |
196 | .dapm_routes = lm4857_routes, | |
197 | .num_dapm_routes = ARRAY_SIZE(lm4857_routes), | |
9b0a25f0 LPC |
198 | }; |
199 | ||
7a79e94e BP |
200 | static int lm4857_i2c_probe(struct i2c_client *i2c, |
201 | const struct i2c_device_id *id) | |
9b0a25f0 LPC |
202 | { |
203 | struct lm4857 *lm4857; | |
204 | int ret; | |
205 | ||
eb3bb97c | 206 | lm4857 = devm_kzalloc(&i2c->dev, sizeof(*lm4857), GFP_KERNEL); |
9b0a25f0 LPC |
207 | if (!lm4857) |
208 | return -ENOMEM; | |
209 | ||
210 | i2c_set_clientdata(i2c, lm4857); | |
211 | ||
212 | lm4857->i2c = i2c; | |
213 | ||
214 | ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_lm4857, NULL, 0); | |
215 | ||
eb3bb97c | 216 | return ret; |
9b0a25f0 LPC |
217 | } |
218 | ||
7a79e94e | 219 | static int lm4857_i2c_remove(struct i2c_client *i2c) |
9b0a25f0 | 220 | { |
9b0a25f0 | 221 | snd_soc_unregister_codec(&i2c->dev); |
9b0a25f0 LPC |
222 | return 0; |
223 | } | |
224 | ||
225 | static const struct i2c_device_id lm4857_i2c_id[] = { | |
226 | { "lm4857", 0 }, | |
227 | { } | |
228 | }; | |
229 | MODULE_DEVICE_TABLE(i2c, lm4857_i2c_id); | |
230 | ||
231 | static struct i2c_driver lm4857_i2c_driver = { | |
232 | .driver = { | |
233 | .name = "lm4857", | |
234 | .owner = THIS_MODULE, | |
235 | }, | |
236 | .probe = lm4857_i2c_probe, | |
7a79e94e | 237 | .remove = lm4857_i2c_remove, |
9b0a25f0 LPC |
238 | .id_table = lm4857_i2c_id, |
239 | }; | |
240 | ||
f6ec139f | 241 | module_i2c_driver(lm4857_i2c_driver); |
9b0a25f0 LPC |
242 | |
243 | MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>"); | |
244 | MODULE_DESCRIPTION("LM4857 amplifier driver"); | |
245 | MODULE_LICENSE("GPL"); |