return had_read_modify(AUD_CONFIG, data, mask);
}
-static void snd_intelhad_enable_audio_v1(struct snd_pcm_substream *substream,
- u8 enable)
-{
- had_read_modify(AUD_CONFIG, enable, BIT(0));
-}
-
static void snd_intelhad_enable_audio_v2(struct snd_pcm_substream *substream,
u8 enable)
{
had_read_modify_aud_config_v2(substream, enable, BIT(0));
}
-static void snd_intelhad_reset_audio_v1(u8 reset)
-{
- had_write_register(AUD_HDMI_STATUS, reset);
-}
-
static void snd_intelhad_reset_audio_v2(u8 reset)
{
had_write_register(AUD_HDMI_STATUS_v2, reset);
IEC958_AES0_NONAUDIO)>>1;
ch_stat0.status_0_regx.clk_acc = (intelhaddata->aes_bits &
IEC958_AES3_CON_CLOCK)>>4;
- cfg_val.cfg_regx.val_bit = ch_stat0.status_0_regx.lpcm_id;
+ cfg_val.cfg_regx_v2.val_bit = ch_stat0.status_0_regx.lpcm_id;
switch (substream->runtime->rate) {
case AUD_SAMPLE_RATE_32:
return 0;
}
-/**
- * function to initialize audio
- * registers and buffer confgiuration registers
- * This function is called in the prepare callback
- */
-static int snd_intelhad_prog_audio_ctrl_v1(struct snd_pcm_substream *substream,
- struct snd_intelhad *intelhaddata)
-{
- union aud_cfg cfg_val = {.cfg_regval = 0};
- union aud_buf_config buf_cfg = {.buf_cfgval = 0};
- u8 channels;
-
- had_prog_status_reg(substream, intelhaddata);
-
- buf_cfg.buf_cfg_regx.fifo_width = FIFO_THRESHOLD;
- buf_cfg.buf_cfg_regx.aud_delay = 0;
- had_write_register(AUD_BUF_CONFIG, buf_cfg.buf_cfgval);
-
- channels = substream->runtime->channels;
-
- switch (channels) {
- case 1:
- case 2:
- cfg_val.cfg_regx.num_ch = CH_STEREO;
- cfg_val.cfg_regx.layout = LAYOUT0;
- break;
-
- case 3:
- case 4:
- cfg_val.cfg_regx.num_ch = CH_THREE_FOUR;
- cfg_val.cfg_regx.layout = LAYOUT1;
- break;
-
- case 5:
- case 6:
- cfg_val.cfg_regx.num_ch = CH_FIVE_SIX;
- cfg_val.cfg_regx.layout = LAYOUT1;
- break;
-
- case 7:
- case 8:
- cfg_val.cfg_regx.num_ch = CH_SEVEN_EIGHT;
- cfg_val.cfg_regx.layout = LAYOUT1;
- break;
-
- }
-
- cfg_val.cfg_regx.val_bit = 1;
- had_write_register(AUD_CONFIG, cfg_val.cfg_regval);
- return 0;
-}
-
/*
* Compute derived values in channel_allocations[].
*/
return 0;
}
-/**
- * snd_intelhad_prog_dip_v1 - to initialize Data Island Packets registers
- *
- * @substream:substream for which the prepare function is called
- * @intelhaddata:substream private data
- *
- * This function is called in the prepare callback
- */
-static void snd_intelhad_prog_dip_v1(struct snd_pcm_substream *substream,
- struct snd_intelhad *intelhaddata)
-{
- int i;
- union aud_ctrl_st ctrl_state = {.ctrl_val = 0};
- union aud_info_frame2 frame2 = {.fr2_val = 0};
- union aud_info_frame3 frame3 = {.fr3_val = 0};
- u8 checksum = 0;
- int channels;
-
- channels = substream->runtime->channels;
-
- had_write_register(AUD_CNTL_ST, ctrl_state.ctrl_val);
-
- frame2.fr2_regx.chnl_cnt = substream->runtime->channels - 1;
-
- frame3.fr3_regx.chnl_alloc = snd_intelhad_channel_allocation(
- intelhaddata, channels);
-
- /*Calculte the byte wide checksum for all valid DIP words*/
- for (i = 0; i < BYTES_PER_WORD; i++)
- checksum += (HDMI_INFO_FRAME_WORD1 >> i*BITS_PER_BYTE) & MASK_BYTE0;
- for (i = 0; i < BYTES_PER_WORD; i++)
- checksum += (frame2.fr2_val >> i*BITS_PER_BYTE) & MASK_BYTE0;
- for (i = 0; i < BYTES_PER_WORD; i++)
- checksum += (frame3.fr3_val >> i*BITS_PER_BYTE) & MASK_BYTE0;
-
- frame2.fr2_regx.chksum = -(checksum);
-
- had_write_register(AUD_HDMIW_INFOFR, HDMI_INFO_FRAME_WORD1);
- had_write_register(AUD_HDMIW_INFOFR, frame2.fr2_val);
- had_write_register(AUD_HDMIW_INFOFR, frame3.fr3_val);
-
- /* program remaining DIP words with zero */
- for (i = 0; i < HAD_MAX_DIP_WORDS-VALID_DIP_WORDS; i++)
- had_write_register(AUD_HDMIW_INFOFR, 0x0);
-
- ctrl_state.ctrl_regx.dip_freq = 1;
- ctrl_state.ctrl_regx.dip_en_sta = 1;
- had_write_register(AUD_CNTL_ST, ctrl_state.ctrl_val);
-}
-
/**
* snd_intelhad_prog_dip_v2 - to initialize Data Island Packets registers
*
return maud_val;
}
-/**
- * snd_intelhad_prog_cts_v1 - Program HDMI audio CTS value
- *
- * @aud_samp_freq: sampling frequency of audio data
- * @tmds: sampling frequency of the display data
- * @n_param: N value, depends on aud_samp_freq
- * @intelhaddata:substream private data
- *
- * Program CTS register based on the audio and display sampling frequency
- */
-static void snd_intelhad_prog_cts_v1(u32 aud_samp_freq, u32 tmds,
- u32 link_rate, u32 n_param,
- struct snd_intelhad *intelhaddata)
-{
- u32 cts_val;
- u64 dividend, divisor;
-
- /* Calculate CTS according to HDMI 1.3a spec*/
- dividend = (u64)tmds * n_param*1000;
- divisor = 128 * aud_samp_freq;
- cts_val = div64_u64(dividend, divisor);
- pr_debug("TMDS value=%d, N value=%d, CTS Value=%d\n",
- tmds, n_param, cts_val);
- had_write_register(AUD_HDMI_CTS, (BIT(20) | cts_val));
-}
-
/**
* snd_intelhad_prog_cts_v2 - Program HDMI audio CTS value
*
return n_val;
}
-/**
- * snd_intelhad_prog_n_v1 - Program HDMI audio N value
- *
- * @aud_samp_freq: sampling frequency of audio data
- * @n_param: N value, depends on aud_samp_freq
- * @intelhaddata:substream private data
- *
- * This function is called in the prepare callback.
- * It programs based on the audio and display sampling frequency
- */
-static int snd_intelhad_prog_n_v1(u32 aud_samp_freq, u32 *n_param,
- struct snd_intelhad *intelhaddata)
-{
- s32 n_val;
-
- n_val = had_calculate_n_value(aud_samp_freq);
-
- if (n_val < 0)
- return n_val;
-
- had_write_register(AUD_N_ENABLE, (BIT(20) | n_val));
- *n_param = n_val;
- return 0;
-}
-
/**
* snd_intelhad_prog_n_v2 - Program HDMI audio N value
*
return 0;
}
-static void had_clear_underrun_intr_v1(struct snd_intelhad *intelhaddata)
-{
- u32 hdmi_status, i = 0;
-
- /* Handle Underrun interrupt within Audio Unit */
- had_write_register(AUD_CONFIG, 0);
- /* Reset buffer pointers */
- had_write_register(AUD_HDMI_STATUS, 1);
- had_write_register(AUD_HDMI_STATUS, 0);
- /**
- * The interrupt status 'sticky' bits might not be cleared by
- * setting '1' to that bit once...
- */
- do { /* clear bit30, 31 AUD_HDMI_STATUS */
- had_read_register(AUD_HDMI_STATUS, &hdmi_status);
- pr_debug("HDMI status =0x%x\n", hdmi_status);
- if (hdmi_status & AUD_CONFIG_MASK_UNDERRUN) {
- i++;
- hdmi_status &= (AUD_CONFIG_MASK_SRDBG |
- AUD_CONFIG_MASK_FUNCRST);
- hdmi_status |= ~AUD_CONFIG_MASK_UNDERRUN;
- had_write_register(AUD_HDMI_STATUS, hdmi_status);
- } else
- break;
- } while (i < MAX_CNT);
- if (i >= MAX_CNT)
- pr_err("Unable to clear UNDERRUN bits\n");
-}
-
static void had_clear_underrun_intr_v2(struct snd_intelhad *intelhaddata)
{
u32 hdmi_status, i = 0;
.resume = hdmi_audio_resume,
};
-static struct had_ops had_ops_v1 = {
- .enable_audio = snd_intelhad_enable_audio_v1,
- .reset_audio = snd_intelhad_reset_audio_v1,
- .prog_n = snd_intelhad_prog_n_v1,
- .prog_cts = snd_intelhad_prog_cts_v1,
- .audio_ctrl = snd_intelhad_prog_audio_ctrl_v1,
- .prog_dip = snd_intelhad_prog_dip_v1,
- .handle_underrun = had_clear_underrun_intr_v1,
-};
-
static struct had_ops had_ops_v2 = {
.enable_audio = snd_intelhad_enable_audio_v2,
.reset_audio = snd_intelhad_reset_audio_v2,
}
intelhaddata->hw_silence = 1;
- had_ops_v1 = had_ops_v1; /* unused */
intelhaddata->ops = &had_ops_v2;
return retval;