[PATCH 1/3] drm/rockchip: inno_hdmi: add audio support

Yakir Yang ykk at rock-chips.com
Wed Aug 3 19:11:53 PDT 2016


Mark,


Got it, would rebase soonest :-)


Thanks,
- Yakir

On 08/04/2016 10:01 AM, Mark yao wrote:
> Hi Yakir
>
> After apply your patch, I got following warning messge:
>
> drivers/gpu/drm/rockchip/inno_hdmi.c:818:2: warning: initialization 
> from incompatible pointer type [enabled by default]
> drivers/gpu/drm/rockchip/inno_hdmi.c:818:2: warning: (near 
> initialization for 'audio_codec_ops.hw_params') [enabled by default]
> drivers/gpu/drm/rockchip/inno_hdmi.c:819:2: warning: initialization 
> from incompatible pointer type [enabled by default]
> drivers/gpu/drm/rockchip/inno_hdmi.c:819:2: warning: (near 
> initialization for 'audio_codec_ops.audio_shutdown') [enabled by default]
> drivers/gpu/drm/rockchip/inno_hdmi.c:820:2: warning: initialization 
> from incompatible pointer type [enabled by default]
> drivers/gpu/drm/rockchip/inno_hdmi.c:820:2: warning: (near 
> initialization for 'audio_codec_ops.digital_mute') [enabled by default]
> drivers/gpu/drm/rockchip/inno_hdmi.c:821:2: warning: initialization 
> from incompatible pointer type [enabled by default]
> drivers/gpu/drm/rockchip/inno_hdmi.c:821:2: warning: (near 
> initialization for 'audio_codec_ops.get_eld') [enabled by default]
>
> since the commit "efc9194 ASoC: hdmi-codec: callback function will be 
> called with private data",
> the hdmi_codec_ops had some changes.
> Can you rebase your patch to the newest kernel?
>
> Thanks.
> On 2016年06月15日 21:28, Yakir Yang wrote:
>> Using the common hdmi-codec driver to support hdmi audio function.
>>
>> Signed-off-by: Yakir Yang <ykk at rock-chips.com>
>> ---
>>   drivers/gpu/drm/rockchip/inno_hdmi.c | 237 
>> ++++++++++++++++++++++++++++++++++-
>>   drivers/gpu/drm/rockchip/inno_hdmi.h |   2 +
>>   2 files changed, 237 insertions(+), 2 deletions(-)
>>
>> diff --git a/drivers/gpu/drm/rockchip/inno_hdmi.c 
>> b/drivers/gpu/drm/rockchip/inno_hdmi.c
>> index f8b4feb..c31dc07 100644
>> --- a/drivers/gpu/drm/rockchip/inno_hdmi.c
>> +++ b/drivers/gpu/drm/rockchip/inno_hdmi.c
>> @@ -29,6 +29,8 @@
>>   #include <drm/drm_crtc_helper.h>
>>   #include <drm/drm_edid.h>
>>   +#include <sound/hdmi-codec.h>
>> +
>>   #include "rockchip_drm_drv.h"
>>   #include "rockchip_drm_vop.h"
>>   @@ -36,6 +38,12 @@
>>     #define to_inno_hdmi(x)    container_of(x, struct inno_hdmi, x)
>>   +struct audio_info {
>> +    int sample_rate;
>> +    int channels;
>> +    int sample_width;
>> +};
>> +
>>   struct hdmi_data_info {
>>       int vic;
>>       bool sink_is_hdmi;
>> @@ -71,6 +79,9 @@ struct inno_hdmi {
>>         unsigned int tmds_rate;
>>   +    struct platform_device *audio_pdev;
>> +    bool audio_enable;
>> +
>>       struct hdmi_data_info    hdmi_data;
>>       struct drm_display_mode previous_mode;
>>   };
>> @@ -306,6 +317,57 @@ static int inno_hdmi_config_video_avi(struct 
>> inno_hdmi *hdmi,
>>       return inno_hdmi_upload_frame(hdmi, rc, &frame, INFOFRAME_AVI, 
>> 0, 0, 0);
>>   }
>>   +static int inno_hdmi_config_audio_aai(struct inno_hdmi *hdmi,
>> +                      struct audio_info *audio)
>> +{
>> +    struct hdmi_audio_infoframe *faudio;
>> +    union hdmi_infoframe frame;
>> +    int rc;
>> +
>> +    rc = hdmi_audio_infoframe_init(&frame.audio);
>> +    faudio = (struct hdmi_audio_infoframe *)&frame;
>> +
>> +    faudio->channels = audio->channels;
>> +
>> +    switch (audio->sample_width) {
>> +    case 16:
>> +        faudio->sample_size = HDMI_AUDIO_SAMPLE_SIZE_16;
>> +        break;
>> +    case 20:
>> +        faudio->sample_size = HDMI_AUDIO_SAMPLE_SIZE_20;
>> +        break;
>> +    case 24:
>> +        faudio->sample_size = HDMI_AUDIO_SAMPLE_SIZE_24;
>> +        break;
>> +    }
>> +
>> +    switch (audio->sample_rate) {
>> +    case 32000:
>> +        faudio->sample_frequency = HDMI_AUDIO_SAMPLE_FREQUENCY_32000;
>> +        break;
>> +    case 44100:
>> +        faudio->sample_frequency = HDMI_AUDIO_SAMPLE_FREQUENCY_44100;
>> +        break;
>> +    case 48000:
>> +        faudio->sample_frequency = HDMI_AUDIO_SAMPLE_FREQUENCY_48000;
>> +        break;
>> +    case 88200:
>> +        faudio->sample_frequency = HDMI_AUDIO_SAMPLE_FREQUENCY_88200;
>> +        break;
>> +    case 96000:
>> +        faudio->sample_frequency = HDMI_AUDIO_SAMPLE_FREQUENCY_96000;
>> +        break;
>> +    case 176400:
>> +        faudio->sample_frequency = HDMI_AUDIO_SAMPLE_FREQUENCY_176400;
>> +        break;
>> +    case 192000:
>> +        faudio->sample_frequency = HDMI_AUDIO_SAMPLE_FREQUENCY_192000;
>> +        break;
>> +    }
>> +
>> +    return inno_hdmi_upload_frame(hdmi, rc, &frame, INFOFRAME_AAI, 
>> 0, 0, 0);
>> +}
>> +
>>   static int inno_hdmi_config_video_csc(struct inno_hdmi *hdmi)
>>   {
>>       struct hdmi_data_info *data = &hdmi->hdmi_data;
>> @@ -478,8 +540,9 @@ static int inno_hdmi_setup(struct inno_hdmi *hdmi,
>>       inno_hdmi_i2c_init(hdmi);
>>         /* Unmute video and audio output */
>> -    hdmi_modb(hdmi, HDMI_AV_MUTE, m_AUDIO_MUTE | m_VIDEO_BLACK,
>> -          v_AUDIO_MUTE(0) | v_VIDEO_MUTE(0));
>> +    hdmi_modb(hdmi, HDMI_AV_MUTE, m_VIDEO_BLACK, v_VIDEO_MUTE(0));
>> +    if (hdmi->audio_enable)
>> +        hdmi_modb(hdmi, HDMI_AV_MUTE, m_AUDIO_MUTE, v_AUDIO_MUTE(0));
>>         return 0;
>>   }
>> @@ -616,6 +679,174 @@ static struct drm_connector_helper_funcs 
>> inno_hdmi_connector_helper_funcs = {
>>       .best_encoder = inno_hdmi_connector_best_encoder,
>>   };
>>   +int inno_hdmi_audio_config_set(struct inno_hdmi *hdmi, struct 
>> audio_info *audio)
>> +{
>> +    int rate, N, channel;
>> +
>> +    if (audio->channels < 3)
>> +        channel = I2S_CHANNEL_1_2;
>> +    else if (audio->channels < 5)
>> +        channel = I2S_CHANNEL_3_4;
>> +    else if (audio->channels < 7)
>> +        channel = I2S_CHANNEL_5_6;
>> +    else
>> +        channel = I2S_CHANNEL_7_8;
>> +
>> +    switch (audio->sample_rate) {
>> +    case 32000:
>> +        rate = AUDIO_32K;
>> +        N = N_32K;
>> +        break;
>> +    case 44100:
>> +        rate = AUDIO_441K;
>> +        N = N_441K;
>> +        break;
>> +    case 48000:
>> +        rate = AUDIO_48K;
>> +        N = N_48K;
>> +        break;
>> +    case 88200:
>> +        rate = AUDIO_882K;
>> +        N = N_882K;
>> +        break;
>> +    case 96000:
>> +        rate = AUDIO_96K;
>> +        N = N_96K;
>> +        break;
>> +    case 176400:
>> +        rate = AUDIO_1764K;
>> +        N = N_1764K;
>> +        break;
>> +    case 192000:
>> +        rate = AUDIO_192K;
>> +        N = N_192K;
>> +        break;
>> +    default:
>> +        dev_err(hdmi->dev, "[%s] not support such sample rate %d\n",
>> +            __func__, audio->sample_rate);
>> +        return -ENOENT;
>> +    }
>> +
>> +    /* set_audio source I2S */
>> +    hdmi_writeb(hdmi, HDMI_AUDIO_CTRL1, 0x01);
>> +    hdmi_writeb(hdmi, AUDIO_SAMPLE_RATE, rate);
>> +    hdmi_writeb(hdmi, AUDIO_I2S_MODE, v_I2S_MODE(I2S_STANDARD) |
>> +            v_I2S_CHANNEL(channel));
>> +
>> +    hdmi_writeb(hdmi, AUDIO_I2S_MAP, 0x00);
>> +    hdmi_writeb(hdmi, AUDIO_I2S_SWAPS_SPDIF, 0);
>> +
>> +    /* Set N value */
>> +    hdmi_writeb(hdmi, AUDIO_N_H, (N >> 16) & 0x0F);
>> +    hdmi_writeb(hdmi, AUDIO_N_M, (N >> 8) & 0xFF);
>> +    hdmi_writeb(hdmi, AUDIO_N_L, N & 0xFF);
>> +
>> +    /*Set hdmi nlpcm mode to support hdmi bitstream*/
>> +    hdmi_writeb(hdmi, HDMI_AUDIO_CHANNEL_STATUS, 
>> v_AUDIO_STATUS_NLPCM(0));
>> +
>> +    return inno_hdmi_config_audio_aai(hdmi, audio);
>> +}
>> +
>> +static int inno_hdmi_audio_hw_params(struct device *dev,
>> +                     struct hdmi_codec_daifmt *daifmt,
>> +                     struct hdmi_codec_params *params)
>> +{
>> +    struct inno_hdmi *hdmi = dev_get_drvdata(dev);
>> +    struct audio_info audio = {
>> +        .sample_width = params->sample_width,
>> +        .sample_rate = params->sample_rate,
>> +        .channels = params->channels,
>> +    };
>> +
>> +    if (!hdmi->hdmi_data.sink_has_audio) {
>> +        dev_err(hdmi->dev, "Sink do not support audio!\n");
>> +        return -ENODEV;
>> +    }
>> +
>> +    if (!hdmi->encoder.crtc)
>> +        return -ENODEV;
>> +
>> +    switch (daifmt->fmt) {
>> +    case HDMI_I2S:
>> +        break;
>> +    default:
>> +        dev_err(dev, "%s: Invalid format %d\n", __func__, daifmt->fmt);
>> +        return -EINVAL;
>> +    }
>> +
>> +    return inno_hdmi_audio_config_set(hdmi, &audio);
>> +}
>> +
>> +static void inno_hdmi_audio_shutdown(struct device *dev)
>> +{
>> +    /* do nothing */
>> +}
>> +
>> +static int inno_hdmi_audio_digital_mute(struct device *dev, bool mute)
>> +{
>> +    struct inno_hdmi *hdmi = dev_get_drvdata(dev);
>> +
>> +    if (!hdmi->hdmi_data.sink_has_audio) {
>> +        dev_err(hdmi->dev, "Sink do not support audio!\n");
>> +        return -ENODEV;
>> +    }
>> +
>> +    hdmi->audio_enable = !mute;
>> +
>> +    if (mute)
>> +        hdmi_modb(hdmi, HDMI_AV_MUTE, m_AUDIO_MUTE | m_AUDIO_PD,
>> +              v_AUDIO_MUTE(1) | v_AUDIO_PD(1));
>> +    else
>> +        hdmi_modb(hdmi, HDMI_AV_MUTE, m_AUDIO_MUTE | m_AUDIO_PD,
>> +              v_AUDIO_MUTE(0) | v_AUDIO_PD(0));
>> +
>> +    return 0;
>> +}
>> +
>> +static int inno_hdmi_audio_get_eld(struct device *dev, uint8_t *buf, 
>> size_t len)
>> +{
>> +    struct inno_hdmi *hdmi = dev_get_drvdata(dev);
>> +    struct drm_mode_config *config = &hdmi->encoder.dev->mode_config;
>> +    struct drm_connector *connector;
>> +    int ret = -ENODEV;
>> +
>> +    mutex_lock(&config->mutex);
>> +    list_for_each_entry(connector, &config->connector_list, head) {
>> +        if (&hdmi->encoder == connector->encoder) {
>> +            memcpy(buf, connector->eld,
>> +                   min(sizeof(connector->eld), len));
>> +            ret = 0;
>> +        }
>> +    }
>> +    mutex_unlock(&config->mutex);
>> +
>> +    return ret;
>> +}
>> +
>> +static const struct hdmi_codec_ops audio_codec_ops = {
>> +    .hw_params = inno_hdmi_audio_hw_params,
>> +    .audio_shutdown = inno_hdmi_audio_shutdown,
>> +    .digital_mute = inno_hdmi_audio_digital_mute,
>> +    .get_eld = inno_hdmi_audio_get_eld,
>> +};
>> +
>> +static int inno_hdmi_audio_codec_init(struct inno_hdmi *hdmi,
>> +                      struct device *dev)
>> +{
>> +    struct hdmi_codec_pdata codec_data = {
>> +        .i2s = 1,
>> +        .ops = &audio_codec_ops,
>> +        .max_i2s_channels = 8,
>> +    };
>> +
>> +    hdmi->audio_enable = false;
>> +    hdmi->audio_pdev = platform_device_register_data(
>> +                dev, HDMI_CODEC_DRV_NAME, PLATFORM_DEVID_NONE,
>> +                &codec_data, sizeof(codec_data));
>> +
>> +    return PTR_ERR_OR_ZERO(hdmi->audio_pdev);
>> +}
>> +
>>   static int inno_hdmi_register(struct drm_device *drm, struct 
>> inno_hdmi *hdmi)
>>   {
>>       struct drm_encoder *encoder = &hdmi->encoder;
>> @@ -645,6 +876,8 @@ static int inno_hdmi_register(struct drm_device 
>> *drm, struct inno_hdmi *hdmi)
>> drm_mode_connector_attach_encoder(&hdmi->connector, encoder);
>>   +    inno_hdmi_audio_codec_init(hdmi, dev);
>> +
>>       return 0;
>>   }
>>   diff --git a/drivers/gpu/drm/rockchip/inno_hdmi.h 
>> b/drivers/gpu/drm/rockchip/inno_hdmi.h
>> index aa7c415..8b23037 100644
>> --- a/drivers/gpu/drm/rockchip/inno_hdmi.h
>> +++ b/drivers/gpu/drm/rockchip/inno_hdmi.h
>> @@ -104,11 +104,13 @@ enum {
>>   #define HDMI_AV_MUTE            0x05
>>   #define m_AVMUTE_CLEAR            (1 << 7)
>>   #define m_AVMUTE_ENABLE            (1 << 6)
>> +#define m_AUDIO_PD            (1 << 2)
>>   #define m_AUDIO_MUTE            (1 << 1)
>>   #define m_VIDEO_BLACK            (1 << 0)
>>   #define v_AVMUTE_CLEAR(n)        (n << 7)
>>   #define v_AVMUTE_ENABLE(n)        (n << 6)
>>   #define v_AUDIO_MUTE(n)            (n << 1)
>> +#define v_AUDIO_PD(n)            (n << 2)
>>   #define v_VIDEO_MUTE(n)            (n << 0)
>>     #define HDMI_VIDEO_TIMING_CTL        0x08
>
>





More information about the Linux-rockchip mailing list