#endif
+#if 0
+#define DBG(x...) printk(KERN_INFO x)
+#else
+#define DBG(x...) do { } while (0)
+#endif
+
#define AUDIO_NAME "rt5625"
#define RT5625_VERSION "0.03 alsa 1.0.21"
#define ALSA_SOC_VERSION "1.0.21"
i2c_master_reg8_recv(codec->control_data,reg,data,2,100 * 1000);
- value = (data[0]<<8) | data[1];
-
- printk("rt5625_read reg%x=%x\n",reg,value);
-
- return value;
+ value = (data[0]<<8) | data[1];
+
+ DBG(KERN_INFO "rt5625_read ok, reg = %x, value = %x\n", reg, value);
+
+ return value;
}
{
regvalue = ((reg == 0x80) ? ®80 : ((reg == 0x82) ? ®82 : ®84));
*regvalue = value;
- printk(KERN_INFO "rt5625_write ok, reg = %x, value = %x\n", reg, value);
+ DBG("rt5625_write ok, reg = %x, value = %x\n", reg, value);
return 0;
}
rt5625_write_reg_cache(codec, reg, value);
if (codec->hw_write(codec->control_data, data, 3) == 3)
{
- printk(KERN_INFO "rt5625_write ok, reg = %x, value = %x\n", reg, value);
+ DBG("rt5625_write ok, reg = %x, value = %x\n", reg, value);
return 0;
}
else
{
- printk(KERN_ERR "rt5625_write fail\n");
+ printk("rt5625_write fail\n");
return -EIO;
}
}
unsigned char RetVal=0;
unsigned int CodecData;
-// printk(KERN_INFO "rt5625_write_mask ok, reg = %x, value = %x ,mask= %x\n", reg, value,mask);
+ DBG("rt5625_write_mask ok, reg = %x, value = %x ,mask= %x\n", reg, value,mask);
if(!mask)
return 0;
// unsigned char RetVal=0;
unsigned int CodecData;
-// printk(KERN_INFO "rt5625_write_index_mask ok, reg = %x, value = %x ,mask= %x\n", reg, value,mask);
+ DBG("rt5625_write_index_mask ok, reg = %x, value = %x ,mask= %x\n", reg, value,mask);
if(!mask)
return;
return -EBUSY;
nDataL = rt5625_read(codec, RT5625_VODSP_REG_DATA);
value = ((nDataH & 0xff) << 8) |(nDataL & 0xff);
- printk(KERN_INFO "%s vodspreg=0x%x, value=0x%x\n", __func__, vodspreg, value);
+ DBG("%s vodspreg=0x%x, value=0x%x\n", __func__, vodspreg, value);
return value;
}
//*************************************************************************************************
//*************************************************************************************************
static const char *rt5625_aec_path_sel[] = {"aec func disable","aec func for pcm in/out",
- "aec func for iis in/out","aec func for analog in/out"}; /*0*/
+ "aec func for iis in/out","aec func for analog in/out"}; /*0*/
static const char *rt5625_spk_out_sel[] = {"Class AB", "Class D"}; /*1*/
static const char *rt5625_spk_l_source_sel[] = {"LPRN", "LPRP", "LPLN", "MM"}; /*2*/
static const char *rt5625_spkmux_source_sel[] = {"VMID", "HP Mixer",
static void rt5625_aec_config(struct snd_soc_codec *codec, unsigned int mode)
{
- printk("rt5625_aec_config %d\n",mode);
+ DBG("rt5625_aec_config %d\n",mode);
if (mode == VODSP_AEC_DISABLE)
{
u16 Virtual_reg = rt5625_read(codec, VIRTUAL_REG_FOR_MISC_FUNC);
int rt5625_mode=(Virtual_reg)&0x03;
- printk("1rt5625_mode=%d,value[0]=%ld,Virtual_reg=%x\n",rt5625_mode,ucontrol->value.integer.value[0],Virtual_reg);
+ DBG("rt5625_mode=%d,value[0]=%ld,Virtual_reg=%x\n",rt5625_mode,ucontrol->value.integer.value[0],Virtual_reg);
if ( rt5625_mode == ucontrol->value.integer.value[0])
return 0;
Virtual_reg |= (ucontrol->value.integer.value[0]);
rt5625_write(codec, VIRTUAL_REG_FOR_MISC_FUNC, Virtual_reg);
- printk("2rt5625_mode=%d,value[0]=%ld,Virtual_reg=%x\n",rt5625_mode,ucontrol->value.integer.value[0],Virtual_reg);
+ DBG("2rt5625_mode=%d,value[0]=%ld,Virtual_reg=%x\n",rt5625_mode,ucontrol->value.integer.value[0],Virtual_reg);
return 0;
}
{
rt5625_write_mask(codec, RT5625_PWR_MANAG_ADD1, PWR_SOFTGEN_EN, PWR_SOFTGEN_EN);
rt5625_write_mask(codec, RT5625_PWR_MANAG_ADD3, PWR_HP_R_OUT_VOL|PWR_HP_L_OUT_VOL,
- PWR_HP_R_OUT_VOL|PWR_HP_L_OUT_VOL);
+ PWR_HP_R_OUT_VOL|PWR_HP_L_OUT_VOL);
rt5625_write(codec, RT5625_MISC_CTRL,HP_DEPOP_MODE2_EN);
- printk(KERN_INFO "delay 500 msec\n");
+
+ DBG("delay 500 msec\n");
+
schedule_timeout_uninterruptible(msecs_to_jiffies(500));
rt5625_write_mask(codec, RT5625_PWR_MANAG_ADD1, PWR_HP_OUT_AMP|PWR_HP_OUT_ENH_AMP,
- PWR_HP_OUT_AMP|PWR_HP_OUT_ENH_AMP);
-// rt5625_write_mask(codec, RT5625_MISC_CTRL, 0, HP_DEPOP_MODE2_EN);
+ PWR_HP_OUT_AMP|PWR_HP_OUT_ENH_AMP);
+ //rt5625_write_mask(codec, RT5625_MISC_CTRL, 0, HP_DEPOP_MODE2_EN);
}
struct snd_soc_codec *codec = w->codec;
unsigned int l, r;
- printk(KERN_INFO "enter %s\n", __func__);
+ DBG("enter %s\n", __func__);
l= rt5625_read(codec, HPL_MIXER);
r = rt5625_read(codec, HPR_MIXER);
struct snd_soc_codec *codec = w->codec;
int reg;
- printk(KERN_INFO "enter %s\n", __func__);
+ DBG("enter %s\n", __func__);
reg = rt5625_read(codec, VIRTUAL_REG_FOR_MISC_FUNC) & (0x3 << 4);
if ((reg >> 4) != 0x3 && reg != 0)
return 0;
switch (event)
{
case SND_SOC_DAPM_POST_PMU:
- printk(KERN_INFO "after virtual spk power up!\n");
+ DBG("after virtual spk power up!\n");
rt5625_write_mask(codec, 0x3e, 0x3000, 0x3000);
rt5625_write_mask(codec, 0x02, 0x0000, 0x8080);
rt5625_write_mask(codec, 0x3a, 0x0400, 0x0400);//power on spk amp
break;
case SND_SOC_DAPM_POST_PMD:
- printk(KERN_INFO "aftet virtual spk power down!\n");
+ DBG("aftet virtual spk power down!\n");
rt5625_write_mask(codec, 0x3a, 0x0000, 0x0400);//power off spk amp
rt5625_write_mask(codec, 0x02, 0x8080, 0x8080);
rt5625_write_mask(codec, 0x3e, 0x0000, 0x3000);
struct snd_soc_codec *codec = w->codec;
int reg;
- printk(KERN_INFO "enter %s\n", __func__);
+ DBG("enter %s\n", __func__);
reg = rt5625_read(codec, VIRTUAL_REG_FOR_MISC_FUNC) & (0x3 << 6);
if ((reg >> 6) != 0x3 && reg != 0)
{
case SND_SOC_DAPM_POST_PMD:
- printk(KERN_INFO "aftet virtual hp power down!\n");
+ DBG("aftet virtual hp power down!\n");
hp_mute_unmute_depop(codec,1);//mute hp
rt5625_write_mask(codec, 0x3a, 0x0000, 0x0300);
case SND_SOC_DAPM_POST_PMU:
- printk(KERN_INFO "after virtual hp power up!\n");
+ DBG("after virtual hp power up!\n");
hp_depop_mode2(codec);
hp_mute_unmute_depop(codec,0);//unmute hp
break;
/*aux out mux*/
{"AUXOUT Mux", "HP Mixer", "HP Mixer"},
{"AUXOUT Mux", "SPK Mixer", "SPK Mixer"},
- {"SPKOUT Mux", "Mono Mixer", "MoNo Mixer"},
+ {"AUXOUT Mux", "Mono Mixer", "MoNo Mixer"},
/*spkl out pga*/
{"SPKL Out PGA", NULL, "SPKOUT Mux"},
-
-
+
/*spkr out pga*/
{"SPKR Out PGA", NULL, "SPKOUT Mux"},
**************************************************************/
static const struct _pll_div codec_master_pll1_div[] = {
- { 2048000, 8192000, 0x0ea0},
- { 3686400, 8192000, 0x4e27},
- { 12000000, 8192000, 0x456b},
- { 13000000, 8192000, 0x495f},
- { 13100000, 8192000, 0x0320},
- { 2048000, 11289600, 0xf637},
- { 3686400, 11289600, 0x2f22},
- { 12000000, 11289600, 0x3e2f},
- { 13000000, 11289600, 0x4d5b},
- { 13100000, 11289600, 0x363b},
- { 2048000, 16384000, 0x1ea0},
- { 3686400, 16384000, 0x9e27},
- { 12000000, 16384000, 0x452b},
- { 13000000, 16384000, 0x542f},
- { 13100000, 16384000, 0x03a0},
- { 2048000, 16934400, 0xe625},
- { 3686400, 16934400, 0x9126},
- { 12000000, 16934400, 0x4d2c},
- { 13000000, 16934400, 0x742f},
- { 13100000, 16934400, 0x3c27},
- { 2048000, 22579200, 0x2aa0},
- { 3686400, 22579200, 0x2f20},
- { 12000000, 22579200, 0x7e2f},
- { 13000000, 22579200, 0x742f},
- { 13100000, 22579200, 0x3c27},
- { 2048000, 24576000, 0x2ea0},
- { 3686400, 24576000, 0xee27},
- { 12000000, 24576000, 0x2915},
- { 13000000, 24576000, 0x772e},
- { 13100000, 24576000, 0x0d20},
- { 26000000, 24576000, 0x2027},
- { 26000000, 22579200, 0x392f},
- { 24576000, 22579200, 0x0921},
- { 24576000, 24576000, 0x02a0},
+ { 2048000, 8192000, 0x0ea0},
+ { 3686400, 8192000, 0x4e27},
+ { 12000000, 8192000, 0x456b},
+ { 13000000, 8192000, 0x495f},
+ { 13100000, 8192000, 0x0320},
+ { 2048000, 11289600, 0xf637},
+ { 3686400, 11289600, 0x2f22},
+ { 12000000, 11289600, 0x3e2f},
+ { 13000000, 11289600, 0x4d5b},
+ { 13100000, 11289600, 0x363b},
+ { 2048000, 16384000, 0x1ea0},
+ { 3686400, 16384000, 0x9e27},
+ { 12000000, 16384000, 0x452b},
+ { 13000000, 16384000, 0x542f},
+ { 13100000, 16384000, 0x03a0},
+ { 2048000, 16934400, 0xe625},
+ { 3686400, 16934400, 0x9126},
+ { 12000000, 16934400, 0x4d2c},
+ { 13000000, 16934400, 0x742f},
+ { 13100000, 16934400, 0x3c27},
+ { 2048000, 22579200, 0x2aa0},
+ { 3686400, 22579200, 0x2f20},
+ { 12000000, 22579200, 0x7e2f},
+ { 13000000, 22579200, 0x742f},
+ { 13100000, 22579200, 0x3c27},
+ { 2048000, 24576000, 0x2ea0},
+ { 3686400, 24576000, 0xee27},
+ { 11289600, 24576000, 0x950F},
+ { 12000000, 24576000, 0x2915},
+ { 12288000, 24576000, 0x0600},
+ { 13000000, 24576000, 0x772e},
+ { 13100000, 24576000, 0x0d20},
+ { 26000000, 24576000, 0x2027},
+ { 26000000, 22579200, 0x392f},
+ { 24576000, 22579200, 0x0921},
+ { 24576000, 24576000, 0x02a0},
};
static const struct _pll_div codec_bclk_pll1_div[] = {
- { 256000, 4096000, 0x3ea0},
- { 352800, 5644800, 0x3ea0},
- { 512000, 8192000, 0x3ea0},
- { 705600, 11289600, 0x3ea0},
+ { 256000, 4096000, 0x3ea0},
+ { 352800, 5644800, 0x3ea0},
+ { 512000, 8192000, 0x3ea0},
+ { 705600, 11289600, 0x3ea0},
{ 1024000, 16384000, 0x3ea0},
- { 1411200, 22579200, 0x3ea0},
- { 1536000, 24576000, 0x3ea0},
+ { 1411200, 22579200, 0x3ea0},
+ { 1536000, 24576000, 0x3ea0},
{ 2048000, 16384000, 0x1ea0},
- { 2822400, 22579200, 0x1ea0},
- { 3072000, 24576000, 0x1ea0},
- { 705600, 11289600, 0x3ea0},
- { 705600, 8467200, 0x3ab0},
- { 2822400, 11289600, 0x1ee0},
- { 3072000, 12288000, 0x1ee0},
+ { 2822400, 22579200, 0x1ea0},
+ { 3072000, 24576000, 0x1ea0},
+ { 705600, 11289600, 0x3ea0},
+ { 705600, 8467200, 0x3ab0},
+ { 2822400, 11289600, 0x1ee0},
+ { 3072000, 12288000, 0x1ee0},
};
static const struct _pll_div codec_vbclk_pll1_div[] = {
- { 256000, 4096000, 0x3ea0},
- { 352800, 5644800, 0x3ea0},
- { 512000, 8192000, 0x3ea0},
- { 705600, 11289600, 0x3ea0},
+
+ { 256000, 4096000, 0x3ea0},
+ { 352800, 5644800, 0x3ea0},
+ { 512000, 8192000, 0x3ea0},
+ { 705600, 11289600, 0x3ea0},
{ 1024000, 16384000, 0x3ea0},
- { 1411200, 22579200, 0x3ea0},
- { 1536000, 24576000, 0x3ea0},
+ { 1411200, 22579200, 0x3ea0},
+ { 1536000, 24576000, 0x3ea0},
{ 2048000, 16384000, 0x1ea0},
- { 2822400, 22579200, 0x1ea0},
- { 3072000, 24576000, 0x1ea0},
- { 705600, 11289600, 0x3ea0},
- { 705600, 8467200, 0x3ab0},
+ { 2822400, 22579200, 0x1ea0},
+ { 3072000, 24576000, 0x1ea0},
+ { 705600, 11289600, 0x3ea0},
+ { 705600, 8467200, 0x3ab0},
};
};
static const struct _coeff_div_stereo coeff_div_stereo[] = {
- /*bclk is config to 32fs, if codec is choose to be slave mode , input bclk should be 32*fs */
- {24576000, 48000, 0x3174, 0x1010},
- {12288000, 48000, 0x1174, 0x0000},
- {18432000, 48000, 0x2174, 0x1111},
- {36864000, 48000, 0x2274, 0x2020},
- {49152000, 48000, 0xf074, 0x3030},
- {24576000, 48000, 0x3172,0x1010},
- {24576000, 8000, 0xB274,0x2424},
- {24576000, 16000, 0xB174,0x2222},
- {24576000, 32000, 0xB074,0x2121},
- {22579200, 11025, 0X3374,0x1414},
- {22579200, 22050, 0X3274,0x1212},
- {22579200, 44100, 0X3174,0x1010},
-
- {0, 0, 0, 0},
+
+ /*bclk is config to 32fs, if codec is choose to be slave mode , input bclk should be 32*fs */
+ {24576000, 48000, 0x3174, 0x1010},
+ {12288000, 48000, 0x1174, 0x0000},
+ {18432000, 48000, 0x2174, 0x1111},
+ {36864000, 48000, 0x2274, 0x2020},
+ {49152000, 48000, 0xf074, 0x3030},
+ {24576000, 48000, 0x3172, 0x1010},
+ {24576000, 8000, 0xB274, 0x2424},
+ {24576000, 16000, 0xB174, 0x2222},
+ {24576000, 32000, 0xB074, 0x2121},
+ {22579200, 11025, 0X3374, 0x1414},
+ {22579200, 22050, 0X3274, 0x1212},
+ {22579200, 44100, 0X3174, 0x1010},
+ {0, 0, 0, 0},
};
static const struct _coeff_div_voice coeff_div_voice[] = {
- /*bclk is config to 32fs, if codec is choose to be slave mode , input bclk should be 32*fs */
- {24576000, 16000, 0x2622},
- {24576000, 8000, 0x2824},
- {0, 0, 0},
+
+ /*bclk is config to 32fs, if codec is choose to be slave mode , input bclk should be 32*fs */
+ {24576000, 16000, 0x2622},
+ {24576000, 8000, 0x2824},
+ {0, 0, 0},
};
static int get_coeff(unsigned int mclk, unsigned int rate, int mode)
{
int i;
- printk("get_coeff mclk = %d, rate = %d\n", mclk, rate);
- if (!mode){
+ DBG("get_coeff mclk = %d, rate = %d, mode = %d\n", mclk, rate, mode);
+
+ if (!mode) {
for (i = 0; i < ARRAY_SIZE(coeff_div_stereo); i++) {
if ((coeff_div_stereo[i].rate == rate) && (coeff_div_stereo[i].mclk == mclk))
return i;
}
- }
- else {
+ } else {
for (i = 0; i< ARRAY_SIZE(coeff_div_voice); i++) {
if ((coeff_div_voice[i].rate == rate) && (coeff_div_voice[i].mclk == mclk))
return i;
}
}
+ printk("can't find a matched mclk and rate in %s\n",
+ (mode ? "coeff_div_voice[]" : "coeff_div_audio[]"));
+
return -EINVAL;
- printk(KERN_ERR "can't find a matched mclk and rate in %s\n",
- (mode ? "coeff_div_voice[]" : "coeff_div_audio[]"));
}
int ret = -EINVAL;
struct snd_soc_codec *codec = codec_dai->codec;
- printk(KERN_DEBUG "enter %s\n", __func__);
+ DBG("enter %s pll_id = %d freq_in = %d freq_out = %d\n",
+ __func__, pll_id, freq_in, freq_out);
if (pll_id < RT5625_PLL1_FROM_MCLK || pll_id > RT5625_PLL1_FROM_VBCLK)
return -EINVAL;
if (!freq_in || !freq_out)
return 0;
- if (RT5625_PLL1_FROM_MCLK == pll_id)
- {
+ if (RT5625_PLL1_FROM_MCLK == pll_id) {
+
for (i = 0; i < ARRAY_SIZE(codec_master_pll1_div); i ++)
{
if ((freq_in == codec_master_pll1_div[i].pll_in) && (freq_out == codec_master_pll1_div[i].pll_out))
{
- rt5625_write(codec, RT5625_GEN_CTRL_REG2, 0x0000); /*PLL source from MCLK*/
- rt5625_write(codec, RT5625_PLL_CTRL, codec_master_pll1_div[i].regvalue); /*set pll code*/
- rt5625_write_mask(codec, RT5625_PWR_MANAG_ADD2, 0x8000, 0x8000); /*enable pll1 power*/
+ rt5625_write(codec, RT5625_GEN_CTRL_REG2, 0x0000); /*PLL source from MCLK*/
+ rt5625_write(codec, RT5625_PLL_CTRL, codec_master_pll1_div[i].regvalue); /*set pll code*/
+ rt5625_write_mask(codec, RT5625_PWR_MANAG_ADD2, 0x8000, 0x8000); /*enable pll1 power*/
rt5625_write_mask(codec, RT5625_GEN_CTRL_REG1, 0x8000, 0x8000);
ret = 0;
}
}
- }
- else if (RT5625_PLL1_FROM_BCLK == pll_id)
- {
+ } else if (RT5625_PLL1_FROM_BCLK == pll_id) {
+
for (i = 0; i < ARRAY_SIZE(codec_bclk_pll1_div); i ++)
{
if ((freq_in == codec_bclk_pll1_div[i].pll_in) && (freq_out == codec_bclk_pll1_div[i].pll_out))
{
- rt5625_write(codec, RT5625_GEN_CTRL_REG2, 0x2000); /*PLL source from BCLK*/
- rt5625_write(codec, RT5625_PLL_CTRL, codec_bclk_pll1_div[i].regvalue); /*set pll1 code*/
- rt5625_write_mask(codec, RT5625_PWR_MANAG_ADD2, 0x8000, 0x8000); /*enable pll1 power*/
+ rt5625_write(codec, RT5625_GEN_CTRL_REG2, 0x2000); /*PLL source from BCLK*/
+ rt5625_write(codec, RT5625_PLL_CTRL, codec_bclk_pll1_div[i].regvalue); /*set pll1 code*/
+ rt5625_write_mask(codec, RT5625_PWR_MANAG_ADD2, 0x8000, 0x8000); /*enable pll1 power*/
rt5625_write_mask(codec, RT5625_GEN_CTRL_REG1, 0x8000, 0x8000);
ret = 0;
}
}
- }
- else if (RT5625_PLL1_FROM_VBCLK == pll_id)
- {
+ } else if (RT5625_PLL1_FROM_VBCLK == pll_id) {
+
for (i = 0; i < ARRAY_SIZE(codec_vbclk_pll1_div); i ++)
{
if ((freq_in == codec_vbclk_pll1_div[i].pll_in) && (freq_out == codec_vbclk_pll1_div[i].pll_out))
{
- rt5625_write(codec, RT5625_GEN_CTRL_REG2, 0x3000); /*PLL source from VBCLK*/
- rt5625_write(codec, RT5625_PLL_CTRL, codec_vbclk_pll1_div[i].regvalue); /*set pll1 code*/
- rt5625_write_mask(codec, RT5625_PWR_MANAG_ADD2, 0x8000, 0x8000); /*enable pll1 power*/
+ rt5625_write(codec, RT5625_GEN_CTRL_REG2, 0x3000); /*PLL source from VBCLK*/
+ rt5625_write(codec, RT5625_PLL_CTRL, codec_vbclk_pll1_div[i].regvalue); /*set pll1 code*/
+ rt5625_write_mask(codec, RT5625_PWR_MANAG_ADD2, 0x8000, 0x8000); /*enable pll1 power*/
rt5625_write_mask(codec, RT5625_GEN_CTRL_REG1, 0x8000, 0x8000);
ret = 0;
}
}
}
-
-
return 0;
}
{
struct snd_soc_codec *codec = codec_dai->codec;
struct rt5625_priv * rt5625 = codec->private_data;
- printk(KERN_DEBUG "enter %s\n", __func__);
+
+ DBG("sysclk freq %u for audio i2s\n", freq);
if ((freq >= (256 * 8000)) && (freq <= (512 * 48000))) {
rt5625->stereo_sysclk = freq;
return 0;
}
- printk(KERN_ERR "unsupported sysclk freq %u for audio i2s\n", freq);
- rt5625->stereo_sysclk=24576000;
+ printk("unsupported sysclk freq %u for audio i2s\n", freq);
+ rt5625->stereo_sysclk=24576000;
return 0;
}
{
struct snd_soc_codec *codec = codec_dai->codec;
struct rt5625_priv * rt5625 = codec->private_data;
-
+
+ DBG("sysclk freq %u for voice pcm\n", freq);
if ((freq >= (256 * 8000)) && (freq <= (512 * 48000))) {
rt5625->voice_sysclk = freq;
return 0;
}
- printk(KERN_ERR "unsupported sysclk freq %u for voice pcm\n", freq);
- rt5625->voice_sysclk = 24576000;
+ printk("unsupported sysclk freq %u for voice pcm\n", freq);
+ rt5625->voice_sysclk = 24576000;
return 0;
}
int rate = params_rate(params);
int coeff = get_coeff(rt5625->stereo_sysclk, rate, 0);
- printk(KERN_DEBUG "enter %s\n", __func__);
-
+ DBG("enter %s rate = %d \n", __func__, rate);
switch (params_format(params))
{
iface |= 0x000c;
}
-
-
rt5625_write(codec, RT5625_MAIN_SDP_CTRL, iface);
rt5625_write_mask(codec, 0x3a, 0xc801, 0xc801); /*power i2s and dac ref*/
if (coeff >= 0) {
int rate = params_rate(params);
int coeff = get_coeff(rt5625->voice_sysclk, rate, 1);
- printk(KERN_DEBUG "enter %s\n", __func__);
+ DBG("enter %s rate = %d \n", __func__, rate);
list_for_each_entry(w, &codec->dapm_widgets, list)
{
struct snd_soc_codec *codec = codec_dai->codec;
u16 iface = 0;
- printk(KERN_DEBUG "enter %s\n", __func__);
+ DBG("enter %s fmt = %d\n", __func__, fmt);
/*set master/slave interface*/
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK)
struct snd_soc_codec *codec = codec_dai->codec;
int iface;
- printk(KERN_DEBUG "enter %s\n", __func__);
+ DBG("enter %s\n", __func__);
/*set slave/master mode*/
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK)
{
static int rt5625_hifi_codec_mute(struct snd_soc_dai *dai, int mute)
{
struct snd_soc_codec *codec = dai->codec;
-
+
if (mute)
rt5625_write_mask(codec, RT5625_STEREO_DAC_VOL, 0x8080, 0x8080);
else
#define RT5625_STEREO_RATES SNDRV_PCM_RATE_8000_48000
-#define RT5626_VOICE_RATES (SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_8000)
+#define RT5626_VOICE_RATES SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_8000
#define RT5625_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
SNDRV_PCM_FMTBIT_S20_3LE |\
.playback = {
.stream_name = "Voice Playback",
.channels_min = 1,
- .channels_max =1,
+ .channels_max = 1,
.rates = RT5626_VOICE_RATES,
.formats = RT5625_FORMATS,
},
static int rt56xx_hwdep_open(struct snd_hwdep *hw, struct file *file)
{
- printk("enter %s\n", __func__);
+ DBG("enter %s\n", __func__);
return 0;
}
static int rt56xx_hwdep_release(struct snd_hwdep *hw, struct file *file)
{
- printk("enter %s\n", __func__);
+ DBG("enter %s\n", __func__);
return 0;
}
int number = codec->reg_cache_size;
int i;
- printk(KERN_DEBUG "enter %s, number = %d\n", __func__, number);
+ DBG("enter %s, number = %d\n", __func__, number);
if (copy_from_user(&rt56xx, _rt56xx, sizeof(rt56xx)))
return -EFAULT;
printk(KERN_ERR "rt5625: failed to register card\n");
goto card_err;
}
- printk(KERN_DEBUG "rt5625: initial ok\n");
+ DBG("rt5625: initial ok\n");
return 0;
card_err:
static int rk29_hw_params(struct snd_pcm_substream *substream,
struct snd_pcm_hw_params *params)
{
- struct snd_soc_pcm_runtime *rtd = substream->private_data;
- struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
- struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
- unsigned int pll_out = 0;
- int ret;
-
- DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
- /*by Vincent Hsiung for EQ Vol Change*/
- #define HW_PARAMS_FLAG_EQVOL_ON 0x21
- #define HW_PARAMS_FLAG_EQVOL_OFF 0x22
- if ((params->flags == HW_PARAMS_FLAG_EQVOL_ON)||(params->flags == HW_PARAMS_FLAG_EQVOL_OFF))
- {
- ret = codec_dai->ops->hw_params(substream, params, codec_dai); //by Vincent
- DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
- }
- else
- {
+ struct snd_soc_pcm_runtime *rtd = substream->private_data;
+ struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
+ struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
+ unsigned int pll_out = 0;
+ int ret;
+
+ DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+ /*by Vincent Hsiung for EQ Vol Change*/
+ #define HW_PARAMS_FLAG_EQVOL_ON 0x21
+ #define HW_PARAMS_FLAG_EQVOL_OFF 0x22
+ if (codec_dai->ops->hw_params && ((params->flags == HW_PARAMS_FLAG_EQVOL_ON) || (params->flags == HW_PARAMS_FLAG_EQVOL_OFF)))
+ {
+ ret = codec_dai->ops->hw_params(substream, params, codec_dai); //by Vincent
+ DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+ } else {
- /* set codec DAI configuration */
- #if defined (CONFIG_SND_RK29_CODEC_SOC_SLAVE)
- ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
- SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS);
- #endif
- #if defined (CONFIG_SND_RK29_CODEC_SOC_MASTER)
- ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
- SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBM_CFM );
- #endif
- if (ret < 0)
- return ret;
-
- /* set cpu DAI configuration */
- #if defined (CONFIG_SND_RK29_CODEC_SOC_SLAVE)
- ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S |
- SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBM_CFM);
- #endif
- #if defined (CONFIG_SND_RK29_CODEC_SOC_MASTER)
- ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S |
- SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS);
- #endif
- if (ret < 0)
- return ret;
-
- }
-
-
- switch(params_rate(params)) {
- case 8000:
- case 16000:
- case 24000:
- case 32000:
- case 48000:
- pll_out = 12288000;
- break;
- case 11025:
- case 22050:
- case 44100:
- pll_out = 11289600;
- break;
- default:
- DBG("Enter:%s, %d, Error rate=%d\n",__FUNCTION__,__LINE__,params_rate(params));
- return -EINVAL;
- break;
- }
- DBG("Enter:%s, %d, rate=%d\n",__FUNCTION__,__LINE__,params_rate(params));
-
- #if defined (CONFIG_SND_RK29_CODEC_SOC_SLAVE)
-#if 0 //use pll from blck
- /*Set the pll of rt5625,the Pll source from BITCLK on CPU is master mode*/
- //bitclk is 64fs
- ret=snd_soc_dai_set_pll(codec_dai,0,params_rate(params)*64,pll_out);
- if (ret < 0)
- {
- DBG("rk29_hw_params_rt5625:failed to set the pll for codec side\n");
- return ret;
- }
-#endif
- /*Set the system clk for codec*/
- ret=snd_soc_dai_set_sysclk(codec_dai, 0,pll_out,SND_SOC_CLOCK_IN);
- if (ret < 0)
- {
- DBG("rk29_hw_params_rt5625:failed to set the sysclk for codec side\n");
- return ret;
- }
+ /* set codec DAI configuration */
+ #if defined (CONFIG_SND_RK29_CODEC_SOC_SLAVE)
+
+ ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
+ SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS);
+ #endif
+ #if defined (CONFIG_SND_RK29_CODEC_SOC_MASTER)
+
+ ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
+ SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBM_CFM );
#endif
-
-/*
- #if defined (CONFIG_SND_RK29_CODEC_SOC_MASTER)
-
- if((24576000%params_rate(params))==0) //for 8k,16k,32k,48k
- {
- snd_soc_dai_set_pll(codec_dai,0,pll_out, 24576000);
- snd_soc_dai_set_sysclk(codec_dai,0, 24576000, SND_SOC_CLOCK_IN);
- }
- else if((22579200%params_rate(params))==0) //for 11k,22k,44k
- {
- snd_soc_dai_set_pll(codec_dai,0,pll_out, 22579200);
- snd_soc_dai_set_sysclk(codec_dai,0, 22579200, SND_SOC_CLOCK_IN);
- }
-
- #endif
-*/
-
- #if defined (CONFIG_SND_RK29_CODEC_SOC_SLAVE)
- snd_soc_dai_set_sysclk(cpu_dai, 0, pll_out, 0);
- snd_soc_dai_set_clkdiv(cpu_dai, ROCKCHIP_DIV_BCLK, (pll_out/4)/params_rate(params)-1);
- snd_soc_dai_set_clkdiv(cpu_dai, ROCKCHIP_DIV_MCLK, 3);
- #endif
-
- DBG("Enter:%s, %d, LRCK=%d\n",__FUNCTION__,__LINE__,(pll_out/4)/params_rate(params));
-
- return 0;
+ if (ret < 0)
+ return ret;
+
+ /* set cpu DAI configuration */
+ #if defined (CONFIG_SND_RK29_CODEC_SOC_SLAVE)
+ ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S |
+ SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBM_CFM);
+ #endif
+ #if defined (CONFIG_SND_RK29_CODEC_SOC_MASTER)
+ ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S |
+ SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS);
+ #endif
+ if (ret < 0)
+ return ret;
+ }
+
+ switch(params_rate(params)) {
+ case 8000:
+ case 16000:
+ case 24000:
+ case 32000:
+ case 48000:
+ pll_out = 12288000;
+ break;
+ case 11025:
+ case 22050:
+ case 44100:
+ pll_out = 11289600;
+ break;
+ default:
+ DBG("Enter:%s, %d, Error rate=%d\n", __FUNCTION__, __LINE__, params_rate(params));
+ return -EINVAL;
+ break;
+ }
+
+ DBG("Enter:%s, %d, rate=%d\n", __FUNCTION__, __LINE__, params_rate(params));
+
+ /*Set the system clk for codec*/
+ ret = snd_soc_dai_set_sysclk(codec_dai, 0, pll_out, SND_SOC_CLOCK_IN);
+ if (ret < 0)
+ {
+ DBG("rk29_hw_params_rt5625:failed to set the sysclk for codec side\n");
+ return ret;
+ }
+
+ snd_soc_dai_set_sysclk(cpu_dai, 0, pll_out, 0);
+ snd_soc_dai_set_clkdiv(cpu_dai, ROCKCHIP_DIV_BCLK, (pll_out/4)/params_rate(params)-1);
+ snd_soc_dai_set_clkdiv(cpu_dai, ROCKCHIP_DIV_MCLK, 3);
+
+ DBG("Enter:%s, %d, pll_out/4/params_rate(params) = %d \n", __FUNCTION__, __LINE__, (pll_out/4)/params_rate(params));
+
+ return 0;
}
static const struct snd_soc_dapm_widget rt5625_dapm_widgets[] = {
/* LINE_OUT --> Ext Speaker */
{"Ext Spk", NULL, "SPKL"},
{"Ext Spk", NULL, "SPKR"},
-
} ;
/*
* Logic for a rt5625 as connected on a rockchip board.
*/
static int rk29_rt5625_init(struct snd_soc_codec *codec)
-{
- DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+{
+ DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
- /* Add specific widgets */
+ /* Add specific widgets */
snd_soc_dapm_new_controls(codec, rt5625_dapm_widgets,
- ARRAY_SIZE(rt5625_dapm_widgets));
- DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
- /* Set up specific audio path audio_mapnects */
- snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
- DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
-// snd_soc_dapm_nc_pin(codec, "HP_L");
- DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
-// snd_soc_dapm_nc_pin(codec, "HP_R");
- DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
- snd_soc_dapm_sync(codec);
- DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+ ARRAY_SIZE(rt5625_dapm_widgets));
+
+ /* Set up specific audio path audio_mapnects */
+ snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
+ //snd_soc_dapm_nc_pin(codec, "HP_L");
+ //snd_soc_dapm_nc_pin(codec, "HP_R");
+ snd_soc_dapm_sync(codec);
- return 0;
+ return 0;
+}
+
+static int rt5625_voice_hw_params(struct snd_pcm_substream *substream,
+ struct snd_pcm_hw_params *params)
+{
+ struct snd_soc_pcm_runtime *rtd = substream->private_data;
+ struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
+ struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
+ unsigned int pll_out = 0;
+ int ret;
+
+ DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+
+ /* set codec DAI configuration */
+ /*#if defined (CONFIG_SND_CODEC_SOC_SLAVE)
+ DBG("Enter::%s----codec slave\n",__FUNCTION__);
+
+ ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_DSP_A |
+ SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS);
+ #endif*/
+ //#if defined (CONFIG_SND_CODEC_SOC_MASTER)
+ DBG("Enter::%s----codec master\n",__FUNCTION__);
+
+ ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_DSP_A |
+ SND_SOC_DAIFMT_IB_NF | SND_SOC_DAIFMT_CBM_CFM );
+ //#endif
+
+ switch(params_rate(params)) {
+ case 8000:
+ case 16000:
+ case 24000:
+ case 32000:
+ case 48000:
+ pll_out = 12288000;
+ break;
+ case 11025:
+ case 22050:
+ case 44100:
+ pll_out = 11289600;
+ break;
+ default:
+ DBG("Enter:%s, %d, Error rate=%d\n", __FUNCTION__, __LINE__, params_rate(params));
+ return -EINVAL;
+ break;
+ }
+
+ snd_soc_dai_set_pll(codec_dai, RT5625_PLL1_FROM_MCLK, pll_out, 24576000);
+
+ /*Set the system clk for codec*/
+ ret = snd_soc_dai_set_sysclk(codec_dai, 0, 24576000, SND_SOC_CLOCK_IN);
+
+ if (ret < 0) {
+ printk("rk29_hw_params_rt5625:failed to set the sysclk for codec side\n");
+ return ret;
+ }
+
+ ret = snd_soc_dai_set_sysclk(cpu_dai, 0, pll_out, 0);
+
+ return 0;
}
static struct snd_soc_ops rk29_ops = {
- .hw_params = rk29_hw_params,
+ .hw_params = rk29_hw_params,
+};
+
+static struct snd_soc_ops rt5625_voice_ops = {
+ .hw_params = rt5625_voice_hw_params,
};
-static struct snd_soc_dai_link rk29_dai = {
- .name = "RT5625",
- .stream_name = "RT5625 PCM",
- .cpu_dai = &rk29_i2s_dai[0],
- .codec_dai = &rt5625_dai[0],
- .init = rk29_rt5625_init,
- .ops = &rk29_ops,
+static struct snd_soc_dai_link rk29_dai[] = {
+ {
+ .name = "RT5625-1",
+ .stream_name = "RT5625 PCM-1",
+ .cpu_dai = &rk29_i2s_dai,
+ .codec_dai = &rt5625_dai[0],
+ .init = rk29_rt5625_init,
+ .ops = &rk29_ops,
+ },
+ {
+ .name = "RT5625-2",
+ .stream_name = "RT5625 PCM-2",
+ .cpu_dai = &rk29_i2s_dai,
+ .codec_dai = &rt5625_dai[1],
+ .init = rk29_rt5625_init,
+ .ops = &rt5625_voice_ops,
+ }
};
static struct snd_soc_card snd_soc_card_rk29 = {
- .name = "RK29_RT5625",
- .platform = &rk29_soc_platform,
- .dai_link = &rk29_dai,
- .num_links = 1,
+ .name = "RK29_RT5625",
+ .platform = &rk29_soc_platform,
+ .dai_link = &rk29_dai,
+ .num_links = 1,
};
static struct snd_soc_device rk29_snd_devdata = {
- .card = &snd_soc_card_rk29,
- .codec_dev = &soc_codec_dev_rt5625,
+ .card = &snd_soc_card_rk29,
+ .codec_dev = &soc_codec_dev_rt5625,
};
static struct platform_device *rk29_snd_device;
static int __init audio_card_init(void)
{
- int ret =0;
- DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+ int ret =0;
+
+ DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+
rk29_snd_device = platform_device_alloc("soc-audio", -1);
if (!rk29_snd_device) {
DBG("platform device allocation failed\n");
projects / firefly-linux-kernel-4.4.55.git / commitdiff