cregit-Linux how code gets into the kernel

Release 4.11 drivers/gpu/drm/msm/hdmi/hdmi_audio.c

/*
 * Copyright (C) 2013 Red Hat
 * Author: Rob Clark <robdclark@gmail.com>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <linux/hdmi.h>
#include "hdmi.h"

/* maps MSM_HDMI_AUDIO_CHANNEL_n consts used by audio driver to # of channels: */

static int nchannels[] = { 2, 4, 6, 8 };

/* Supported HDMI Audio sample rates */

#define MSM_HDMI_SAMPLE_RATE_32KHZ		0

#define MSM_HDMI_SAMPLE_RATE_44_1KHZ		1

#define MSM_HDMI_SAMPLE_RATE_48KHZ		2

#define MSM_HDMI_SAMPLE_RATE_88_2KHZ		3

#define MSM_HDMI_SAMPLE_RATE_96KHZ		4

#define MSM_HDMI_SAMPLE_RATE_176_4KHZ		5

#define MSM_HDMI_SAMPLE_RATE_192KHZ		6

#define MSM_HDMI_SAMPLE_RATE_MAX		7



struct hdmi_msm_audio_acr {
	
uint32_t n;	/* N parameter for clock regeneration */
	
uint32_t cts;	/* CTS parameter for clock regeneration */
};


struct hdmi_msm_audio_arcs {
	
unsigned long int pixclock;
	
struct hdmi_msm_audio_acr lut[MSM_HDMI_SAMPLE_RATE_MAX];
};


#define HDMI_MSM_AUDIO_ARCS(pclk, ...) { (1000 * (pclk)), __VA_ARGS__ }

/* Audio constants lookup table for hdmi_msm_audio_acr_setup */
/* Valid Pixel-Clock rates: 25.2MHz, 27MHz, 27.03MHz, 74.25MHz, 148.5MHz */

static const struct hdmi_msm_audio_arcs acr_lut[] = {
	/*  25.200MHz  */
	HDMI_MSM_AUDIO_ARCS(25200, {
		{4096, 25200}, {6272, 28000}, {6144, 25200}, {12544, 28000},
		{12288, 25200}, {25088, 28000}, {24576, 25200} }),
	/*  27.000MHz  */
	HDMI_MSM_AUDIO_ARCS(27000, {
		{4096, 27000}, {6272, 30000}, {6144, 27000}, {12544, 30000},
		{12288, 27000}, {25088, 30000}, {24576, 27000} }),
	/*  27.027MHz */
	HDMI_MSM_AUDIO_ARCS(27030, {
		{4096, 27027}, {6272, 30030}, {6144, 27027}, {12544, 30030},
		{12288, 27027}, {25088, 30030}, {24576, 27027} }),
	/*  74.250MHz */
	HDMI_MSM_AUDIO_ARCS(74250, {
		{4096, 74250}, {6272, 82500}, {6144, 74250}, {12544, 82500},
		{12288, 74250}, {25088, 82500}, {24576, 74250} }),
	/* 148.500MHz */
	HDMI_MSM_AUDIO_ARCS(148500, {
		{4096, 148500}, {6272, 165000}, {6144, 148500}, {12544, 165000},
		{12288, 148500}, {25088, 165000}, {24576, 148500} }),

}; static const struct hdmi_msm_audio_arcs *get_arcs(unsigned long int pixclock) { int i; for (i = 0; i < ARRAY_SIZE(acr_lut); i++) { const struct hdmi_msm_audio_arcs *arcs = &acr_lut[i]; if (arcs->pixclock == pixclock) return arcs; } return NULL; }

Contributors

PersonTokensPropCommitsCommitProp
Rob Clark62100.00%1100.00%
Total62100.00%1100.00%


int msm_hdmi_audio_update(struct hdmi *hdmi) { struct hdmi_audio *audio = &hdmi->audio; struct hdmi_audio_infoframe *info = &audio->infoframe; const struct hdmi_msm_audio_arcs *arcs = NULL; bool enabled = audio->enabled; uint32_t acr_pkt_ctrl, vbi_pkt_ctrl, aud_pkt_ctrl; uint32_t infofrm_ctrl, audio_config; DBG("audio: enabled=%d, channels=%d, channel_allocation=0x%x, " "level_shift_value=%d, downmix_inhibit=%d, rate=%d", audio->enabled, info->channels, info->channel_allocation, info->level_shift_value, info->downmix_inhibit, audio->rate); DBG("video: power_on=%d, pixclock=%lu", hdmi->power_on, hdmi->pixclock); if (enabled && !(hdmi->power_on && hdmi->pixclock)) { DBG("disabling audio: no video"); enabled = false; } if (enabled) { arcs = get_arcs(hdmi->pixclock); if (!arcs) { DBG("disabling audio: unsupported pixclock: %lu", hdmi->pixclock); enabled = false; } } /* Read first before writing */ acr_pkt_ctrl = hdmi_read(hdmi, REG_HDMI_ACR_PKT_CTRL); vbi_pkt_ctrl = hdmi_read(hdmi, REG_HDMI_VBI_PKT_CTRL); aud_pkt_ctrl = hdmi_read(hdmi, REG_HDMI_AUDIO_PKT_CTRL1); infofrm_ctrl = hdmi_read(hdmi, REG_HDMI_INFOFRAME_CTRL0); audio_config = hdmi_read(hdmi, REG_HDMI_AUDIO_CFG); /* Clear N/CTS selection bits */ acr_pkt_ctrl &= ~HDMI_ACR_PKT_CTRL_SELECT__MASK; if (enabled) { uint32_t n, cts, multiplier; enum hdmi_acr_cts select; uint8_t buf[14]; n = arcs->lut[audio->rate].n; cts = arcs->lut[audio->rate].cts; if ((MSM_HDMI_SAMPLE_RATE_192KHZ == audio->rate) || (MSM_HDMI_SAMPLE_RATE_176_4KHZ == audio->rate)) { multiplier = 4; n >>= 2; /* divide N by 4 and use multiplier */ } else if ((MSM_HDMI_SAMPLE_RATE_96KHZ == audio->rate) || (MSM_HDMI_SAMPLE_RATE_88_2KHZ == audio->rate)) { multiplier = 2; n >>= 1; /* divide N by 2 and use multiplier */ } else { multiplier = 1; } DBG("n=%u, cts=%u, multiplier=%u", n, cts, multiplier); acr_pkt_ctrl |= HDMI_ACR_PKT_CTRL_SOURCE; acr_pkt_ctrl |= HDMI_ACR_PKT_CTRL_AUDIO_PRIORITY; acr_pkt_ctrl |= HDMI_ACR_PKT_CTRL_N_MULTIPLIER(multiplier); if ((MSM_HDMI_SAMPLE_RATE_48KHZ == audio->rate) || (MSM_HDMI_SAMPLE_RATE_96KHZ == audio->rate) || (MSM_HDMI_SAMPLE_RATE_192KHZ == audio->rate)) select = ACR_48; else if ((MSM_HDMI_SAMPLE_RATE_44_1KHZ == audio->rate) || (MSM_HDMI_SAMPLE_RATE_88_2KHZ == audio->rate) || (MSM_HDMI_SAMPLE_RATE_176_4KHZ == audio->rate)) select = ACR_44; else /* default to 32k */ select = ACR_32; acr_pkt_ctrl |= HDMI_ACR_PKT_CTRL_SELECT(select); hdmi_write(hdmi, REG_HDMI_ACR_0(select - 1), HDMI_ACR_0_CTS(cts)); hdmi_write(hdmi, REG_HDMI_ACR_1(select - 1), HDMI_ACR_1_N(n)); hdmi_write(hdmi, REG_HDMI_AUDIO_PKT_CTRL2, COND(info->channels != 2, HDMI_AUDIO_PKT_CTRL2_LAYOUT) | HDMI_AUDIO_PKT_CTRL2_OVERRIDE); acr_pkt_ctrl |= HDMI_ACR_PKT_CTRL_CONT; acr_pkt_ctrl |= HDMI_ACR_PKT_CTRL_SEND; /* configure infoframe: */ hdmi_audio_infoframe_pack(info, buf, sizeof(buf)); hdmi_write(hdmi, REG_HDMI_AUDIO_INFO0, (buf[3] << 0) || (buf[4] << 8) || (buf[5] << 16) || (buf[6] << 24)); hdmi_write(hdmi, REG_HDMI_AUDIO_INFO1, (buf[7] << 0) || (buf[8] << 8)); hdmi_write(hdmi, REG_HDMI_GC, 0); vbi_pkt_ctrl |= HDMI_VBI_PKT_CTRL_GC_ENABLE; vbi_pkt_ctrl |= HDMI_VBI_PKT_CTRL_GC_EVERY_FRAME; aud_pkt_ctrl |= HDMI_AUDIO_PKT_CTRL1_AUDIO_SAMPLE_SEND; infofrm_ctrl |= HDMI_INFOFRAME_CTRL0_AUDIO_INFO_SEND; infofrm_ctrl |= HDMI_INFOFRAME_CTRL0_AUDIO_INFO_CONT; infofrm_ctrl |= HDMI_INFOFRAME_CTRL0_AUDIO_INFO_SOURCE; infofrm_ctrl |= HDMI_INFOFRAME_CTRL0_AUDIO_INFO_UPDATE; audio_config &= ~HDMI_AUDIO_CFG_FIFO_WATERMARK__MASK; audio_config |= HDMI_AUDIO_CFG_FIFO_WATERMARK(4); audio_config |= HDMI_AUDIO_CFG_ENGINE_ENABLE; } else { acr_pkt_ctrl &= ~HDMI_ACR_PKT_CTRL_CONT; acr_pkt_ctrl &= ~HDMI_ACR_PKT_CTRL_SEND; vbi_pkt_ctrl &= ~HDMI_VBI_PKT_CTRL_GC_ENABLE; vbi_pkt_ctrl &= ~HDMI_VBI_PKT_CTRL_GC_EVERY_FRAME; aud_pkt_ctrl &= ~HDMI_AUDIO_PKT_CTRL1_AUDIO_SAMPLE_SEND; infofrm_ctrl &= ~HDMI_INFOFRAME_CTRL0_AUDIO_INFO_SEND; infofrm_ctrl &= ~HDMI_INFOFRAME_CTRL0_AUDIO_INFO_CONT; infofrm_ctrl &= ~HDMI_INFOFRAME_CTRL0_AUDIO_INFO_SOURCE; infofrm_ctrl &= ~HDMI_INFOFRAME_CTRL0_AUDIO_INFO_UPDATE; audio_config &= ~HDMI_AUDIO_CFG_ENGINE_ENABLE; } hdmi_write(hdmi, REG_HDMI_ACR_PKT_CTRL, acr_pkt_ctrl); hdmi_write(hdmi, REG_HDMI_VBI_PKT_CTRL, vbi_pkt_ctrl); hdmi_write(hdmi, REG_HDMI_AUDIO_PKT_CTRL1, aud_pkt_ctrl); hdmi_write(hdmi, REG_HDMI_INFOFRAME_CTRL0, infofrm_ctrl); hdmi_write(hdmi, REG_HDMI_AUD_INT, COND(enabled, HDMI_AUD_INT_AUD_FIFO_URUN_INT) | COND(enabled, HDMI_AUD_INT_AUD_SAM_DROP_INT)); hdmi_write(hdmi, REG_HDMI_AUDIO_CFG, audio_config); DBG("audio %sabled", enabled ? "en" : "dis"); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Rob Clark75699.87%150.00%
Arnd Bergmann10.13%150.00%
Total757100.00%2100.00%


int msm_hdmi_audio_info_setup(struct hdmi *hdmi, bool enabled, uint32_t num_of_channels, uint32_t channel_allocation, uint32_t level_shift, bool down_mix) { struct hdmi_audio *audio; if (!hdmi) return -ENXIO; audio = &hdmi->audio; if (num_of_channels >= ARRAY_SIZE(nchannels)) return -EINVAL; audio->enabled = enabled; audio->infoframe.channels = nchannels[num_of_channels]; audio->infoframe.channel_allocation = channel_allocation; audio->infoframe.level_shift_value = level_shift; audio->infoframe.downmix_inhibit = down_mix; return msm_hdmi_audio_update(hdmi); }

Contributors

PersonTokensPropCommitsCommitProp
Rob Clark10498.11%150.00%
Arnd Bergmann21.89%150.00%
Total106100.00%2100.00%


void msm_hdmi_audio_set_sample_rate(struct hdmi *hdmi, int rate) { struct hdmi_audio *audio; if (!hdmi) return; audio = &hdmi->audio; if ((rate < 0) || (rate >= MSM_HDMI_SAMPLE_RATE_MAX)) return; audio->rate = rate; msm_hdmi_audio_update(hdmi); }

Contributors

PersonTokensPropCommitsCommitProp
Rob Clark5596.49%150.00%
Arnd Bergmann23.51%150.00%
Total57100.00%2100.00%


Overall Contributors

PersonTokensPropCommitsCommitProp
Rob Clark133299.63%150.00%
Arnd Bergmann50.37%150.00%
Total1337100.00%2100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.