rk2928: acodec: move audio codec platform device registration to board file to config...

[firefly-linux-kernel-4.4.55.git] / sound / soc / codecs / rk2928_codec.c

diff --git a/sound/soc/codecs/rk2928_codec.c b/sound/soc/codecs/rk2928_codec.c
index 57086b8ec23727576ec6b45e392d461675b58d82..a31276077b7dd1752a2979af34f3dbf9177393a7 100755 (executable)
--- a/sound/soc/codecs/rk2928_codec.c
+++ b/sound/soc/codecs/rk2928_codec.c
@@ -37,15 +37,18 @@
 #include <sound/initval.h>
 #include <sound/tlv.h>
 
+#include <mach/iomux.h>
+
 #include "rk2928_codec.h"
 
 static struct rk2928_codec_data {
        struct device   *dev;
-       struct clk              *hclk;
        int                     regbase;
        int                             regbase_phy;
        int                             regsize_phy;
-       int     mute;
+       int                             mute;
+       int                             hdmi_enable;
+       int                             spkctl;
 } rk2928_data;
 
 static const struct snd_soc_dapm_widget rk2928_dapm_widgets[] = {
@@ -64,28 +67,24 @@ static const struct snd_soc_dapm_widget rk2928_dapm_widgets[] = {
 };
 
 static const struct snd_soc_dapm_route rk2928_audio_map[] = {
-       {"DACL Drv", "DACL Amp", "DACL"},
-       {"DACR Drv", "DACR Amp", "DACR"},
-       {"SPKL", NULL, "DACL Drv"},
-       {"SPKR", NULL, "DACR Drv"},
+       {"SPKL", "DACL Amp", "DACL"},
+       {"SPKR", "DACR Amp", "DACR"},
+//     {"SPKL", NULL, "DACL Drv"},
+//     {"SPKR", NULL, "DACR Drv"},
        {"ADCL", NULL, "MICL"},
        {"ADCR", NULL, "MICR"},
 };
 
-void codec_set_spk(bool on)
-{
-       
-}
 
 static unsigned int rk2928_read(struct snd_soc_codec *codec, unsigned int reg)
 {      
-       return readl(rk2928_data.regbase + reg);
+       return readl(rk2928_data.regbase + reg*4);
 }
 
 static int rk2928_write(struct snd_soc_codec *codec, unsigned int reg, unsigned int value)
 {
        DBG("%s reg 0x%02x value 0x%02x", __FUNCTION__, reg, value);
-       writel(value, rk2928_data.regbase + reg);
+       writel(value, rk2928_data.regbase + reg*4);
        return 0;
 }
 
@@ -101,6 +100,22 @@ static int rk2928_write_mask(struct snd_soc_codec *codec, unsigned int reg,
        return rk2928_write(codec, reg, regvalue);
 }
 
+void codec_set_spk(bool on)
+{
+       if(on == 0) {
+               DBG("%s speaker is disabled\n", __FUNCTION__);
+               rk2928_data.hdmi_enable = 1;
+               if(rk2928_data.mute = 0)
+                       rk2928_write(NULL, CODEC_REG_DAC_MUTE, v_MUTE_DAC(1));
+       }
+       else {
+               DBG("%s speaker is enabled\n", __FUNCTION__);
+               rk2928_data.hdmi_enable = 0;
+               if(rk2928_data.mute = 0)
+                       rk2928_write(NULL, CODEC_REG_DAC_MUTE, v_MUTE_DAC(0));
+       }
+}
+
 static int rk2928_audio_hw_params(struct snd_pcm_substream *substream,
                                    struct snd_pcm_hw_params *params,
                                    struct snd_soc_dai *dai)
@@ -117,9 +132,9 @@ static int rk2928_audio_hw_params(struct snd_pcm_substream *substream,
 static int rk2928_audio_trigger(struct snd_pcm_substream *substream, int cmd,
                                struct snd_soc_dai *dai)
 {
-//     struct snd_soc_pcm_runtime *rtd = substream->private_data;
-//     struct snd_soc_codec *codec = rtd->codec;
-//     struct rk2928_codec_data *priv = snd_soc_codec_get_drvdata(codec);
+       struct snd_soc_pcm_runtime *rtd = substream->private_data;
+       struct snd_soc_codec *codec = rtd->codec;
+       struct rk2928_codec_data *priv = snd_soc_codec_get_drvdata(codec);
        int err = 0;
 
        DBG("%s cmd 0x%x", __FUNCTION__, cmd);
@@ -128,10 +143,31 @@ static int rk2928_audio_trigger(struct snd_pcm_substream *substream, int cmd,
                case SNDRV_PCM_TRIGGER_START:
                case SNDRV_PCM_TRIGGER_RESUME:
                case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
+                       if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
+//                             rk2928_write(codec, CODEC_REG_DAC_GAIN, v_GAIN_DAC(DAC_GAIN_3DB_P));
+                               if(!rk2928_data.hdmi_enable)
+                                       rk2928_write(codec, CODEC_REG_DAC_MUTE, v_MUTE_DAC(0));
+                               rk2928_data.mute = 0;
+                               if(rk2928_data.spkctl != INVALID_GPIO) {
+                                       gpio_direction_output(rk2928_data.spkctl, GPIO_HIGH);
+                               }
+                       }
+                       else {
+                               rk2928_write(codec, CODEC_REG_ADC_PGA_GAIN, 0xFF);
+//                             rk2928_write(codec, 0x08, 0xff);
+//                             rk2928_write(codec, 0x09, 0x07);
+                       }
                        break;
                case SNDRV_PCM_TRIGGER_STOP:
                case SNDRV_PCM_TRIGGER_SUSPEND:
                case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
+                       if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
+                               if(rk2928_data.spkctl != INVALID_GPIO) {
+                                       gpio_direction_output(rk2928_data.spkctl, GPIO_LOW);
+                               }
+                               rk2928_write(codec, CODEC_REG_DAC_MUTE, v_MUTE_DAC(1));
+                               rk2928_data.mute = 1;
+                       }
                        break;
                default:
                        err = -EINVAL;
@@ -210,14 +246,34 @@ static int rk2928_probe(struct snd_soc_codec *codec)
                goto err1;
        }
        
+       res = platform_get_resource(pdev, IORESOURCE_IO, 0);
+       if(!res) {
+               rk2928_data.spkctl = INVALID_GPIO;
+       }
+       else {
+               rk2928_data.spkctl = res->start;
+       }
+       
+       if(rk2928_data.spkctl != INVALID_GPIO) {
+               ret = gpio_request(rk2928_data.spkctl, NULL);
+               if (ret != 0) {
+                       gpio_free(rk2928_data.spkctl);
+               }
+               else
+                       gpio_direction_output(rk2928_data.spkctl, GPIO_LOW);
+       }
+       
+       // Select SDI input from internal audio codec
+       writel(0x04000400, RK2928_GRF_BASE + GRF_SOC_CON0);
+       
+       // Mute and Power off codec
        rk2928_write(codec, CODEC_REG_DAC_MUTE, v_MUTE_DAC(1));
-       rk2928_write(codec, CODEC_REG_DAC_GAIN, v_GAIN_DAC(DAC_GAIN_3DB_P));
        rk2928_set_bias_level(codec, SND_SOC_BIAS_OFF);
        
        snd_soc_dapm_new_controls(dapm, rk2928_dapm_widgets,
                        ARRAY_SIZE(rk2928_dapm_widgets));
        snd_soc_dapm_add_routes(dapm, rk2928_audio_map, ARRAY_SIZE(rk2928_audio_map));
-       
+
        return 0;
        
 err1: