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