ASoC: sti: Add IEC control

[firefly-linux-kernel-4.4.55.git] / sound / soc / sti / uniperif_player.c

diff --git a/sound/soc/sti/uniperif_player.c b/sound/soc/sti/uniperif_player.c
index f609089a6e00eb928bb965a6091c7b7d1c6abc24..f6eefe1b8f8f1c6ad28b8c5ee00ee473d0d833ef 100644 (file)
--- a/sound/soc/sti/uniperif_player.c
+++ b/sound/soc/sti/uniperif_player.c
@@ -250,6 +250,7 @@ static void uni_player_set_channel_status(struct uniperif *player,
         * sampling frequency. If no sample rate is already specified, then
         * set one.
         */
+       mutex_lock(&player->ctrl_lock);
        if (runtime && (player->stream_settings.iec958.status[3]
                                        == IEC958_AES3_CON_FS_NOTID)) {
                switch (runtime->rate) {
@@ -327,6 +328,7 @@ static void uni_player_set_channel_status(struct uniperif *player,
                player->stream_settings.iec958.status[3 + (n * 4)] << 24;
                SET_UNIPERIF_CHANNEL_STA_REGN(player, n, status);
        }
+       mutex_unlock(&player->ctrl_lock);
 
        /* Update the channel status */
        if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
@@ -537,6 +539,63 @@ static int uni_player_prepare_pcm(struct uniperif *player,
        return 0;
 }
 
+/*
+ * ALSA uniperipheral iec958 controls
+ */
+static int  uni_player_ctl_iec958_info(struct snd_kcontrol *kcontrol,
+                                      struct snd_ctl_elem_info *uinfo)
+{
+       uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
+       uinfo->count = 1;
+
+       return 0;
+}
+
+static int uni_player_ctl_iec958_get(struct snd_kcontrol *kcontrol,
+                                    struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_soc_dai *dai = snd_kcontrol_chip(kcontrol);
+       struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
+       struct uniperif *player = priv->dai_data.uni;
+       struct snd_aes_iec958 *iec958 = &player->stream_settings.iec958;
+
+       mutex_lock(&player->ctrl_lock);
+       ucontrol->value.iec958.status[0] = iec958->status[0];
+       ucontrol->value.iec958.status[1] = iec958->status[1];
+       ucontrol->value.iec958.status[2] = iec958->status[2];
+       ucontrol->value.iec958.status[3] = iec958->status[3];
+       mutex_unlock(&player->ctrl_lock);
+       return 0;
+}
+
+static int uni_player_ctl_iec958_put(struct snd_kcontrol *kcontrol,
+                                    struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_soc_dai *dai = snd_kcontrol_chip(kcontrol);
+       struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
+       struct uniperif *player = priv->dai_data.uni;
+       struct snd_aes_iec958 *iec958 =  &player->stream_settings.iec958;
+
+       mutex_lock(&player->ctrl_lock);
+       iec958->status[0] = ucontrol->value.iec958.status[0];
+       iec958->status[1] = ucontrol->value.iec958.status[1];
+       iec958->status[2] = ucontrol->value.iec958.status[2];
+       iec958->status[3] = ucontrol->value.iec958.status[3];
+       mutex_unlock(&player->ctrl_lock);
+
+       uni_player_set_channel_status(player, NULL);
+
+       return 0;
+}
+
+static struct snd_kcontrol_new uni_player_iec958_ctl = {
+       .iface = SNDRV_CTL_ELEM_IFACE_PCM,
+       .name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, DEFAULT),
+       .info = uni_player_ctl_iec958_info,
+       .get = uni_player_ctl_iec958_get,
+       .put = uni_player_ctl_iec958_put,
+};
+
 /*
  * uniperif rate adjustement control
  */
@@ -559,7 +618,9 @@ static int snd_sti_clk_adjustment_get(struct snd_kcontrol *kcontrol,
        struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
        struct uniperif *player = priv->dai_data.uni;
 
+       mutex_lock(&player->ctrl_lock);
        ucontrol->value.integer.value[0] = player->clk_adj;
+       mutex_unlock(&player->ctrl_lock);
 
        return 0;
 }
@@ -594,7 +655,12 @@ static struct snd_kcontrol_new uni_player_clk_adj_ctl = {
        .put = snd_sti_clk_adjustment_put,
 };
 
-static struct snd_kcontrol_new *snd_sti_ctl[] = {
+static struct snd_kcontrol_new *snd_sti_pcm_ctl[] = {
+       &uni_player_clk_adj_ctl,
+};
+
+static struct snd_kcontrol_new *snd_sti_iec_ctl[] = {
+       &uni_player_iec958_ctl,
        &uni_player_clk_adj_ctl,
 };
 
@@ -956,7 +1022,7 @@ static int uni_player_parse_dt(struct platform_device *pdev,
        return 0;
 }
 
-const struct snd_soc_dai_ops uni_player_dai_ops = {
+static const struct snd_soc_dai_ops uni_player_dai_ops = {
                .startup = uni_player_startup,
                .shutdown = uni_player_shutdown,
                .prepare = uni_player_prepare,
@@ -1031,10 +1097,13 @@ int uni_player_init(struct platform_device *pdev,
                player->stream_settings.iec958.status[4] =
                                        IEC958_AES4_CON_MAX_WORDLEN_24 |
                                        IEC958_AES4_CON_WORDLEN_24_20;
-       }
 
-       player->num_ctrls = ARRAY_SIZE(snd_sti_ctl);
-       player->snd_ctrls = snd_sti_ctl[0];
+               player->num_ctrls = ARRAY_SIZE(snd_sti_iec_ctl);
+               player->snd_ctrls = snd_sti_iec_ctl[0];
+       } else {
+               player->num_ctrls = ARRAY_SIZE(snd_sti_pcm_ctl);
+               player->snd_ctrls = snd_sti_pcm_ctl[0];
+       }
 
        return 0;
 }