1 files changed, 116 insertions, 1 deletions

diff --git a/drivers/gpu/drm/msm/hdmi/hdmi.c b/drivers/gpu/drm/msm/hdmi/hdmi.c
index 51b9ea552f97..973720792236 100644
--- a/drivers/gpu/drm/msm/hdmi/hdmi.c
+++ b/drivers/gpu/drm/msm/hdmi/hdmi.c
@@ -19,6 +19,7 @@
 #include <linux/of_irq.h>
 #include <linux/of_gpio.h>
 
+#include <sound/hdmi-codec.h>
 #include "hdmi.h"
 
 void msm_hdmi_set_mode(struct hdmi *hdmi, bool power_on)
@@ -434,6 +435,111 @@ static int msm_hdmi_get_gpio(struct device_node *of_node, const char *name)
         return gpio;
 }
 
+/*
+ * HDMI audio codec callbacks
+ */
+static int msm_hdmi_audio_hw_params(struct device *dev, void *data,
+                                    struct hdmi_codec_daifmt *daifmt,
+                                    struct hdmi_codec_params *params)
+{
+        struct hdmi *hdmi = dev_get_drvdata(dev);
+        unsigned int chan;
+        unsigned int channel_allocation = 0;
+        unsigned int rate;
+        unsigned int level_shift  = 0; /* 0dB */
+        bool down_mix = false;
+
+        dev_dbg(dev, "%u Hz, %d bit, %d channels\n", params->sample_rate,
+                 params->sample_width, params->cea.channels);
+
+        switch (params->cea.channels) {
+        case 2:
+                /* FR and FL speakers */
+                channel_allocation  = 0;
+                chan = MSM_HDMI_AUDIO_CHANNEL_2;
+                break;
+        case 4:
+                /* FC, LFE, FR and FL speakers */
+                channel_allocation  = 0x3;
+                chan = MSM_HDMI_AUDIO_CHANNEL_4;
+                break;
+        case 6:
+                /* RR, RL, FC, LFE, FR and FL speakers */
+                channel_allocation  = 0x0B;
+                chan = MSM_HDMI_AUDIO_CHANNEL_6;
+                break;
+        case 8:
+                /* FRC, FLC, RR, RL, FC, LFE, FR and FL speakers */
+                channel_allocation  = 0x1F;
+                chan = MSM_HDMI_AUDIO_CHANNEL_8;
+                break;
+        default:
+                return -EINVAL;
+        }
+
+        switch (params->sample_rate) {
+        case 32000:
+                rate = HDMI_SAMPLE_RATE_32KHZ;
+                break;
+        case 44100:
+                rate = HDMI_SAMPLE_RATE_44_1KHZ;
+                break;
+        case 48000:
+                rate = HDMI_SAMPLE_RATE_48KHZ;
+                break;
+        case 88200:
+                rate = HDMI_SAMPLE_RATE_88_2KHZ;
+                break;
+        case 96000:
+                rate = HDMI_SAMPLE_RATE_96KHZ;
+                break;
+        case 176400:
+                rate = HDMI_SAMPLE_RATE_176_4KHZ;
+                break;
+        case 192000:
+                rate = HDMI_SAMPLE_RATE_192KHZ;
+                break;
+        default:
+                dev_err(dev, "rate[%d] not supported!\n",
+                        params->sample_rate);
+                return -EINVAL;
+        }
+
+        msm_hdmi_audio_set_sample_rate(hdmi, rate);
+        msm_hdmi_audio_info_setup(hdmi, 1, chan, channel_allocation,
+                              level_shift, down_mix);
+
+        return 0;
+}
+
+static void msm_hdmi_audio_shutdown(struct device *dev, void *data)
+{
+        struct hdmi *hdmi = dev_get_drvdata(dev);
+
+        msm_hdmi_audio_info_setup(hdmi, 0, 0, 0, 0, 0);
+}
+
+static const struct hdmi_codec_ops msm_hdmi_audio_codec_ops = {
+        .hw_params = msm_hdmi_audio_hw_params,
+        .audio_shutdown = msm_hdmi_audio_shutdown,
+};
+
+static struct hdmi_codec_pdata codec_data = {
+        .ops = &msm_hdmi_audio_codec_ops,
+        .max_i2s_channels = 8,
+        .i2s = 1,
+};
+
+static int msm_hdmi_register_audio_driver(struct hdmi *hdmi, struct device *dev)
+{
+        hdmi->audio_pdev = platform_device_register_data(dev,
+                                                         HDMI_CODEC_DRV_NAME,
+                                                         PLATFORM_DEVID_AUTO,
+                                                         &codec_data,
+                                                         sizeof(codec_data));
+        return PTR_ERR_OR_ZERO(hdmi->audio_pdev);
+}
+
 static int msm_hdmi_bind(struct device *dev, struct device *master, void *data)
 {
         struct drm_device *drm = dev_get_drvdata(master);
@@ -441,7 +547,7 @@ static int msm_hdmi_bind(struct device *dev, struct device *master, void *data)
         static struct hdmi_platform_config *hdmi_cfg;
         struct hdmi *hdmi;
         struct device_node *of_node = dev->of_node;
-        int i;
+        int i, err;
 
         hdmi_cfg = (struct hdmi_platform_config *)
                         of_device_get_match_data(dev);
@@ -468,6 +574,12 @@ static int msm_hdmi_bind(struct device *dev, struct device *master, void *data)
                 return PTR_ERR(hdmi);
         priv->hdmi = hdmi;
 
+        err = msm_hdmi_register_audio_driver(hdmi, dev);
+        if (err) {
+                DRM_ERROR("Failed to attach an audio codec %d\n", err);
+                hdmi->audio_pdev = NULL;
+        }
+
         return 0;
 }
 
@@ -477,6 +589,9 @@ static void msm_hdmi_unbind(struct device *dev, struct device *master,
         struct drm_device *drm = dev_get_drvdata(master);
         struct msm_drm_private *priv = drm->dev_private;
         if (priv->hdmi) {
+                if (priv->hdmi->audio_pdev)
+                        platform_device_unregister(priv->hdmi->audio_pdev);
+
                 msm_hdmi_destroy(priv->hdmi);
                 priv->hdmi = NULL;
         }