From: nengwen.chen <nengwen.chen@amlogic.com>
Date: Mon, 25 Feb 2019 02:10:27 +0000 (+0800)
Subject: atv_demod: Add audio carrier offset detect [1/1]
X-Git-Tag: hardkernel-4.9.236-104~1722
X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=7068b634a195cfd31d38a26b4e7856eaaa402639;p=platform%2Fkernel%2Flinux-amlogic.git

atv_demod: Add audio carrier offset detect [1/1]

PD#TV-2564

Problem:
Torture room teset report SND0810 sound carrier deviation

Solution:
Add audio carrier offset detect

Verify:
verified by x301

Change-Id: I2d715891fb268452f95e05f998864e9b7321ff38
Signed-off-by: nengwen.chen <nengwen.chen@amlogic.com>
---

diff --git a/drivers/amlogic/atv_demod/atv_demod_debug.c b/drivers/amlogic/atv_demod/atv_demod_debug.c
index 551ef3b..6535e09 100644
--- a/drivers/amlogic/atv_demod/atv_demod_debug.c
+++ b/drivers/amlogic/atv_demod/atv_demod_debug.c
@@ -57,6 +57,7 @@
 	DEBUGFS_CREATE_NODE(over_threshold, 0640, dentry, u64)\
 	DEBUGFS_CREATE_NODE(input_amplitude, 0640, dentry, u64)\
 	DEBUGFS_CREATE_NODE(atvaudio_det_outputmode_en, 0640, dentry, bool)\
+	DEBUGFS_CREATE_NODE(audio_carrier_offset_det_en, 0640, dentry, bool)\
 	DEBUGFS_CREATE_NODE(audio_det_en, 0640, dentry, bool)\
 	DEBUGFS_CREATE_NODE(non_std_en, 0640, dentry, u32)\
 	DEBUGFS_CREATE_NODE(atvdemod_det_nonstd_en, 0640, dentry, bool)\
diff --git a/drivers/amlogic/atv_demod/atv_demod_monitor.c b/drivers/amlogic/atv_demod/atv_demod_monitor.c
index 240a043..0ebc929 100644
--- a/drivers/amlogic/atv_demod/atv_demod_monitor.c
+++ b/drivers/amlogic/atv_demod/atv_demod_monitor.c
@@ -34,6 +34,7 @@ bool atvdemod_det_snr_en = true;
 bool audio_thd_en = true;
 bool atvdemod_det_nonstd_en;
 bool atvaudio_det_outputmode_en = true;
+bool audio_carrier_offset_det_en;
 
 unsigned int atvdemod_timer_delay = 100; /* 1s */
 unsigned int atvdemod_timer_delay2 = 10; /* 100ms */
@@ -70,6 +71,9 @@ static void atv_demod_monitor_do_work(struct work_struct *work)
 	if (atvaudio_det_outputmode_en)
 		atvauddemod_set_outputmode();
 
+	if (audio_carrier_offset_det_en)
+		audio_carrier_offset_det();
+
 	if (atvdemod_det_nonstd_en)
 		atv_dmd_non_std_set(true);
 }
diff --git a/drivers/amlogic/atv_demod/atvauddemod_func.c b/drivers/amlogic/atv_demod/atvauddemod_func.c
index 76fea6a..93a3f25 100644
--- a/drivers/amlogic/atv_demod/atvauddemod_func.c
+++ b/drivers/amlogic/atv_demod/atvauddemod_func.c
@@ -60,7 +60,12 @@ static int last_mode = -1;
 #undef pr_info
 #define pr_info(args...)\
 	do {\
-		if (ademod_debug_en)\
+		if (ademod_debug_en & 0x1)\
+			printk(args);\
+	} while (0)
+#define pr_carr(args...)\
+	do {\
+		if (ademod_debug_en & 0x2)\
 			printk(args);\
 	} while (0)
 #undef pr_dbg
@@ -1469,6 +1474,37 @@ void audio_thd_det(void)
 	}
 }
 
+void audio_carrier_offset_det(void)
+{
+	unsigned int carrier_freq = 0, report = 0;
+	int threshold = 0;
+
+	report = adec_rd_reg(DC_REPORT);
+	carrier_freq = adec_rd_reg(ADDR_DDC_FREQ0);
+
+	pr_carr("\n\nreport: 0x%x.\n", report);
+	pr_carr("read carrier_freq: 0x%x.\n", carrier_freq);
+	report = report & 0xFFFF;
+
+	if (report > (1 << 15))
+		threshold = report - (1 << 16);
+	else
+		threshold = report;
+
+	threshold = threshold >> 8;
+	pr_carr("threshold: %d.\n", threshold);
+
+	if (threshold > 30) {
+		carrier_freq = carrier_freq - 0x100;
+		adec_wr_reg(ADDR_DDC_FREQ0, carrier_freq);
+	} else if (threshold < -30) {
+		carrier_freq = carrier_freq + 0x100;
+		adec_wr_reg(ADDR_DDC_FREQ0, carrier_freq);
+	}
+
+	pr_carr("write carrier_freq: 0x%x.\n", carrier_freq);
+}
+
 void set_outputmode_status_init(void)
 {
 	last_nicam_lock = -1;
diff --git a/drivers/amlogic/atv_demod/atvauddemod_func.h b/drivers/amlogic/atv_demod/atvauddemod_func.h
index 361b556..c71037f 100644
--- a/drivers/amlogic/atv_demod/atvauddemod_func.h
+++ b/drivers/amlogic/atv_demod/atvauddemod_func.h
@@ -32,6 +32,7 @@ void configure_adec(int Audio_mode);
 void adec_soft_reset(void);
 void audio_thd_init(void);
 void audio_thd_det(void);
+void audio_carrier_offset_det(void);
 void set_nicam_outputmode(uint32_t outmode);
 void set_a2_eiaj_outputmode(uint32_t outmode);
 void set_btsc_outputmode(uint32_t outmode);