Kernel bump from 4.1.3-rt to 4.1.7-rt.
[kvmfornfv.git] / kernel / sound / soc / codecs / ssm4567.c
1 /*
2  * SSM4567 amplifier audio driver
3  *
4  * Copyright 2014 Google Chromium project.
5  *  Author: Anatol Pomozov <anatol@chromium.org>
6  *
7  * Based on code copyright/by:
8  *   Copyright 2013 Analog Devices Inc.
9  *
10  * Licensed under the GPL-2.
11  */
12
13 #include <linux/module.h>
14 #include <linux/init.h>
15 #include <linux/i2c.h>
16 #include <linux/regmap.h>
17 #include <linux/slab.h>
18 #include <sound/core.h>
19 #include <sound/pcm.h>
20 #include <sound/pcm_params.h>
21 #include <sound/soc.h>
22 #include <sound/initval.h>
23 #include <sound/tlv.h>
24
25 #define SSM4567_REG_POWER_CTRL          0x00
26 #define SSM4567_REG_AMP_SNS_CTRL                0x01
27 #define SSM4567_REG_DAC_CTRL            0x02
28 #define SSM4567_REG_DAC_VOLUME          0x03
29 #define SSM4567_REG_SAI_CTRL_1          0x04
30 #define SSM4567_REG_SAI_CTRL_2          0x05
31 #define SSM4567_REG_SAI_PLACEMENT_1             0x06
32 #define SSM4567_REG_SAI_PLACEMENT_2             0x07
33 #define SSM4567_REG_SAI_PLACEMENT_3             0x08
34 #define SSM4567_REG_SAI_PLACEMENT_4             0x09
35 #define SSM4567_REG_SAI_PLACEMENT_5             0x0a
36 #define SSM4567_REG_SAI_PLACEMENT_6             0x0b
37 #define SSM4567_REG_BATTERY_V_OUT               0x0c
38 #define SSM4567_REG_LIMITER_CTRL_1              0x0d
39 #define SSM4567_REG_LIMITER_CTRL_2              0x0e
40 #define SSM4567_REG_LIMITER_CTRL_3              0x0f
41 #define SSM4567_REG_STATUS_1            0x10
42 #define SSM4567_REG_STATUS_2            0x11
43 #define SSM4567_REG_FAULT_CTRL          0x12
44 #define SSM4567_REG_PDM_CTRL            0x13
45 #define SSM4567_REG_MCLK_RATIO          0x14
46 #define SSM4567_REG_BOOST_CTRL_1                0x15
47 #define SSM4567_REG_BOOST_CTRL_2                0x16
48 #define SSM4567_REG_SOFT_RESET          0xff
49
50 /* POWER_CTRL */
51 #define SSM4567_POWER_APWDN_EN          BIT(7)
52 #define SSM4567_POWER_BSNS_PWDN         BIT(6)
53 #define SSM4567_POWER_VSNS_PWDN         BIT(5)
54 #define SSM4567_POWER_ISNS_PWDN         BIT(4)
55 #define SSM4567_POWER_BOOST_PWDN                BIT(3)
56 #define SSM4567_POWER_AMP_PWDN          BIT(2)
57 #define SSM4567_POWER_VBAT_ONLY         BIT(1)
58 #define SSM4567_POWER_SPWDN                     BIT(0)
59
60 /* DAC_CTRL */
61 #define SSM4567_DAC_HV                  BIT(7)
62 #define SSM4567_DAC_MUTE                BIT(6)
63 #define SSM4567_DAC_HPF                 BIT(5)
64 #define SSM4567_DAC_LPM                 BIT(4)
65 #define SSM4567_DAC_FS_MASK     0x7
66 #define SSM4567_DAC_FS_8000_12000       0x0
67 #define SSM4567_DAC_FS_16000_24000      0x1
68 #define SSM4567_DAC_FS_32000_48000      0x2
69 #define SSM4567_DAC_FS_64000_96000      0x3
70 #define SSM4567_DAC_FS_128000_192000    0x4
71
72 /* SAI_CTRL_1 */
73 #define SSM4567_SAI_CTRL_1_BCLK                 BIT(6)
74 #define SSM4567_SAI_CTRL_1_TDM_BLCKS_MASK       (0x3 << 4)
75 #define SSM4567_SAI_CTRL_1_TDM_BLCKS_32         (0x0 << 4)
76 #define SSM4567_SAI_CTRL_1_TDM_BLCKS_48         (0x1 << 4)
77 #define SSM4567_SAI_CTRL_1_TDM_BLCKS_64         (0x2 << 4)
78 #define SSM4567_SAI_CTRL_1_FSYNC                BIT(3)
79 #define SSM4567_SAI_CTRL_1_LJ                   BIT(2)
80 #define SSM4567_SAI_CTRL_1_TDM                  BIT(1)
81 #define SSM4567_SAI_CTRL_1_PDM                  BIT(0)
82
83 /* SAI_CTRL_2 */
84 #define SSM4567_SAI_CTRL_2_AUTO_SLOT            BIT(3)
85 #define SSM4567_SAI_CTRL_2_TDM_SLOT_MASK        0x7
86 #define SSM4567_SAI_CTRL_2_TDM_SLOT(x)          (x)
87
88 struct ssm4567 {
89         struct regmap *regmap;
90 };
91
92 static const struct reg_default ssm4567_reg_defaults[] = {
93         { SSM4567_REG_POWER_CTRL,       0x81 },
94         { SSM4567_REG_AMP_SNS_CTRL, 0x09 },
95         { SSM4567_REG_DAC_CTRL, 0x32 },
96         { SSM4567_REG_DAC_VOLUME, 0x40 },
97         { SSM4567_REG_SAI_CTRL_1, 0x00 },
98         { SSM4567_REG_SAI_CTRL_2, 0x08 },
99         { SSM4567_REG_SAI_PLACEMENT_1, 0x01 },
100         { SSM4567_REG_SAI_PLACEMENT_2, 0x20 },
101         { SSM4567_REG_SAI_PLACEMENT_3, 0x32 },
102         { SSM4567_REG_SAI_PLACEMENT_4, 0x07 },
103         { SSM4567_REG_SAI_PLACEMENT_5, 0x07 },
104         { SSM4567_REG_SAI_PLACEMENT_6, 0x07 },
105         { SSM4567_REG_BATTERY_V_OUT, 0x00 },
106         { SSM4567_REG_LIMITER_CTRL_1, 0xa4 },
107         { SSM4567_REG_LIMITER_CTRL_2, 0x73 },
108         { SSM4567_REG_LIMITER_CTRL_3, 0x00 },
109         { SSM4567_REG_STATUS_1, 0x00 },
110         { SSM4567_REG_STATUS_2, 0x00 },
111         { SSM4567_REG_FAULT_CTRL, 0x30 },
112         { SSM4567_REG_PDM_CTRL, 0x40 },
113         { SSM4567_REG_MCLK_RATIO, 0x11 },
114         { SSM4567_REG_BOOST_CTRL_1, 0x03 },
115         { SSM4567_REG_BOOST_CTRL_2, 0x00 },
116         { SSM4567_REG_SOFT_RESET, 0x00 },
117 };
118
119
120 static bool ssm4567_readable_reg(struct device *dev, unsigned int reg)
121 {
122         switch (reg) {
123         case SSM4567_REG_POWER_CTRL ... SSM4567_REG_BOOST_CTRL_2:
124                 return true;
125         default:
126                 return false;
127         }
128
129 }
130
131 static bool ssm4567_writeable_reg(struct device *dev, unsigned int reg)
132 {
133         switch (reg) {
134         case SSM4567_REG_POWER_CTRL ... SSM4567_REG_SAI_PLACEMENT_6:
135         case SSM4567_REG_LIMITER_CTRL_1 ... SSM4567_REG_LIMITER_CTRL_3:
136         case SSM4567_REG_FAULT_CTRL ... SSM4567_REG_BOOST_CTRL_2:
137         /* The datasheet states that soft reset register is read-only,
138          * but logically it is write-only. */
139         case SSM4567_REG_SOFT_RESET:
140                 return true;
141         default:
142                 return false;
143         }
144 }
145
146 static bool ssm4567_volatile_reg(struct device *dev, unsigned int reg)
147 {
148         switch (reg) {
149         case SSM4567_REG_BATTERY_V_OUT:
150         case SSM4567_REG_STATUS_1 ... SSM4567_REG_STATUS_2:
151         case SSM4567_REG_SOFT_RESET:
152                 return true;
153         default:
154                 return false;
155         }
156 }
157
158 static const DECLARE_TLV_DB_MINMAX_MUTE(ssm4567_vol_tlv, -7125, 2400);
159
160 static const struct snd_kcontrol_new ssm4567_snd_controls[] = {
161         SOC_SINGLE_TLV("Master Playback Volume", SSM4567_REG_DAC_VOLUME, 0,
162                 0xff, 1, ssm4567_vol_tlv),
163         SOC_SINGLE("DAC Low Power Mode Switch", SSM4567_REG_DAC_CTRL, 4, 1, 0),
164         SOC_SINGLE("DAC High Pass Filter Switch", SSM4567_REG_DAC_CTRL,
165                 5, 1, 0),
166 };
167
168 static const struct snd_kcontrol_new ssm4567_amplifier_boost_control =
169         SOC_DAPM_SINGLE("Switch", SSM4567_REG_POWER_CTRL, 1, 1, 1);
170
171 static const struct snd_soc_dapm_widget ssm4567_dapm_widgets[] = {
172         SND_SOC_DAPM_DAC("DAC", "HiFi Playback", SSM4567_REG_POWER_CTRL, 2, 1),
173         SND_SOC_DAPM_SWITCH("Amplifier Boost", SSM4567_REG_POWER_CTRL, 3, 1,
174                 &ssm4567_amplifier_boost_control),
175
176         SND_SOC_DAPM_OUTPUT("OUT"),
177 };
178
179 static const struct snd_soc_dapm_route ssm4567_routes[] = {
180         { "OUT", NULL, "Amplifier Boost" },
181         { "Amplifier Boost", "Switch", "DAC" },
182         { "OUT", NULL, "DAC" },
183 };
184
185 static int ssm4567_hw_params(struct snd_pcm_substream *substream,
186         struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
187 {
188         struct snd_soc_codec *codec = dai->codec;
189         struct ssm4567 *ssm4567 = snd_soc_codec_get_drvdata(codec);
190         unsigned int rate = params_rate(params);
191         unsigned int dacfs;
192
193         if (rate >= 8000 && rate <= 12000)
194                 dacfs = SSM4567_DAC_FS_8000_12000;
195         else if (rate >= 16000 && rate <= 24000)
196                 dacfs = SSM4567_DAC_FS_16000_24000;
197         else if (rate >= 32000 && rate <= 48000)
198                 dacfs = SSM4567_DAC_FS_32000_48000;
199         else if (rate >= 64000 && rate <= 96000)
200                 dacfs = SSM4567_DAC_FS_64000_96000;
201         else if (rate >= 128000 && rate <= 192000)
202                 dacfs = SSM4567_DAC_FS_128000_192000;
203         else
204                 return -EINVAL;
205
206         return regmap_update_bits(ssm4567->regmap, SSM4567_REG_DAC_CTRL,
207                                 SSM4567_DAC_FS_MASK, dacfs);
208 }
209
210 static int ssm4567_mute(struct snd_soc_dai *dai, int mute)
211 {
212         struct ssm4567 *ssm4567 = snd_soc_codec_get_drvdata(dai->codec);
213         unsigned int val;
214
215         val = mute ? SSM4567_DAC_MUTE : 0;
216         return regmap_update_bits(ssm4567->regmap, SSM4567_REG_DAC_CTRL,
217                         SSM4567_DAC_MUTE, val);
218 }
219
220 static int ssm4567_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask,
221         unsigned int rx_mask, int slots, int width)
222 {
223         struct ssm4567 *ssm4567 = snd_soc_dai_get_drvdata(dai);
224         unsigned int blcks;
225         int slot;
226         int ret;
227
228         if (tx_mask == 0)
229                 return -EINVAL;
230
231         if (rx_mask && rx_mask != tx_mask)
232                 return -EINVAL;
233
234         slot = __ffs(tx_mask);
235         if (tx_mask != BIT(slot))
236                 return -EINVAL;
237
238         switch (width) {
239         case 32:
240                 blcks = SSM4567_SAI_CTRL_1_TDM_BLCKS_32;
241                 break;
242         case 48:
243                 blcks = SSM4567_SAI_CTRL_1_TDM_BLCKS_48;
244                 break;
245         case 64:
246                 blcks = SSM4567_SAI_CTRL_1_TDM_BLCKS_64;
247                 break;
248         default:
249                 return -EINVAL;
250         }
251
252         ret = regmap_update_bits(ssm4567->regmap, SSM4567_REG_SAI_CTRL_2,
253                 SSM4567_SAI_CTRL_2_AUTO_SLOT | SSM4567_SAI_CTRL_2_TDM_SLOT_MASK,
254                 SSM4567_SAI_CTRL_2_TDM_SLOT(slot));
255         if (ret)
256                 return ret;
257
258         return regmap_update_bits(ssm4567->regmap, SSM4567_REG_SAI_CTRL_1,
259                 SSM4567_SAI_CTRL_1_TDM_BLCKS_MASK, blcks);
260 }
261
262 static int ssm4567_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
263 {
264         struct ssm4567 *ssm4567 = snd_soc_dai_get_drvdata(dai);
265         unsigned int ctrl1 = 0;
266         bool invert_fclk;
267
268         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
269         case SND_SOC_DAIFMT_CBS_CFS:
270                 break;
271         default:
272                 return -EINVAL;
273         }
274
275         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
276         case SND_SOC_DAIFMT_NB_NF:
277                 invert_fclk = false;
278                 break;
279         case SND_SOC_DAIFMT_IB_NF:
280                 ctrl1 |= SSM4567_SAI_CTRL_1_BCLK;
281                 invert_fclk = false;
282                 break;
283         case SND_SOC_DAIFMT_NB_IF:
284                 ctrl1 |= SSM4567_SAI_CTRL_1_FSYNC;
285                 invert_fclk = true;
286                 break;
287         case SND_SOC_DAIFMT_IB_IF:
288                 ctrl1 |= SSM4567_SAI_CTRL_1_BCLK;
289                 invert_fclk = true;
290                 break;
291         default:
292                 return -EINVAL;
293         }
294
295         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
296         case SND_SOC_DAIFMT_I2S:
297                 break;
298         case SND_SOC_DAIFMT_LEFT_J:
299                 ctrl1 |= SSM4567_SAI_CTRL_1_LJ;
300                 invert_fclk = !invert_fclk;
301                 break;
302         case SND_SOC_DAIFMT_DSP_A:
303                 ctrl1 |= SSM4567_SAI_CTRL_1_TDM;
304                 break;
305         case SND_SOC_DAIFMT_DSP_B:
306                 ctrl1 |= SSM4567_SAI_CTRL_1_TDM | SSM4567_SAI_CTRL_1_LJ;
307                 break;
308         case SND_SOC_DAIFMT_PDM:
309                 ctrl1 |= SSM4567_SAI_CTRL_1_PDM;
310                 break;
311         default:
312                 return -EINVAL;
313         }
314
315         if (invert_fclk)
316                 ctrl1 |= SSM4567_SAI_CTRL_1_FSYNC;
317
318         return regmap_update_bits(ssm4567->regmap, SSM4567_REG_SAI_CTRL_1,
319                         SSM4567_SAI_CTRL_1_BCLK |
320                         SSM4567_SAI_CTRL_1_FSYNC |
321                         SSM4567_SAI_CTRL_1_LJ |
322                         SSM4567_SAI_CTRL_1_TDM |
323                         SSM4567_SAI_CTRL_1_PDM,
324                         ctrl1);
325 }
326
327 static int ssm4567_set_power(struct ssm4567 *ssm4567, bool enable)
328 {
329         int ret = 0;
330
331         if (!enable) {
332                 ret = regmap_update_bits(ssm4567->regmap,
333                         SSM4567_REG_POWER_CTRL,
334                         SSM4567_POWER_SPWDN, SSM4567_POWER_SPWDN);
335                 regcache_mark_dirty(ssm4567->regmap);
336         }
337
338         regcache_cache_only(ssm4567->regmap, !enable);
339
340         if (enable) {
341                 ret = regmap_update_bits(ssm4567->regmap,
342                         SSM4567_REG_POWER_CTRL,
343                         SSM4567_POWER_SPWDN, 0x00);
344                 regcache_sync(ssm4567->regmap);
345         }
346
347         return ret;
348 }
349
350 static int ssm4567_set_bias_level(struct snd_soc_codec *codec,
351         enum snd_soc_bias_level level)
352 {
353         struct ssm4567 *ssm4567 = snd_soc_codec_get_drvdata(codec);
354         int ret = 0;
355
356         switch (level) {
357         case SND_SOC_BIAS_ON:
358                 break;
359         case SND_SOC_BIAS_PREPARE:
360                 break;
361         case SND_SOC_BIAS_STANDBY:
362                 if (codec->dapm.bias_level == SND_SOC_BIAS_OFF)
363                         ret = ssm4567_set_power(ssm4567, true);
364                 break;
365         case SND_SOC_BIAS_OFF:
366                 ret = ssm4567_set_power(ssm4567, false);
367                 break;
368         }
369
370         if (ret)
371                 return ret;
372
373         codec->dapm.bias_level = level;
374
375         return 0;
376 }
377
378 static const struct snd_soc_dai_ops ssm4567_dai_ops = {
379         .hw_params      = ssm4567_hw_params,
380         .digital_mute   = ssm4567_mute,
381         .set_fmt        = ssm4567_set_dai_fmt,
382         .set_tdm_slot   = ssm4567_set_tdm_slot,
383 };
384
385 static struct snd_soc_dai_driver ssm4567_dai = {
386         .name = "ssm4567-hifi",
387         .playback = {
388                 .stream_name = "Playback",
389                 .channels_min = 1,
390                 .channels_max = 1,
391                 .rates = SNDRV_PCM_RATE_8000_192000,
392                 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE |
393                         SNDRV_PCM_FMTBIT_S32,
394         },
395         .ops = &ssm4567_dai_ops,
396 };
397
398 static struct snd_soc_codec_driver ssm4567_codec_driver = {
399         .set_bias_level = ssm4567_set_bias_level,
400         .idle_bias_off = true,
401
402         .controls = ssm4567_snd_controls,
403         .num_controls = ARRAY_SIZE(ssm4567_snd_controls),
404         .dapm_widgets = ssm4567_dapm_widgets,
405         .num_dapm_widgets = ARRAY_SIZE(ssm4567_dapm_widgets),
406         .dapm_routes = ssm4567_routes,
407         .num_dapm_routes = ARRAY_SIZE(ssm4567_routes),
408 };
409
410 static const struct regmap_config ssm4567_regmap_config = {
411         .val_bits = 8,
412         .reg_bits = 8,
413
414         .max_register = SSM4567_REG_SOFT_RESET,
415         .readable_reg = ssm4567_readable_reg,
416         .writeable_reg = ssm4567_writeable_reg,
417         .volatile_reg = ssm4567_volatile_reg,
418
419         .cache_type = REGCACHE_RBTREE,
420         .reg_defaults = ssm4567_reg_defaults,
421         .num_reg_defaults = ARRAY_SIZE(ssm4567_reg_defaults),
422 };
423
424 static int ssm4567_i2c_probe(struct i2c_client *i2c,
425         const struct i2c_device_id *id)
426 {
427         struct ssm4567 *ssm4567;
428         int ret;
429
430         ssm4567 = devm_kzalloc(&i2c->dev, sizeof(*ssm4567), GFP_KERNEL);
431         if (ssm4567 == NULL)
432                 return -ENOMEM;
433
434         i2c_set_clientdata(i2c, ssm4567);
435
436         ssm4567->regmap = devm_regmap_init_i2c(i2c, &ssm4567_regmap_config);
437         if (IS_ERR(ssm4567->regmap))
438                 return PTR_ERR(ssm4567->regmap);
439
440         ret = regmap_write(ssm4567->regmap, SSM4567_REG_SOFT_RESET, 0x00);
441         if (ret)
442                 return ret;
443
444         ret = ssm4567_set_power(ssm4567, false);
445         if (ret)
446                 return ret;
447
448         return snd_soc_register_codec(&i2c->dev, &ssm4567_codec_driver,
449                         &ssm4567_dai, 1);
450 }
451
452 static int ssm4567_i2c_remove(struct i2c_client *client)
453 {
454         snd_soc_unregister_codec(&client->dev);
455         return 0;
456 }
457
458 static const struct i2c_device_id ssm4567_i2c_ids[] = {
459         { "ssm4567", 0 },
460         { }
461 };
462 MODULE_DEVICE_TABLE(i2c, ssm4567_i2c_ids);
463
464 static struct i2c_driver ssm4567_driver = {
465         .driver = {
466                 .name = "ssm4567",
467                 .owner = THIS_MODULE,
468         },
469         .probe = ssm4567_i2c_probe,
470         .remove = ssm4567_i2c_remove,
471         .id_table = ssm4567_i2c_ids,
472 };
473 module_i2c_driver(ssm4567_driver);
474
475 MODULE_DESCRIPTION("ASoC SSM4567 driver");
476 MODULE_AUTHOR("Anatol Pomozov <anatol@chromium.org>");
477 MODULE_LICENSE("GPL");