1186 lines
32 KiB
C
1186 lines
32 KiB
C
/*
|
|
* rt1305.c -- RT1305 ALSA SoC amplifier component driver
|
|
*
|
|
* Copyright 2018 Realtek Semiconductor Corp.
|
|
* Author: Shuming Fan <shumingf@realtek.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.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/moduleparam.h>
|
|
#include <linux/init.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/pm.h>
|
|
#include <linux/acpi.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/of_gpio.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/firmware.h>
|
|
#include <sound/core.h>
|
|
#include <sound/pcm.h>
|
|
#include <sound/pcm_params.h>
|
|
#include <sound/soc.h>
|
|
#include <sound/soc-dapm.h>
|
|
#include <sound/initval.h>
|
|
#include <sound/tlv.h>
|
|
|
|
#include "rl6231.h"
|
|
#include "rt1305.h"
|
|
|
|
|
|
#define RT1305_PR_RANGE_BASE (0xff + 1)
|
|
#define RT1305_PR_SPACING 0x100
|
|
|
|
#define RT1305_PR_BASE (RT1305_PR_RANGE_BASE + (0 * RT1305_PR_SPACING))
|
|
|
|
|
|
static const struct regmap_range_cfg rt1305_ranges[] = {
|
|
{
|
|
.name = "PR",
|
|
.range_min = RT1305_PR_BASE,
|
|
.range_max = RT1305_PR_BASE + 0xff,
|
|
.selector_reg = RT1305_PRIV_INDEX,
|
|
.selector_mask = 0xff,
|
|
.selector_shift = 0x0,
|
|
.window_start = RT1305_PRIV_DATA,
|
|
.window_len = 0x1,
|
|
},
|
|
};
|
|
|
|
|
|
static const struct reg_sequence init_list[] = {
|
|
|
|
{ RT1305_PR_BASE + 0xcf, 0x5548 },
|
|
{ RT1305_PR_BASE + 0x5d, 0x0442 },
|
|
{ RT1305_PR_BASE + 0xc1, 0x0320 },
|
|
|
|
{ RT1305_POWER_STATUS, 0x0000 },
|
|
|
|
{ RT1305_SPK_TEMP_PROTECTION_1, 0xd6de },
|
|
{ RT1305_SPK_TEMP_PROTECTION_2, 0x0707 },
|
|
{ RT1305_SPK_TEMP_PROTECTION_3, 0x4090 },
|
|
|
|
{ RT1305_DAC_SET_1, 0xdfdf }, /* 4 ohm 2W */
|
|
{ RT1305_ADC_SET_3, 0x0219 },
|
|
{ RT1305_ADC_SET_1, 0x170f }, /* 0.2 ohm RSense*/
|
|
|
|
};
|
|
#define RT1305_INIT_REG_LEN ARRAY_SIZE(init_list)
|
|
|
|
struct rt1305_priv {
|
|
struct snd_soc_component *component;
|
|
struct regmap *regmap;
|
|
|
|
int sysclk;
|
|
int sysclk_src;
|
|
int lrck;
|
|
int bclk;
|
|
int master;
|
|
|
|
int pll_src;
|
|
int pll_in;
|
|
int pll_out;
|
|
};
|
|
|
|
static const struct reg_default rt1305_reg[] = {
|
|
|
|
{ 0x04, 0x0400 },
|
|
{ 0x05, 0x0880 },
|
|
{ 0x06, 0x0000 },
|
|
{ 0x07, 0x3100 },
|
|
{ 0x08, 0x8000 },
|
|
{ 0x09, 0x0000 },
|
|
{ 0x0a, 0x087e },
|
|
{ 0x0b, 0x0020 },
|
|
{ 0x0c, 0x0802 },
|
|
{ 0x0d, 0x0020 },
|
|
{ 0x10, 0x1d1d },
|
|
{ 0x11, 0x1d1d },
|
|
{ 0x12, 0xffff },
|
|
{ 0x14, 0x000c },
|
|
{ 0x16, 0x1717 },
|
|
{ 0x17, 0x4000 },
|
|
{ 0x18, 0x0019 },
|
|
{ 0x20, 0x0000 },
|
|
{ 0x22, 0x0000 },
|
|
{ 0x24, 0x0000 },
|
|
{ 0x26, 0x0000 },
|
|
{ 0x28, 0x0000 },
|
|
{ 0x2a, 0x4000 },
|
|
{ 0x2b, 0x3000 },
|
|
{ 0x2d, 0x6000 },
|
|
{ 0x2e, 0x0000 },
|
|
{ 0x2f, 0x8000 },
|
|
{ 0x32, 0x0000 },
|
|
{ 0x39, 0x0001 },
|
|
{ 0x3a, 0x0000 },
|
|
{ 0x3b, 0x1020 },
|
|
{ 0x3c, 0x0000 },
|
|
{ 0x3d, 0x0000 },
|
|
{ 0x3e, 0x4c00 },
|
|
{ 0x3f, 0x3000 },
|
|
{ 0x40, 0x000c },
|
|
{ 0x42, 0x0400 },
|
|
{ 0x46, 0xc22c },
|
|
{ 0x47, 0x0000 },
|
|
{ 0x4b, 0x0000 },
|
|
{ 0x4c, 0x0300 },
|
|
{ 0x4f, 0xf000 },
|
|
{ 0x50, 0xc200 },
|
|
{ 0x51, 0x1f1f },
|
|
{ 0x52, 0x01f0 },
|
|
{ 0x53, 0x407f },
|
|
{ 0x54, 0xffff },
|
|
{ 0x58, 0x4005 },
|
|
{ 0x5e, 0x0000 },
|
|
{ 0x5f, 0x0000 },
|
|
{ 0x60, 0xee13 },
|
|
{ 0x62, 0x0000 },
|
|
{ 0x63, 0x5f5f },
|
|
{ 0x64, 0x0040 },
|
|
{ 0x65, 0x4000 },
|
|
{ 0x66, 0x4004 },
|
|
{ 0x67, 0x0306 },
|
|
{ 0x68, 0x8c04 },
|
|
{ 0x69, 0xe021 },
|
|
{ 0x6a, 0x0000 },
|
|
{ 0x6c, 0xaaaa },
|
|
{ 0x70, 0x0333 },
|
|
{ 0x71, 0x3330 },
|
|
{ 0x72, 0x3333 },
|
|
{ 0x73, 0x3300 },
|
|
{ 0x74, 0x0000 },
|
|
{ 0x75, 0x0000 },
|
|
{ 0x76, 0x0000 },
|
|
{ 0x7a, 0x0003 },
|
|
{ 0x7c, 0x10ec },
|
|
{ 0x7e, 0x6251 },
|
|
{ 0x80, 0x0800 },
|
|
{ 0x81, 0x4000 },
|
|
{ 0x82, 0x0000 },
|
|
{ 0x90, 0x7a01 },
|
|
{ 0x91, 0x8431 },
|
|
{ 0x92, 0x0180 },
|
|
{ 0x93, 0x0000 },
|
|
{ 0x94, 0x0000 },
|
|
{ 0x95, 0x0000 },
|
|
{ 0x96, 0x0000 },
|
|
{ 0x97, 0x0000 },
|
|
{ 0x98, 0x0000 },
|
|
{ 0x99, 0x0000 },
|
|
{ 0x9a, 0x0000 },
|
|
{ 0x9b, 0x0000 },
|
|
{ 0x9c, 0x0000 },
|
|
{ 0x9d, 0x0000 },
|
|
{ 0x9e, 0x0000 },
|
|
{ 0x9f, 0x0000 },
|
|
{ 0xa0, 0x0000 },
|
|
{ 0xb0, 0x8200 },
|
|
{ 0xb1, 0x00ff },
|
|
{ 0xb2, 0x0008 },
|
|
{ 0xc0, 0x0200 },
|
|
{ 0xc1, 0x0000 },
|
|
{ 0xc2, 0x0000 },
|
|
{ 0xc3, 0x0000 },
|
|
{ 0xc4, 0x0000 },
|
|
{ 0xc5, 0x0000 },
|
|
{ 0xc6, 0x0000 },
|
|
{ 0xc7, 0x0000 },
|
|
{ 0xc8, 0x0000 },
|
|
{ 0xc9, 0x0000 },
|
|
{ 0xca, 0x0200 },
|
|
{ 0xcb, 0x0000 },
|
|
{ 0xcc, 0x0000 },
|
|
{ 0xcd, 0x0000 },
|
|
{ 0xce, 0x0000 },
|
|
{ 0xcf, 0x0000 },
|
|
{ 0xd0, 0x0000 },
|
|
{ 0xd1, 0x0000 },
|
|
{ 0xd2, 0x0000 },
|
|
{ 0xd3, 0x0000 },
|
|
{ 0xd4, 0x0200 },
|
|
{ 0xd5, 0x0000 },
|
|
{ 0xd6, 0x0000 },
|
|
{ 0xd7, 0x0000 },
|
|
{ 0xd8, 0x0000 },
|
|
{ 0xd9, 0x0000 },
|
|
{ 0xda, 0x0000 },
|
|
{ 0xdb, 0x0000 },
|
|
{ 0xdc, 0x0000 },
|
|
{ 0xdd, 0x0000 },
|
|
{ 0xde, 0x0200 },
|
|
{ 0xdf, 0x0000 },
|
|
{ 0xe0, 0x0000 },
|
|
{ 0xe1, 0x0000 },
|
|
{ 0xe2, 0x0000 },
|
|
{ 0xe3, 0x0000 },
|
|
{ 0xe4, 0x0000 },
|
|
{ 0xe5, 0x0000 },
|
|
{ 0xe6, 0x0000 },
|
|
{ 0xe7, 0x0000 },
|
|
{ 0xe8, 0x0200 },
|
|
{ 0xe9, 0x0000 },
|
|
{ 0xea, 0x0000 },
|
|
{ 0xeb, 0x0000 },
|
|
{ 0xec, 0x0000 },
|
|
{ 0xed, 0x0000 },
|
|
{ 0xee, 0x0000 },
|
|
{ 0xef, 0x0000 },
|
|
{ 0xf0, 0x0000 },
|
|
{ 0xf1, 0x0000 },
|
|
{ 0xf2, 0x0200 },
|
|
{ 0xf3, 0x0000 },
|
|
{ 0xf4, 0x0000 },
|
|
{ 0xf5, 0x0000 },
|
|
{ 0xf6, 0x0000 },
|
|
{ 0xf7, 0x0000 },
|
|
{ 0xf8, 0x0000 },
|
|
{ 0xf9, 0x0000 },
|
|
{ 0xfa, 0x0000 },
|
|
{ 0xfb, 0x0000 },
|
|
};
|
|
|
|
static int rt1305_reg_init(struct snd_soc_component *component)
|
|
{
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
|
|
regmap_multi_reg_write(rt1305->regmap, init_list, RT1305_INIT_REG_LEN);
|
|
return 0;
|
|
}
|
|
|
|
static bool rt1305_volatile_register(struct device *dev, unsigned int reg)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(rt1305_ranges); i++) {
|
|
if (reg >= rt1305_ranges[i].range_min &&
|
|
reg <= rt1305_ranges[i].range_max) {
|
|
return true;
|
|
}
|
|
}
|
|
|
|
switch (reg) {
|
|
case RT1305_RESET:
|
|
case RT1305_SPDIF_IN_SET_1:
|
|
case RT1305_SPDIF_IN_SET_2:
|
|
case RT1305_SPDIF_IN_SET_3:
|
|
case RT1305_POWER_CTRL_2:
|
|
case RT1305_CLOCK_DETECT:
|
|
case RT1305_BIQUAD_SET_1:
|
|
case RT1305_BIQUAD_SET_2:
|
|
case RT1305_EQ_SET_2:
|
|
case RT1305_SPK_TEMP_PROTECTION_0:
|
|
case RT1305_SPK_TEMP_PROTECTION_2:
|
|
case RT1305_SPK_DC_DETECT_1:
|
|
case RT1305_SILENCE_DETECT:
|
|
case RT1305_VERSION_ID:
|
|
case RT1305_VENDOR_ID:
|
|
case RT1305_DEVICE_ID:
|
|
case RT1305_EFUSE_1:
|
|
case RT1305_EFUSE_3:
|
|
case RT1305_DC_CALIB_1:
|
|
case RT1305_DC_CALIB_3:
|
|
case RT1305_DAC_OFFSET_1:
|
|
case RT1305_DAC_OFFSET_2:
|
|
case RT1305_DAC_OFFSET_3:
|
|
case RT1305_DAC_OFFSET_4:
|
|
case RT1305_DAC_OFFSET_5:
|
|
case RT1305_DAC_OFFSET_6:
|
|
case RT1305_DAC_OFFSET_7:
|
|
case RT1305_DAC_OFFSET_8:
|
|
case RT1305_DAC_OFFSET_9:
|
|
case RT1305_DAC_OFFSET_10:
|
|
case RT1305_DAC_OFFSET_11:
|
|
case RT1305_TRIM_1:
|
|
case RT1305_TRIM_2:
|
|
return true;
|
|
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static bool rt1305_readable_register(struct device *dev, unsigned int reg)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(rt1305_ranges); i++) {
|
|
if (reg >= rt1305_ranges[i].range_min &&
|
|
reg <= rt1305_ranges[i].range_max) {
|
|
return true;
|
|
}
|
|
}
|
|
|
|
switch (reg) {
|
|
case RT1305_RESET:
|
|
case RT1305_CLK_1 ... RT1305_CAL_EFUSE_CLOCK:
|
|
case RT1305_PLL0_1 ... RT1305_PLL1_2:
|
|
case RT1305_MIXER_CTRL_1:
|
|
case RT1305_MIXER_CTRL_2:
|
|
case RT1305_DAC_SET_1:
|
|
case RT1305_DAC_SET_2:
|
|
case RT1305_ADC_SET_1:
|
|
case RT1305_ADC_SET_2:
|
|
case RT1305_ADC_SET_3:
|
|
case RT1305_PATH_SET:
|
|
case RT1305_SPDIF_IN_SET_1:
|
|
case RT1305_SPDIF_IN_SET_2:
|
|
case RT1305_SPDIF_IN_SET_3:
|
|
case RT1305_SPDIF_OUT_SET_1:
|
|
case RT1305_SPDIF_OUT_SET_2:
|
|
case RT1305_SPDIF_OUT_SET_3:
|
|
case RT1305_I2S_SET_1:
|
|
case RT1305_I2S_SET_2:
|
|
case RT1305_PBTL_MONO_MODE_SRC:
|
|
case RT1305_MANUALLY_I2C_DEVICE:
|
|
case RT1305_POWER_STATUS:
|
|
case RT1305_POWER_CTRL_1:
|
|
case RT1305_POWER_CTRL_2:
|
|
case RT1305_POWER_CTRL_3:
|
|
case RT1305_POWER_CTRL_4:
|
|
case RT1305_POWER_CTRL_5:
|
|
case RT1305_CLOCK_DETECT:
|
|
case RT1305_BIQUAD_SET_1:
|
|
case RT1305_BIQUAD_SET_2:
|
|
case RT1305_ADJUSTED_HPF_1:
|
|
case RT1305_ADJUSTED_HPF_2:
|
|
case RT1305_EQ_SET_1:
|
|
case RT1305_EQ_SET_2:
|
|
case RT1305_SPK_TEMP_PROTECTION_0:
|
|
case RT1305_SPK_TEMP_PROTECTION_1:
|
|
case RT1305_SPK_TEMP_PROTECTION_2:
|
|
case RT1305_SPK_TEMP_PROTECTION_3:
|
|
case RT1305_SPK_DC_DETECT_1:
|
|
case RT1305_SPK_DC_DETECT_2:
|
|
case RT1305_LOUDNESS:
|
|
case RT1305_THERMAL_FOLD_BACK_1:
|
|
case RT1305_THERMAL_FOLD_BACK_2:
|
|
case RT1305_SILENCE_DETECT ... RT1305_SPK_EXCURSION_LIMITER_7:
|
|
case RT1305_VERSION_ID:
|
|
case RT1305_VENDOR_ID:
|
|
case RT1305_DEVICE_ID:
|
|
case RT1305_EFUSE_1:
|
|
case RT1305_EFUSE_2:
|
|
case RT1305_EFUSE_3:
|
|
case RT1305_DC_CALIB_1:
|
|
case RT1305_DC_CALIB_2:
|
|
case RT1305_DC_CALIB_3:
|
|
case RT1305_DAC_OFFSET_1 ... RT1305_DAC_OFFSET_14:
|
|
case RT1305_TRIM_1:
|
|
case RT1305_TRIM_2:
|
|
case RT1305_TUNE_INTERNAL_OSC:
|
|
case RT1305_BIQUAD1_H0_L_28_16 ... RT1305_BIQUAD3_A2_R_15_0:
|
|
return true;
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -9435, 37, 0);
|
|
|
|
static const char * const rt1305_rx_data_ch_select[] = {
|
|
"LR",
|
|
"RL",
|
|
"Copy L",
|
|
"Copy R",
|
|
};
|
|
|
|
static SOC_ENUM_SINGLE_DECL(rt1305_rx_data_ch_enum, RT1305_I2S_SET_2, 2,
|
|
rt1305_rx_data_ch_select);
|
|
|
|
static void rt1305_reset(struct regmap *regmap)
|
|
{
|
|
regmap_write(regmap, RT1305_RESET, 0);
|
|
}
|
|
|
|
static const struct snd_kcontrol_new rt1305_snd_controls[] = {
|
|
SOC_DOUBLE_TLV("DAC Playback Volume", RT1305_DAC_SET_1,
|
|
8, 0, 0xff, 0, dac_vol_tlv),
|
|
|
|
/* I2S Data Channel Selection */
|
|
SOC_ENUM("RX Channel Select", rt1305_rx_data_ch_enum),
|
|
};
|
|
|
|
static int rt1305_is_rc_clk_from_pll(struct snd_soc_dapm_widget *source,
|
|
struct snd_soc_dapm_widget *sink)
|
|
{
|
|
struct snd_soc_component *component =
|
|
snd_soc_dapm_to_component(source->dapm);
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
unsigned int val;
|
|
|
|
snd_soc_component_read(component, RT1305_CLK_1, &val);
|
|
|
|
if (rt1305->sysclk_src == RT1305_FS_SYS_PRE_S_PLL1 &&
|
|
(val & RT1305_SEL_PLL_SRC_2_RCCLK))
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
static int rt1305_is_sys_clk_from_pll(struct snd_soc_dapm_widget *source,
|
|
struct snd_soc_dapm_widget *sink)
|
|
{
|
|
struct snd_soc_component *component =
|
|
snd_soc_dapm_to_component(source->dapm);
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
|
|
if (rt1305->sysclk_src == RT1305_FS_SYS_PRE_S_PLL1)
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
static int rt1305_classd_event(struct snd_soc_dapm_widget *w,
|
|
struct snd_kcontrol *kcontrol, int event)
|
|
{
|
|
struct snd_soc_component *component =
|
|
snd_soc_dapm_to_component(w->dapm);
|
|
|
|
switch (event) {
|
|
case SND_SOC_DAPM_POST_PMU:
|
|
snd_soc_component_update_bits(component, RT1305_POWER_CTRL_1,
|
|
RT1305_POW_PDB_JD_MASK, RT1305_POW_PDB_JD);
|
|
break;
|
|
case SND_SOC_DAPM_PRE_PMD:
|
|
snd_soc_component_update_bits(component, RT1305_POWER_CTRL_1,
|
|
RT1305_POW_PDB_JD_MASK, 0);
|
|
usleep_range(150000, 200000);
|
|
break;
|
|
|
|
default:
|
|
return 0;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct snd_kcontrol_new rt1305_sto_dac_l =
|
|
SOC_DAPM_SINGLE("Switch", RT1305_DAC_SET_2,
|
|
RT1305_DVOL_MUTE_L_EN_SFT, 1, 1);
|
|
|
|
static const struct snd_kcontrol_new rt1305_sto_dac_r =
|
|
SOC_DAPM_SINGLE("Switch", RT1305_DAC_SET_2,
|
|
RT1305_DVOL_MUTE_R_EN_SFT, 1, 1);
|
|
|
|
static const struct snd_soc_dapm_widget rt1305_dapm_widgets[] = {
|
|
SND_SOC_DAPM_SUPPLY("PLL0", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_PLL0_EN_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("PLL1", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_PLL1_EN_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("MBIAS", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_MBIAS_LV_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("BG MBIAS", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_BG_MBIAS_LV_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("LDO2", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_LDO2_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("BG2", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_BG2_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("LDO2 IB2", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_LDO2_IB2_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("VREF", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_VREF_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("VREF1", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_VREF1_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("VREF2", RT1305_POWER_CTRL_1,
|
|
RT1305_POW_VREF2_BIT, 0, NULL, 0),
|
|
|
|
|
|
SND_SOC_DAPM_SUPPLY("DISC VREF", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_DISC_VREF_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("FASTB VREF", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_FASTB_VREF_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("ULTRA FAST VREF", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_ULTRA_FAST_VREF_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("CHOP DAC", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_CKXEN_DAC_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("CKGEN DAC", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_EN_CKGEN_DAC_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("CLAMP", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_CLAMP_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("BUFL", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_BUFL_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("BUFR", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_BUFR_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("CKGEN ADC", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_EN_CKGEN_ADC_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("ADC3 L", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_ADC3_L_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("ADC3 R", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_ADC3_R_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("TRIOSC", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_TRIOSC_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("AVDD1", RT1305_POWER_CTRL_2,
|
|
RT1305_POR_AVDD1_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("AVDD2", RT1305_POWER_CTRL_2,
|
|
RT1305_POR_AVDD2_BIT, 0, NULL, 0),
|
|
|
|
|
|
SND_SOC_DAPM_SUPPLY("VSENSE R", RT1305_POWER_CTRL_3,
|
|
RT1305_POW_VSENSE_RCH_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("VSENSE L", RT1305_POWER_CTRL_3,
|
|
RT1305_POW_VSENSE_LCH_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("ISENSE R", RT1305_POWER_CTRL_3,
|
|
RT1305_POW_ISENSE_RCH_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("ISENSE L", RT1305_POWER_CTRL_3,
|
|
RT1305_POW_ISENSE_LCH_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("POR AVDD1", RT1305_POWER_CTRL_3,
|
|
RT1305_POW_POR_AVDD1_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("POR AVDD2", RT1305_POWER_CTRL_3,
|
|
RT1305_POW_POR_AVDD2_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("VCM 6172", RT1305_POWER_CTRL_3,
|
|
RT1305_EN_VCM_6172_BIT, 0, NULL, 0),
|
|
|
|
|
|
/* Audio Interface */
|
|
SND_SOC_DAPM_AIF_IN("AIF1RX", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
|
|
|
|
/* Digital Interface */
|
|
SND_SOC_DAPM_SUPPLY("DAC L Power", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_DAC1_L_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_SUPPLY("DAC R Power", RT1305_POWER_CTRL_2,
|
|
RT1305_POW_DAC1_R_BIT, 0, NULL, 0),
|
|
SND_SOC_DAPM_DAC("DAC", NULL, SND_SOC_NOPM, 0, 0),
|
|
SND_SOC_DAPM_SWITCH("DAC L", SND_SOC_NOPM, 0, 0, &rt1305_sto_dac_l),
|
|
SND_SOC_DAPM_SWITCH("DAC R", SND_SOC_NOPM, 0, 0, &rt1305_sto_dac_r),
|
|
|
|
/* Output Lines */
|
|
SND_SOC_DAPM_PGA_E("CLASS D", SND_SOC_NOPM, 0, 0, NULL, 0,
|
|
rt1305_classd_event,
|
|
SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
|
|
SND_SOC_DAPM_OUTPUT("SPOL"),
|
|
SND_SOC_DAPM_OUTPUT("SPOR"),
|
|
};
|
|
|
|
static const struct snd_soc_dapm_route rt1305_dapm_routes[] = {
|
|
|
|
{ "DAC", NULL, "AIF1RX" },
|
|
|
|
{ "DAC", NULL, "PLL0", rt1305_is_rc_clk_from_pll },
|
|
{ "DAC", NULL, "PLL1", rt1305_is_sys_clk_from_pll },
|
|
|
|
{ "DAC", NULL, "MBIAS" },
|
|
{ "DAC", NULL, "BG MBIAS" },
|
|
{ "DAC", NULL, "LDO2" },
|
|
{ "DAC", NULL, "BG2" },
|
|
{ "DAC", NULL, "LDO2 IB2" },
|
|
{ "DAC", NULL, "VREF" },
|
|
{ "DAC", NULL, "VREF1" },
|
|
{ "DAC", NULL, "VREF2" },
|
|
|
|
{ "DAC", NULL, "DISC VREF" },
|
|
{ "DAC", NULL, "FASTB VREF" },
|
|
{ "DAC", NULL, "ULTRA FAST VREF" },
|
|
{ "DAC", NULL, "CHOP DAC" },
|
|
{ "DAC", NULL, "CKGEN DAC" },
|
|
{ "DAC", NULL, "CLAMP" },
|
|
{ "DAC", NULL, "CKGEN ADC" },
|
|
{ "DAC", NULL, "TRIOSC" },
|
|
{ "DAC", NULL, "AVDD1" },
|
|
{ "DAC", NULL, "AVDD2" },
|
|
|
|
{ "DAC", NULL, "POR AVDD1" },
|
|
{ "DAC", NULL, "POR AVDD2" },
|
|
{ "DAC", NULL, "VCM 6172" },
|
|
|
|
{ "DAC L", "Switch", "DAC" },
|
|
{ "DAC R", "Switch", "DAC" },
|
|
|
|
{ "DAC R", NULL, "VSENSE R" },
|
|
{ "DAC L", NULL, "VSENSE L" },
|
|
{ "DAC R", NULL, "ISENSE R" },
|
|
{ "DAC L", NULL, "ISENSE L" },
|
|
{ "DAC L", NULL, "ADC3 L" },
|
|
{ "DAC R", NULL, "ADC3 R" },
|
|
{ "DAC L", NULL, "BUFL" },
|
|
{ "DAC R", NULL, "BUFR" },
|
|
{ "DAC L", NULL, "DAC L Power" },
|
|
{ "DAC R", NULL, "DAC R Power" },
|
|
|
|
{ "CLASS D", NULL, "DAC L" },
|
|
{ "CLASS D", NULL, "DAC R" },
|
|
|
|
{ "SPOL", NULL, "CLASS D" },
|
|
{ "SPOR", NULL, "CLASS D" },
|
|
};
|
|
|
|
static int rt1305_get_clk_info(int sclk, int rate)
|
|
{
|
|
int i, pd[] = {1, 2, 3, 4, 6, 8, 12, 16};
|
|
|
|
if (sclk <= 0 || rate <= 0)
|
|
return -EINVAL;
|
|
|
|
rate = rate << 8;
|
|
for (i = 0; i < ARRAY_SIZE(pd); i++)
|
|
if (sclk == rate * pd[i])
|
|
return i;
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int rt1305_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
|
|
{
|
|
struct snd_soc_component *component = dai->component;
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
unsigned int val_len = 0, val_clk, mask_clk;
|
|
int pre_div, bclk_ms, frame_size;
|
|
|
|
rt1305->lrck = params_rate(params);
|
|
pre_div = rt1305_get_clk_info(rt1305->sysclk, rt1305->lrck);
|
|
if (pre_div < 0) {
|
|
dev_warn(component->dev, "Force using PLL ");
|
|
snd_soc_dai_set_pll(dai, 0, RT1305_PLL1_S_BCLK,
|
|
rt1305->lrck * 64, rt1305->lrck * 256);
|
|
snd_soc_dai_set_sysclk(dai, RT1305_FS_SYS_PRE_S_PLL1,
|
|
rt1305->lrck * 256, SND_SOC_CLOCK_IN);
|
|
pre_div = 0;
|
|
}
|
|
frame_size = snd_soc_params_to_frame_size(params);
|
|
if (frame_size < 0) {
|
|
dev_err(component->dev, "Unsupported frame size: %d\n",
|
|
frame_size);
|
|
return -EINVAL;
|
|
}
|
|
|
|
bclk_ms = frame_size > 32;
|
|
rt1305->bclk = rt1305->lrck * (32 << bclk_ms);
|
|
|
|
dev_dbg(component->dev, "bclk_ms is %d and pre_div is %d for iis %d\n",
|
|
bclk_ms, pre_div, dai->id);
|
|
|
|
dev_dbg(component->dev, "lrck is %dHz and pre_div is %d for iis %d\n",
|
|
rt1305->lrck, pre_div, dai->id);
|
|
|
|
switch (params_width(params)) {
|
|
case 16:
|
|
val_len |= RT1305_I2S_DL_SEL_16B;
|
|
break;
|
|
case 20:
|
|
val_len |= RT1305_I2S_DL_SEL_20B;
|
|
break;
|
|
case 24:
|
|
val_len |= RT1305_I2S_DL_SEL_24B;
|
|
break;
|
|
case 8:
|
|
val_len |= RT1305_I2S_DL_SEL_8B;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (dai->id) {
|
|
case RT1305_AIF1:
|
|
mask_clk = RT1305_DIV_FS_SYS_MASK;
|
|
val_clk = pre_div << RT1305_DIV_FS_SYS_SFT;
|
|
snd_soc_component_update_bits(component, RT1305_I2S_SET_2,
|
|
RT1305_I2S_DL_SEL_MASK,
|
|
val_len);
|
|
break;
|
|
default:
|
|
dev_err(component->dev, "Invalid dai->id: %d\n", dai->id);
|
|
return -EINVAL;
|
|
}
|
|
|
|
snd_soc_component_update_bits(component, RT1305_CLK_2,
|
|
mask_clk, val_clk);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rt1305_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
|
|
{
|
|
struct snd_soc_component *component = dai->component;
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
unsigned int reg_val = 0, reg1_val = 0;
|
|
|
|
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
|
case SND_SOC_DAIFMT_CBM_CFM:
|
|
reg_val |= RT1305_SEL_I2S_OUT_MODE_M;
|
|
rt1305->master = 1;
|
|
break;
|
|
case SND_SOC_DAIFMT_CBS_CFS:
|
|
reg_val |= RT1305_SEL_I2S_OUT_MODE_S;
|
|
rt1305->master = 0;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
|
|
case SND_SOC_DAIFMT_NB_NF:
|
|
break;
|
|
case SND_SOC_DAIFMT_IB_NF:
|
|
reg1_val |= RT1305_I2S_BCLK_INV;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
|
case SND_SOC_DAIFMT_I2S:
|
|
break;
|
|
case SND_SOC_DAIFMT_LEFT_J:
|
|
reg1_val |= RT1305_I2S_DF_SEL_LEFT;
|
|
break;
|
|
case SND_SOC_DAIFMT_DSP_A:
|
|
reg1_val |= RT1305_I2S_DF_SEL_PCM_A;
|
|
break;
|
|
case SND_SOC_DAIFMT_DSP_B:
|
|
reg1_val |= RT1305_I2S_DF_SEL_PCM_B;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (dai->id) {
|
|
case RT1305_AIF1:
|
|
snd_soc_component_update_bits(component, RT1305_I2S_SET_1,
|
|
RT1305_SEL_I2S_OUT_MODE_MASK, reg_val);
|
|
snd_soc_component_update_bits(component, RT1305_I2S_SET_2,
|
|
RT1305_I2S_DF_SEL_MASK | RT1305_I2S_BCLK_MASK,
|
|
reg1_val);
|
|
break;
|
|
default:
|
|
dev_err(component->dev, "Invalid dai->id: %d\n", dai->id);
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int rt1305_set_component_sysclk(struct snd_soc_component *component,
|
|
int clk_id, int source, unsigned int freq, int dir)
|
|
{
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
unsigned int reg_val = 0;
|
|
|
|
if (freq == rt1305->sysclk && clk_id == rt1305->sysclk_src)
|
|
return 0;
|
|
|
|
switch (clk_id) {
|
|
case RT1305_FS_SYS_PRE_S_MCLK:
|
|
reg_val |= RT1305_SEL_FS_SYS_PRE_MCLK;
|
|
snd_soc_component_update_bits(component,
|
|
RT1305_CLOCK_DETECT, RT1305_SEL_CLK_DET_SRC_MASK,
|
|
RT1305_SEL_CLK_DET_SRC_MCLK);
|
|
break;
|
|
case RT1305_FS_SYS_PRE_S_PLL1:
|
|
reg_val |= RT1305_SEL_FS_SYS_PRE_PLL;
|
|
break;
|
|
case RT1305_FS_SYS_PRE_S_RCCLK:
|
|
reg_val |= RT1305_SEL_FS_SYS_PRE_RCCLK;
|
|
break;
|
|
default:
|
|
dev_err(component->dev, "Invalid clock id (%d)\n", clk_id);
|
|
return -EINVAL;
|
|
}
|
|
snd_soc_component_update_bits(component, RT1305_CLK_1,
|
|
RT1305_SEL_FS_SYS_PRE_MASK, reg_val);
|
|
rt1305->sysclk = freq;
|
|
rt1305->sysclk_src = clk_id;
|
|
|
|
dev_dbg(component->dev, "Sysclk is %dHz and clock id is %d\n",
|
|
freq, clk_id);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rt1305_set_component_pll(struct snd_soc_component *component,
|
|
int pll_id, int source, unsigned int freq_in,
|
|
unsigned int freq_out)
|
|
{
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
struct rl6231_pll_code pll_code;
|
|
int ret;
|
|
|
|
if (source == rt1305->pll_src && freq_in == rt1305->pll_in &&
|
|
freq_out == rt1305->pll_out)
|
|
return 0;
|
|
|
|
if (!freq_in || !freq_out) {
|
|
dev_dbg(component->dev, "PLL disabled\n");
|
|
|
|
rt1305->pll_in = 0;
|
|
rt1305->pll_out = 0;
|
|
snd_soc_component_update_bits(component, RT1305_CLK_1,
|
|
RT1305_SEL_FS_SYS_PRE_MASK | RT1305_SEL_PLL_SRC_1_MASK,
|
|
RT1305_SEL_FS_SYS_PRE_PLL | RT1305_SEL_PLL_SRC_1_BCLK);
|
|
return 0;
|
|
}
|
|
|
|
switch (source) {
|
|
case RT1305_PLL2_S_MCLK:
|
|
snd_soc_component_update_bits(component, RT1305_CLK_1,
|
|
RT1305_SEL_PLL_SRC_2_MASK | RT1305_SEL_PLL_SRC_1_MASK |
|
|
RT1305_DIV_PLL_SRC_2_MASK,
|
|
RT1305_SEL_PLL_SRC_2_MCLK | RT1305_SEL_PLL_SRC_1_PLL2);
|
|
snd_soc_component_update_bits(component,
|
|
RT1305_CLOCK_DETECT, RT1305_SEL_CLK_DET_SRC_MASK,
|
|
RT1305_SEL_CLK_DET_SRC_MCLK);
|
|
break;
|
|
case RT1305_PLL1_S_BCLK:
|
|
snd_soc_component_update_bits(component,
|
|
RT1305_CLK_1, RT1305_SEL_PLL_SRC_1_MASK,
|
|
RT1305_SEL_PLL_SRC_1_BCLK);
|
|
break;
|
|
case RT1305_PLL2_S_RCCLK:
|
|
snd_soc_component_update_bits(component, RT1305_CLK_1,
|
|
RT1305_SEL_PLL_SRC_2_MASK | RT1305_SEL_PLL_SRC_1_MASK |
|
|
RT1305_DIV_PLL_SRC_2_MASK,
|
|
RT1305_SEL_PLL_SRC_2_RCCLK | RT1305_SEL_PLL_SRC_1_PLL2);
|
|
freq_in = 98304000;
|
|
break;
|
|
default:
|
|
dev_err(component->dev, "Unknown PLL Source %d\n", source);
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = rl6231_pll_calc(freq_in, freq_out, &pll_code);
|
|
if (ret < 0) {
|
|
dev_err(component->dev, "Unsupport input clock %d\n", freq_in);
|
|
return ret;
|
|
}
|
|
|
|
dev_dbg(component->dev, "bypass=%d m=%d n=%d k=%d\n",
|
|
pll_code.m_bp, (pll_code.m_bp ? 0 : pll_code.m_code),
|
|
pll_code.n_code, pll_code.k_code);
|
|
|
|
snd_soc_component_write(component, RT1305_PLL1_1,
|
|
(pll_code.m_bp ? 0 : pll_code.m_code) << RT1305_PLL_1_M_SFT |
|
|
pll_code.m_bp << RT1305_PLL_1_M_BYPASS_SFT |
|
|
pll_code.n_code);
|
|
snd_soc_component_write(component, RT1305_PLL1_2,
|
|
pll_code.k_code);
|
|
|
|
rt1305->pll_in = freq_in;
|
|
rt1305->pll_out = freq_out;
|
|
rt1305->pll_src = source;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rt1305_probe(struct snd_soc_component *component)
|
|
{
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
|
|
rt1305->component = component;
|
|
|
|
/* initial settings */
|
|
rt1305_reg_init(component);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void rt1305_remove(struct snd_soc_component *component)
|
|
{
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
|
|
rt1305_reset(rt1305->regmap);
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int rt1305_suspend(struct snd_soc_component *component)
|
|
{
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
|
|
regcache_cache_only(rt1305->regmap, true);
|
|
regcache_mark_dirty(rt1305->regmap);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rt1305_resume(struct snd_soc_component *component)
|
|
{
|
|
struct rt1305_priv *rt1305 = snd_soc_component_get_drvdata(component);
|
|
|
|
regcache_cache_only(rt1305->regmap, false);
|
|
regcache_sync(rt1305->regmap);
|
|
|
|
return 0;
|
|
}
|
|
#else
|
|
#define rt1305_suspend NULL
|
|
#define rt1305_resume NULL
|
|
#endif
|
|
|
|
#define RT1305_STEREO_RATES SNDRV_PCM_RATE_8000_192000
|
|
#define RT1305_FORMATS (SNDRV_PCM_FMTBIT_S8 | \
|
|
SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S16_LE | \
|
|
SNDRV_PCM_FMTBIT_S24_LE)
|
|
|
|
static const struct snd_soc_dai_ops rt1305_aif_dai_ops = {
|
|
.hw_params = rt1305_hw_params,
|
|
.set_fmt = rt1305_set_dai_fmt,
|
|
};
|
|
|
|
static struct snd_soc_dai_driver rt1305_dai[] = {
|
|
{
|
|
.name = "rt1305-aif",
|
|
.playback = {
|
|
.stream_name = "AIF1 Playback",
|
|
.channels_min = 1,
|
|
.channels_max = 2,
|
|
.rates = RT1305_STEREO_RATES,
|
|
.formats = RT1305_FORMATS,
|
|
},
|
|
.ops = &rt1305_aif_dai_ops,
|
|
},
|
|
};
|
|
|
|
static const struct snd_soc_component_driver soc_component_dev_rt1305 = {
|
|
.probe = rt1305_probe,
|
|
.remove = rt1305_remove,
|
|
.suspend = rt1305_suspend,
|
|
.resume = rt1305_resume,
|
|
.controls = rt1305_snd_controls,
|
|
.num_controls = ARRAY_SIZE(rt1305_snd_controls),
|
|
.dapm_widgets = rt1305_dapm_widgets,
|
|
.num_dapm_widgets = ARRAY_SIZE(rt1305_dapm_widgets),
|
|
.dapm_routes = rt1305_dapm_routes,
|
|
.num_dapm_routes = ARRAY_SIZE(rt1305_dapm_routes),
|
|
.set_sysclk = rt1305_set_component_sysclk,
|
|
.set_pll = rt1305_set_component_pll,
|
|
.use_pmdown_time = 1,
|
|
.endianness = 1,
|
|
.non_legacy_dai_naming = 1,
|
|
};
|
|
|
|
static const struct regmap_config rt1305_regmap = {
|
|
.reg_bits = 8,
|
|
.val_bits = 16,
|
|
.max_register = RT1305_MAX_REG + 1 + (ARRAY_SIZE(rt1305_ranges) *
|
|
RT1305_PR_SPACING),
|
|
.volatile_reg = rt1305_volatile_register,
|
|
.readable_reg = rt1305_readable_register,
|
|
.cache_type = REGCACHE_RBTREE,
|
|
.reg_defaults = rt1305_reg,
|
|
.num_reg_defaults = ARRAY_SIZE(rt1305_reg),
|
|
.ranges = rt1305_ranges,
|
|
.num_ranges = ARRAY_SIZE(rt1305_ranges),
|
|
.use_single_read = true,
|
|
.use_single_write = true,
|
|
};
|
|
|
|
#if defined(CONFIG_OF)
|
|
static const struct of_device_id rt1305_of_match[] = {
|
|
{ .compatible = "realtek,rt1305", },
|
|
{ .compatible = "realtek,rt1306", },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, rt1305_of_match);
|
|
#endif
|
|
|
|
#ifdef CONFIG_ACPI
|
|
static struct acpi_device_id rt1305_acpi_match[] = {
|
|
{"10EC1305", 0,},
|
|
{"10EC1306", 0,},
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(acpi, rt1305_acpi_match);
|
|
#endif
|
|
|
|
static const struct i2c_device_id rt1305_i2c_id[] = {
|
|
{ "rt1305", 0 },
|
|
{ "rt1306", 0 },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, rt1305_i2c_id);
|
|
|
|
static void rt1305_calibrate(struct rt1305_priv *rt1305)
|
|
{
|
|
unsigned int valmsb, vallsb, offsetl, offsetr;
|
|
unsigned int rh, rl, rhl, r0ohm;
|
|
u64 r0l, r0r;
|
|
|
|
regcache_cache_bypass(rt1305->regmap, true);
|
|
|
|
rt1305_reset(rt1305->regmap);
|
|
regmap_write(rt1305->regmap, RT1305_ADC_SET_3, 0x0219);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xcf, 0x5548);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xc1, 0x0320);
|
|
regmap_write(rt1305->regmap, RT1305_CLOCK_DETECT, 0x1000);
|
|
regmap_write(rt1305->regmap, RT1305_CLK_1, 0x0600);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0xffd0);
|
|
regmap_write(rt1305->regmap, RT1305_EFUSE_1, 0x0080);
|
|
regmap_write(rt1305->regmap, RT1305_EFUSE_1, 0x0880);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_1, 0x0dfe);
|
|
|
|
/* Sin Gen */
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x5d, 0x0442);
|
|
|
|
regmap_write(rt1305->regmap, RT1305_CAL_EFUSE_CLOCK, 0xb000);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xc3, 0xd4a0);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xcc, 0x00cc);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xc1, 0x0320);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_STATUS, 0x0000);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_2, 0xffff);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0xfc20);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x06, 0x00c0);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0xfca0);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0xfce0);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0xfcf0);
|
|
|
|
/* EFUSE read */
|
|
regmap_write(rt1305->regmap, RT1305_EFUSE_1, 0x0080);
|
|
regmap_write(rt1305->regmap, RT1305_EFUSE_1, 0x0880);
|
|
regmap_write(rt1305->regmap, RT1305_EFUSE_1, 0x0880);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0xfce0);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0xfca0);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0xfc20);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x06, 0x0000);
|
|
regmap_write(rt1305->regmap, RT1305_EFUSE_1, 0x0000);
|
|
|
|
regmap_read(rt1305->regmap, RT1305_DAC_OFFSET_5, &valmsb);
|
|
regmap_read(rt1305->regmap, RT1305_DAC_OFFSET_6, &vallsb);
|
|
offsetl = valmsb << 16 | vallsb;
|
|
regmap_read(rt1305->regmap, RT1305_DAC_OFFSET_7, &valmsb);
|
|
regmap_read(rt1305->regmap, RT1305_DAC_OFFSET_8, &vallsb);
|
|
offsetr = valmsb << 16 | vallsb;
|
|
pr_info("DC offsetl=0x%x, offsetr=0x%x\n", offsetl, offsetr);
|
|
|
|
/* R0 calibration */
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x5d, 0x9542);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0xfcf0);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_2, 0xffff);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_1, 0x1dfe);
|
|
regmap_write(rt1305->regmap, RT1305_SILENCE_DETECT, 0x0e13);
|
|
regmap_write(rt1305->regmap, RT1305_CLK_1, 0x0650);
|
|
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x50, 0x0064);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x51, 0x0770);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x52, 0xc30c);
|
|
regmap_write(rt1305->regmap, RT1305_SPK_TEMP_PROTECTION_1, 0x8200);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xd4, 0xfb00);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xd4, 0xff80);
|
|
msleep(2000);
|
|
regmap_read(rt1305->regmap, RT1305_PR_BASE + 0x55, &rh);
|
|
regmap_read(rt1305->regmap, RT1305_PR_BASE + 0x56, &rl);
|
|
rhl = (rh << 16) | rl;
|
|
r0ohm = (rhl*10) / 33554432;
|
|
|
|
pr_debug("Left_rhl = 0x%x rh=0x%x rl=0x%x\n", rhl, rh, rl);
|
|
pr_info("Left channel %d.%dohm\n", (r0ohm/10), (r0ohm%10));
|
|
|
|
r0l = 562949953421312ULL;
|
|
if (rhl != 0)
|
|
do_div(r0l, rhl);
|
|
pr_debug("Left_r0 = 0x%llx\n", r0l);
|
|
|
|
regmap_write(rt1305->regmap, RT1305_SPK_TEMP_PROTECTION_1, 0x9200);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xd4, 0xfb00);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xd4, 0xff80);
|
|
msleep(2000);
|
|
regmap_read(rt1305->regmap, RT1305_PR_BASE + 0x55, &rh);
|
|
regmap_read(rt1305->regmap, RT1305_PR_BASE + 0x56, &rl);
|
|
rhl = (rh << 16) | rl;
|
|
r0ohm = (rhl*10) / 33554432;
|
|
|
|
pr_debug("Right_rhl = 0x%x rh=0x%x rl=0x%x\n", rhl, rh, rl);
|
|
pr_info("Right channel %d.%dohm\n", (r0ohm/10), (r0ohm%10));
|
|
|
|
r0r = 562949953421312ULL;
|
|
if (rhl != 0)
|
|
do_div(r0r, rhl);
|
|
pr_debug("Right_r0 = 0x%llx\n", r0r);
|
|
|
|
regmap_write(rt1305->regmap, RT1305_SPK_TEMP_PROTECTION_1, 0xc2ec);
|
|
|
|
if ((r0l > R0_UPPER) && (r0l < R0_LOWER) &&
|
|
(r0r > R0_UPPER) && (r0r < R0_LOWER)) {
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x4e,
|
|
(r0l >> 16) & 0xffff);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x4f,
|
|
r0l & 0xffff);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xfe,
|
|
((r0r >> 16) & 0xffff) | 0xf800);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0xfd,
|
|
r0r & 0xffff);
|
|
} else {
|
|
pr_err("R0 calibration failed\n");
|
|
}
|
|
|
|
/* restore some registers */
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_1, 0x0dfe);
|
|
usleep_range(200000, 400000);
|
|
regmap_write(rt1305->regmap, RT1305_PR_BASE + 0x5d, 0x0442);
|
|
regmap_write(rt1305->regmap, RT1305_CLOCK_DETECT, 0x3000);
|
|
regmap_write(rt1305->regmap, RT1305_CLK_1, 0x0400);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_1, 0x0000);
|
|
regmap_write(rt1305->regmap, RT1305_CAL_EFUSE_CLOCK, 0x8000);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_2, 0x1020);
|
|
regmap_write(rt1305->regmap, RT1305_POWER_CTRL_3, 0x0000);
|
|
|
|
regcache_cache_bypass(rt1305->regmap, false);
|
|
}
|
|
|
|
static int rt1305_i2c_probe(struct i2c_client *i2c,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
struct rt1305_priv *rt1305;
|
|
int ret;
|
|
unsigned int val;
|
|
|
|
rt1305 = devm_kzalloc(&i2c->dev, sizeof(struct rt1305_priv),
|
|
GFP_KERNEL);
|
|
if (rt1305 == NULL)
|
|
return -ENOMEM;
|
|
|
|
i2c_set_clientdata(i2c, rt1305);
|
|
|
|
rt1305->regmap = devm_regmap_init_i2c(i2c, &rt1305_regmap);
|
|
if (IS_ERR(rt1305->regmap)) {
|
|
ret = PTR_ERR(rt1305->regmap);
|
|
dev_err(&i2c->dev, "Failed to allocate register map: %d\n",
|
|
ret);
|
|
return ret;
|
|
}
|
|
|
|
regmap_read(rt1305->regmap, RT1305_DEVICE_ID, &val);
|
|
if (val != RT1305_DEVICE_ID_NUM) {
|
|
dev_err(&i2c->dev,
|
|
"Device with ID register %x is not rt1305\n", val);
|
|
return -ENODEV;
|
|
}
|
|
|
|
rt1305_reset(rt1305->regmap);
|
|
rt1305_calibrate(rt1305);
|
|
|
|
return devm_snd_soc_register_component(&i2c->dev,
|
|
&soc_component_dev_rt1305,
|
|
rt1305_dai, ARRAY_SIZE(rt1305_dai));
|
|
}
|
|
|
|
static void rt1305_i2c_shutdown(struct i2c_client *client)
|
|
{
|
|
struct rt1305_priv *rt1305 = i2c_get_clientdata(client);
|
|
|
|
rt1305_reset(rt1305->regmap);
|
|
}
|
|
|
|
|
|
static struct i2c_driver rt1305_i2c_driver = {
|
|
.driver = {
|
|
.name = "rt1305",
|
|
#if defined(CONFIG_OF)
|
|
.of_match_table = rt1305_of_match,
|
|
#endif
|
|
#if defined(CONFIG_ACPI)
|
|
.acpi_match_table = ACPI_PTR(rt1305_acpi_match)
|
|
#endif
|
|
},
|
|
.probe = rt1305_i2c_probe,
|
|
.shutdown = rt1305_i2c_shutdown,
|
|
.id_table = rt1305_i2c_id,
|
|
};
|
|
module_i2c_driver(rt1305_i2c_driver);
|
|
|
|
MODULE_DESCRIPTION("ASoC RT1305 amplifier driver");
|
|
MODULE_AUTHOR("Shuming Fan <shumingf@realtek.com>");
|
|
MODULE_LICENSE("GPL v2");
|