hc
2024-01-05 071106ecf68c401173c58808b1cf5f68cc50d390
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
// SPDX-License-Identifier: GPL-2.0-only
// Copyright (c) 2020 Intel Corporation
 
/*
 *  sof_sdw_rt1316 - Helpers to handle RT1316 from generic machine driver
 */
 
#include <linux/device.h>
#include <linux/errno.h>
#include <sound/control.h>
#include <sound/soc.h>
#include <sound/soc-acpi.h>
#include <sound/soc-dapm.h>
#include "sof_sdw_common.h"
 
static const struct snd_soc_dapm_widget rt1316_widgets[] = {
   SND_SOC_DAPM_SPK("Speaker", NULL),
};
 
/*
 * dapm routes for rt1316 will be registered dynamically according
 * to the number of rt1316 used. The first two entries will be registered
 * for one codec case, and the last two entries are also registered
 * if two 1316s are used.
 */
static const struct snd_soc_dapm_route rt1316_map[] = {
   { "Speaker", NULL, "rt1316-1 SPOL" },
   { "Speaker", NULL, "rt1316-1 SPOR" },
   { "Speaker", NULL, "rt1316-2 SPOL" },
   { "Speaker", NULL, "rt1316-2 SPOR" },
};
 
static const struct snd_kcontrol_new rt1316_controls[] = {
   SOC_DAPM_PIN_SWITCH("Speaker"),
};
 
static int first_spk_init(struct snd_soc_pcm_runtime *rtd)
{
   struct snd_soc_card *card = rtd->card;
   int ret;
 
   card->components = devm_kasprintf(card->dev, GFP_KERNEL,
                     "%s spk:rt1316",
                     card->components);
   if (!card->components)
       return -ENOMEM;
 
   ret = snd_soc_add_card_controls(card, rt1316_controls,
                   ARRAY_SIZE(rt1316_controls));
   if (ret) {
       dev_err(card->dev, "rt1316 controls addition failed: %d\n", ret);
       return ret;
   }
 
   ret = snd_soc_dapm_new_controls(&card->dapm, rt1316_widgets,
                   ARRAY_SIZE(rt1316_widgets));
   if (ret) {
       dev_err(card->dev, "rt1316 widgets addition failed: %d\n", ret);
       return ret;
   }
 
   ret = snd_soc_dapm_add_routes(&card->dapm, rt1316_map, 2);
   if (ret)
       dev_err(rtd->dev, "failed to add first SPK map: %d\n", ret);
 
   return ret;
}
 
static int second_spk_init(struct snd_soc_pcm_runtime *rtd)
{
   struct snd_soc_card *card = rtd->card;
   int ret;
 
   ret = snd_soc_dapm_add_routes(&card->dapm, rt1316_map + 2, 2);
   if (ret)
       dev_err(rtd->dev, "failed to add second SPK map: %d\n", ret);
 
   return ret;
}
 
static int all_spk_init(struct snd_soc_pcm_runtime *rtd)
{
   int ret;
 
   ret = first_spk_init(rtd);
   if (ret)
       return ret;
 
   return second_spk_init(rtd);
}
 
int sof_sdw_rt1316_init(const struct snd_soc_acpi_link_adr *link,
           struct snd_soc_dai_link *dai_links,
           struct sof_sdw_codec_info *info,
           bool playback)
{
   /* Count amp number and do init on playback link only. */
   if (!playback)
       return 0;
 
   info->amp_num++;
   if (info->amp_num == 1)
       dai_links->init = first_spk_init;
 
   if (info->amp_num == 2) {
       /*
        * if two 1316s are in one dai link, the init function
        * in this dai link will be first set for the first speaker,
        * and it should be reset to initialize all speakers when
        * the second speaker is found.
        */
       if (dai_links->init)
           dai_links->init = all_spk_init;
       else
           dai_links->init = second_spk_init;
   }
 
   return 0;
}