1 /*
2 * LM4857 AMP driver
3 *
4 * Copyright 2007 Wolfson Microelectronics PLC.
5 * Author: Graeme Gregory
6 * graeme.gregory@wolfsonmicro.com
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
lm4857_write(struct snd_soc_codec * codec,unsigned int reg,unsigned int value)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
lm4857_read(struct snd_soc_codec * codec,unsigned int reg)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
lm4857_get_mode(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)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
lm4857_set_mode(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)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
lm4857_set_bias_level(struct snd_soc_codec * codec,enum snd_soc_bias_level level)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
164 /* There is a demux between the input signal and the output signals.
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
lm4857_probe(struct snd_soc_codec * codec)174 static int lm4857_probe(struct snd_soc_codec *codec)
175 {
176 struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec);
177 struct snd_soc_dapm_context *dapm = &codec->dapm;
178 int ret;
179
180 codec->control_data = lm4857->i2c;
181
182 ret = snd_soc_add_codec_controls(codec, lm4857_controls,
183 ARRAY_SIZE(lm4857_controls));
184 if (ret)
185 return ret;
186
187 ret = snd_soc_dapm_new_controls(dapm, lm4857_dapm_widgets,
188 ARRAY_SIZE(lm4857_dapm_widgets));
189 if (ret)
190 return ret;
191
192 ret = snd_soc_dapm_add_routes(dapm, lm4857_routes,
193 ARRAY_SIZE(lm4857_routes));
194 if (ret)
195 return ret;
196
197 snd_soc_dapm_new_widgets(dapm);
198
199 return 0;
200 }
201
202 static struct snd_soc_codec_driver soc_codec_dev_lm4857 = {
203 .write = lm4857_write,
204 .read = lm4857_read,
205 .probe = lm4857_probe,
206 .reg_cache_size = ARRAY_SIZE(lm4857_default_regs),
207 .reg_word_size = sizeof(uint8_t),
208 .reg_cache_default = lm4857_default_regs,
209 .set_bias_level = lm4857_set_bias_level,
210 };
211
lm4857_i2c_probe(struct i2c_client * i2c,const struct i2c_device_id * id)212 static int __devinit lm4857_i2c_probe(struct i2c_client *i2c,
213 const struct i2c_device_id *id)
214 {
215 struct lm4857 *lm4857;
216 int ret;
217
218 lm4857 = devm_kzalloc(&i2c->dev, sizeof(*lm4857), GFP_KERNEL);
219 if (!lm4857)
220 return -ENOMEM;
221
222 i2c_set_clientdata(i2c, lm4857);
223
224 lm4857->i2c = i2c;
225
226 ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_lm4857, NULL, 0);
227
228 return ret;
229 }
230
lm4857_i2c_remove(struct i2c_client * i2c)231 static int __devexit lm4857_i2c_remove(struct i2c_client *i2c)
232 {
233 snd_soc_unregister_codec(&i2c->dev);
234 return 0;
235 }
236
237 static const struct i2c_device_id lm4857_i2c_id[] = {
238 { "lm4857", 0 },
239 { }
240 };
241 MODULE_DEVICE_TABLE(i2c, lm4857_i2c_id);
242
243 static struct i2c_driver lm4857_i2c_driver = {
244 .driver = {
245 .name = "lm4857",
246 .owner = THIS_MODULE,
247 },
248 .probe = lm4857_i2c_probe,
249 .remove = __devexit_p(lm4857_i2c_remove),
250 .id_table = lm4857_i2c_id,
251 };
252
lm4857_init(void)253 static int __init lm4857_init(void)
254 {
255 return i2c_add_driver(&lm4857_i2c_driver);
256 }
257 module_init(lm4857_init);
258
lm4857_exit(void)259 static void __exit lm4857_exit(void)
260 {
261 i2c_del_driver(&lm4857_i2c_driver);
262 }
263 module_exit(lm4857_exit);
264
265 MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
266 MODULE_DESCRIPTION("LM4857 amplifier driver");
267 MODULE_LICENSE("GPL");
268