1182 lines
		
	
	
		
			32 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1182 lines
		
	
	
		
			32 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-only
 | |
| /*
 | |
|  * rt1305.c  --  RT1305 ALSA SoC amplifier component driver
 | |
|  *
 | |
|  * Copyright 2018 Realtek Semiconductor Corp.
 | |
|  * Author: Shuming Fan <shumingf@realtek.com>
 | |
|  */
 | |
| 
 | |
| #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;
 | |
| 
 | |
| 	val = snd_soc_component_read(component, RT1305_CLK_1);
 | |
| 
 | |
| 	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;
 | |
| 	static const int 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, "Unsupported 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,
 | |
| };
 | |
| 
 | |
| 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 const 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)
 | |
| {
 | |
| 	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_new = 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");
 |