drivers/media/dtv_demod/atsc/atsc_func.c

// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
/*
 * Copyright (c) 2021 Amlogic, Inc. All rights reserved.
 */

#include "demod_func.h"
#include "aml_demod.h"
#include "atsc_func.h"
#include <linux/string.h>
#include <linux/kernel.h>
#include <linux/mutex.h>

MODULE_PARM_DESC(debug_atsc, "\n\t\t Enable frontend atsc debug information");
static int debug_atsc = 1;
module_param(debug_atsc, int, 0644);

MODULE_PARM_DESC(atsc_thread_enable, "\n\t\t Enable frontend debug information");
static int atsc_thread_enable = 1;
module_param(atsc_thread_enable, int, 0644);

MODULE_PARM_DESC(ar_enable, "\n\t\t Enable ar");
static int ar_enable;
module_param(ar_enable, int, 0644);

MODULE_PARM_DESC(cci_enable, "\n\t\t Enable ar");
static int cci_enable = 1;
module_param(cci_enable, int, 0644);

MODULE_PARM_DESC(cfo_count, "\n\t\t cfo_count");
static int cfo_count;
module_param(cfo_count, int, 0644);

MODULE_PARM_DESC(field_test_version, "\n\t\t field_test_version");
static int field_test_version;
module_param(field_test_version, int, 0644);

MODULE_PARM_DESC(cfo_times, "\n\t\t cfo_times");
static int cfo_times = 30;
module_param(cfo_times, int, 0644);

static int dagc_switch;
static int ar_flag;
static int awgn_flag;

/* 8vsb */
static struct atsc_cfg list_8vsb[22] = {
	{0x0733, 0x00, 0},
	{0x0734, 0xff, 0},
	{0x0716, 0x02, 0},	/* F06[7] invert spectrum  0x02 0x06 */
	{0x05e7, 0x00, 0},
	{0x05e8, 0x00, 0},
	{0x0f06, 0x80, 0},
	{0x0f09, 0x04, 0},
	{0x070c, 0x18, 0},
	{0x070d, 0x9d, 0},
	{0x070e, 0x89, 0},
	{0x070f, 0x6a, 0},
	{0x0710, 0x75, 0},
	{0x0711, 0x6f, 0},
	{0x072a, 0x02, 0},
	{0x072c, 0x02, 0},
	{0x090d, 0x03, 0},
	{0x090e, 0x02, 0},
	{0x090f, 0x00, 0},
	{0x0900, 0x01, 0},
	{0x0900, 0x00, 0},
	{0x0f00, 0x01, 0},
	{0x0000, 0x00, 1}
};

/* 64qam */
static struct atsc_cfg list_qam64[111] = {
	{0x0900, 0x01, 0},
	{0x0f04, 0x08, 0},
	{0x0f06, 0x80, 0},
	{0x0f07, 0x00, 0},
	{0x0f00, 0xe0, 0},
	{0x0f00, 0xec, 0},
	{0x0001, 0x05, 0},
	{0x0002, 0x61, 0},	/* /0x61 invert spectrum */
	{0x0003, 0x3e, 0},
	{0x0004, 0xed, 0},	/* 0x9d */
	{0x0005, 0x10, 0},
	{0x0006, 0xc0, 0},
	{0x0007, 0x5c, 0},
	{0x0008, 0x0f, 0},
	{0x0009, 0x4f, 0},
	{0x000a, 0xfc, 0},
	{0x000b, 0x0c, 0},
	{0x000c, 0x6c, 0},
	{0x000d, 0x3a, 0},
	{0x000e, 0x10, 0},
	{0x000f, 0x02, 0},
	{0x0011, 0x00, 0},
	{0x0012, 0xf5, 0},
	{0x0013, 0x74, 0},
	{0x0014, 0xb9, 0},
	{0x0015, 0x1f, 0},
	{0x0016, 0x80, 0},
	{0x0017, 0x1f, 0},
	{0x0018, 0x0f, 0},
	{0x001e, 0x00, 0},
	{0x001f, 0x00, 0},
	{0x0023, 0x03, 0},
	{0x0025, 0x20, 0},
	{0x0026, 0xff, 0},
	{0x0027, 0xff, 0},
	{0x0028, 0xf8, 0},
	{0x0200, 0x20, 0},
	{0x0201, 0x62, 0},
	{0x0202, 0x23, 0},
	{0x0204, 0x19, 0},
	{0x0205, 0x74, 0},
	{0x0206, 0xab, 0},
	{0x0207, 0xff, 0},
	{0x0208, 0xc0, 0},
	{0x0209, 0xff, 0},
	{0x0211, 0xc0, 0},
	{0x0212, 0xb0, 0},
	{0x0213, 0x05, 0},
	{0x0215, 0x08, 0},
	{0x0222, 0xe0, 0},
	{0x0223, 0xf0, 0},
	{0x0226, 0x40, 0},
	{0x0229, 0x23, 0},
	{0x022a, 0x02, 0},
	{0x022c, 0x01, 0},
	{0x022e, 0x01, 0},
	{0x022f, 0x25, 0},
	{0x0230, 0x40, 0},
	{0x0231, 0x01, 0},
	{0x0734, 0xff, 0},
	{0x073a, 0xff, 0},
	{0x073b, 0x04, 0},
	{0x073c, 0x08, 0},
	{0x073d, 0x08, 0},
	{0x073e, 0x01, 0},
	{0x073f, 0xf8, 0},
	{0x0740, 0xf1, 0},
	{0x0741, 0xf3, 0},
	{0x0742, 0xff, 0},
	{0x0743, 0x0f, 0},
	{0x0744, 0x1a, 0},
	{0x0745, 0x16, 0},
	{0x0746, 0x00, 0},
	{0x0747, 0xe3, 0},
	{0x0748, 0xce, 0},
	{0x0749, 0xd4, 0},
	{0x074a, 0x00, 0},
	{0x074b, 0x4b, 0},
	{0x074c, 0x00, 0},
	{0x074d, 0xa2, 0},
	{0x074e, 0x00, 0},
	{0x074f, 0xe6, 0},
	{0x0750, 0x00, 0},
	{0x0751, 0x00, 0},
	{0x0752, 0x01, 0},
	{0x0753, 0x03, 0},
	{0x0400, 0x00, 0},
	{0x0408, 0x04, 0},
	{0x040e, 0xe0, 0},
	{0x0500, 0x02, 0},
	{0x05e7, 0x00, 0},
	{0x05e8, 0x00, 0},
	{0x0f09, 0x18, 0},
	{0x070c, 0x20, 0},
	{0x070d, 0x41, 0},	/* 0x49 */
	{0x070e, 0x04, 0},	/* 0x37 */
	{0x070f, 0x00, 0},
	{0x0710, 0x00, 0},
	{0x0711, 0x00, 0},
	{0x0716, 0xf0, 0},
	{0x090f, 0x00, 0},
	{0x0900, 0x01, 1},
	{0x0900, 0x00, 0},
	{0x0001, 0xf5, 0},
	{0x0001, 0xf5, 1},
	{0x0001, 0xf5, 1},
	{0x0001, 0xf5, 1},
	{0x0001, 0xf5, 1},
	{0x0001, 0x05, 0},
	{0x0001, 0x05, 1},
	{0x0000, 0x00, 1}
};

/* 256qam */
static struct atsc_cfg list_qam256[113] = {
	{0x0900, 0x01, 0},
	{0x0f04, 0x08, 0},
	{0x0f06, 0x80, 0},
	{0x0f00, 0xe0, 0},
	{0x0f00, 0xec, 0},
	{0x0001, 0x05, 0},
	{0x0002, 0x01, 0},	/* 0x09 */
	{0x0003, 0x2c, 0},
	{0x0004, 0x91, 0},
	{0x0005, 0x10, 0},
	{0x0006, 0xc0, 0},
	{0x0007, 0x5c, 0},
	{0x0008, 0x0f, 0},
	{0x0009, 0x4f, 0},
	{0x000a, 0xfc, 0},
	{0x000b, 0x0c, 0},
	{0x000c, 0x6c, 0},
	{0x000d, 0x3a, 0},
	{0x000e, 0x10, 0},
	{0x000f, 0x02, 0},
	{0x0011, 0x80, 0},
	{0x0012, 0xf5, 0},	/* a5 */
	{0x0013, 0x74, 0},
	{0x0014, 0xb9, 0},
	{0x0015, 0x1f, 0},
	{0x0016, 0x80, 0},
	{0x0017, 0x1f, 0},
	{0x0018, 0x0f, 0},
	{0x001e, 0x00, 0},
	{0x001f, 0x00, 0},
	{0x0023, 0x03, 0},
	{0x0025, 0x20, 0},
	{0x0026, 0xff, 0},
	{0x0027, 0xff, 0},
	{0x0028, 0xf8, 0},
	{0x0200, 0x20, 0},
	{0x0201, 0x62, 0},
	{0x0202, 0x23, 0},
	{0x0204, 0x19, 0},
	{0x0205, 0x76, 0},
	{0x0206, 0xd2, 0},
	{0x0207, 0xff, 0},
	{0x0208, 0xc0, 0},
	{0x0209, 0xff, 0},
	{0x0211, 0xc0, 0},
	{0x0212, 0xb0, 0},
	{0x0213, 0x05, 0},
	{0x0215, 0x08, 0},
	{0x0222, 0xf0, 0},
	{0x0223, 0xff, 0},
	{0x0226, 0x40, 0},
	{0x0229, 0x23, 0},
	{0x022a, 0x02, 0},
	{0x022c, 0x01, 0},
	{0x022e, 0x01, 0},
	{0x022f, 0x05, 0},
	{0x0230, 0x40, 0},
	{0x0231, 0x01, 0},
	{0x0400, 0x02, 0},
	{0x0401, 0x30, 0},
	{0x0402, 0x13, 0},
	{0x0406, 0x06, 0},
	{0x0408, 0x04, 0},
	{0x040e, 0xe0, 0},
	{0x0411, 0x02, 0},
	{0x073a, 0x02, 0},
	{0x073b, 0x09, 0},
	{0x073c, 0x0c, 0},
	{0x073d, 0x08, 0},
	{0x073e, 0xfd, 0},
	{0x073f, 0xf2, 0},
	{0x0740, 0xed, 0},
	{0x0741, 0xf4, 0},
	{0x0742, 0x03, 0},
	{0x0743, 0x15, 0},
	{0x0744, 0x1d, 0},
	{0x0745, 0x15, 0},
	{0x0746, 0xfc, 0},
	{0x0747, 0xde, 0},
	{0x0748, 0xcc, 0},
	{0x0749, 0xd6, 0},
	{0x074a, 0x04, 0},
	{0x074b, 0x4f, 0},
	{0x074c, 0x00, 0},
	{0x074d, 0xa2, 0},
	{0x074e, 0x00, 0},
	{0x074f, 0xe3, 0},
	{0x0750, 0x00, 0},
	{0x0751, 0xfc, 0},
	{0x0752, 0x00, 0},
	{0x0753, 0x03, 0},
	{0x0500, 0x02, 0},
	{0x05e7, 0x00, 0},
	{0x05e8, 0x00, 0},
	{0x0f09, 0x18, 0},
	{0x070c, 0x20, 0},
	{0x070d, 0x49, 0},
	{0x070e, 0x37, 0},
	{0x070f, 0x00, 0},
	{0x0710, 0x00, 0},
	{0x0711, 0x00, 0},
	{0x0716, 0xf0, 0},
	{0x090f, 0x00, 0},
	{0x0900, 0x01, 1},
	{0x0900, 0x00, 0},
	{0x0001, 0xf5, 0},
	{0x0001, 0xf5, 1},
	{0x0001, 0xf5, 1},
	{0x0001, 0xf5, 1},
	{0x0001, 0xf5, 1},
	{0x0001, 0x05, 0},
	{0x0001, 0x05, 1},
	{0x0000, 0x00, 1}
};

unsigned int SNR_table[56] = {
		0, 7, 9, 11, 14,
		17, 22, 27, 34, 43, 54,
		68, 86, 108, 136, 171,
		215, 271, 341, 429, 540,
		566, 592, 620, 649, 680,
		712, 746, 781, 818, 856,
		896, 939, 983, 1029, 1078,
		1182, 1237, 1237, 1296, 1357,
		1708, 2150, 2707, 3408, 4291,
		5402, 6800, 8561, 10778, 13568,
		16312, 17081, 18081, 19081, 65536
};

unsigned int SNR_dB_table[56] = {
			360, 350, 340, 330, 320,
			310, 300, 290, 280, 270, 260,
			250, 240, 230, 220, 210,
			200, 190, 180, 170, 160,
			158, 156, 154, 152, 150,
			148, 146, 144, 142, 140,
			138, 136, 134, 132, 130,
			128, 126, 124, 122, 120,
			110, 100, 90, 80, 70,
			60, 50, 40, 30, 20,
			12, 10, 4, 2, 0
};

void atsc_set_version(int version)
{
	if (version == 1)
		field_test_version = 1;
	else if (version == 2)
		field_test_version = 0;
	else
		field_test_version = 1;
}

int app_apb_read_reg(int addr)
{
	addr = ATSC_TOP_ADDR(addr);
	return (int)demod_read_demod_reg(addr);
}

int app_apb_write_reg(int addr, int data)
{
	addr = ATSC_TOP_ADDR(addr);
	demod_set_demod_reg(data, addr);
	return 0;
}

/*int atsc_qam_set(fe_modulation_t mode)*/
int atsc_qam_set(enum fe_modulation mode)

{
	int i, j;

	if (mode == VSB_8) {	/* 5-8vsb, 2-64qam, 4-256qam */
		for (i = 0; list_8vsb[i].adr != 0; i++) {
			if (list_8vsb[i].rw)
				atsc_read_reg(list_8vsb[i].adr);
			/* msleep(20); */
			else
				atsc_write_reg(list_8vsb[i].adr,
					       list_8vsb[i].dat);
			/* msleep(20); */
		}
		j = 15589;
		PR_ATSC("8-vsb mode\n");
	} else if (mode == QAM_64) {
		for (i = 0; list_qam64[i].adr != 0; i++) {
			if (list_qam64[i].rw) {
				atsc_read_reg(list_qam64[i].adr);
				msleep(20);
			} else {
				atsc_write_reg(list_qam64[i].adr,
					       list_qam64[i].dat);
				msleep(20);
			}
		}
		j = 16588;	/* 33177; */
		PR_ATSC("64qam mode\n");
	} else if (mode == QAM_256) {
		for (i = 0; list_qam256[i].adr != 0; i++) {
			if (list_qam256[i].rw) {
				atsc_read_reg(list_qam256[i].adr);
				msleep(20);
			} else {
				atsc_write_reg(list_qam256[i].adr,
					       list_qam256[i].dat);
				msleep(20);
			}
		}
		j = 15649;	/* 31298; */
		PR_ATSC("256qam mode\n");
	} else {
		for (i = 0; list_qam256[i].adr != 0; i++) {
			if (list_qam256[i].rw) {
				atsc_read_reg(list_qam256[i].adr);
				msleep(20);
			} else {
				atsc_write_reg(list_qam256[i].adr,
					       list_qam256[i].dat);
				msleep(20);
			}
		}
		j = 15649;	/* 31298; */
		PR_ATSC("256qam mode\n");
	}
	return j;
}

int read_snr_atsc_tune(void)
{
	unsigned int SNR;
	unsigned int SNR_dB;
	int tmp[3];

	tmp[0] = atsc_read_reg(0x0511);
	tmp[1] = atsc_read_reg(0x0512);
	SNR = (tmp[0] << 8) + tmp[1];
	SNR_dB = SNR_dB_table[atsc_find(SNR, SNR_table, 56)];
	return SNR_dB;
}

void set_cr_ck_rate(void)
{
	atsc_write_reg(0x0f07, 0x21);/*0x50*/
	/*25M ADC B2*/
	/*atsc_write_reg(0x070c, 0x19);*/
	/*atsc_write_reg(0x070d, 0x30);*/
	/*atsc_write_reg(0x070e, 0xbe);*/
	/*atsc_write_reg(0x070f, 0x52);*/
	/*atsc_write_reg(0x0710, 0xab);*/
	/*atsc_write_reg(0x0711, 0xfe);*/
	/*24M Crystal*/
	atsc_write_reg(0x70c, 0x1a);
	atsc_write_reg(0x70d, 0xaa);
	atsc_write_reg(0x70e, 0xaa);
	atsc_write_reg(0x70f, 0x3a);
	atsc_write_reg(0x710, 0xe5);
	atsc_write_reg(0x711, 0xc9);
	atsc_write_reg(0x0f06, 0x00);
	atsc_write_reg(0x0580, 0x01);
	atsc_write_reg(0x0520, 0x09);
	atsc_write_reg(0x0f28, 0x0f);
	atsc_write_reg(0x0f2d, 0x80);
	atsc_write_reg(0x0f2b, 0x04);
	atsc_write_reg(0x07f0, 0x31);
	atsc_write_reg(0x07f1, 0x31);
	atsc_write_reg(0x07f2, 0x31);
	atsc_write_reg(0x07f3, 0x31);
	atsc_write_reg(0x07f4, 0x31);
	atsc_write_reg(0x07f5, 0x31);
	atsc_write_reg(0x07f6, 0x31);
	atsc_write_reg(0x072c, 0x04);
	/* 50 ck confirm cnt*/
	atsc_write_reg(0x054f, 0x20);
	/* 76 timeout cnt*/
	atsc_write_reg(0x0550, 0x02);
	/* 77 timeout cnt */
	atsc_write_reg(0x0572, 0x18);
	/* 77 timeout cnt */
	atsc_write_reg(0x0556, 0x04);
	/* DFE sz for 75    */
	atsc_write_reg(0x0557, 0x04);
	/*  DFE sz for 76    */
	atsc_write_reg(0x055a, 0x04);
	/* DFE sz for 79   MUST  */
	atsc_write_reg(0x0f33, 0x33);
	/*  FA stepsize 0.5 MUST */
	atsc_write_reg(0x0f32, 0x33);
	/* FA stepsize 0.5 MUST  */
	atsc_write_reg(0x0f31, 0x33);
	/* FA stepsize 0.5 MUST */
	atsc_write_reg(0x0912, 0xf0);
	/* FA stepsize 0.5 MUST  */
	atsc_write_reg(0x0555, 0x02);
	/* FA stepsize 0.5 MUST  */
	atsc_write_reg(0x053c, 0x0e);
	/* FA stepsize 0.5 MUST */
	atsc_write_reg(0x053d, 0x0e);
	/* FA stepsize 0.5 MUST  */
	atsc_write_reg(0x053b, 0x0d);
	atsc_write_reg(0x057b, 0x01);
	atsc_write_reg(0x057a, 0x0d);
	atsc_write_reg(0x0f6f, 0x81);
	atsc_write_reg(0x0735, 0x83);
	atsc_write_reg(0x0f6a, 0x00);
	atsc_write_reg(0x0724, 0x00);
	/* PN 2cond correlation threshold ,*/
	/* case138 fail if it is default 16  */
	atsc_write_reg(0x0552, 0x10);
	/* FSM79 TO cnt  */
	atsc_write_reg(0x0551, 0x30);
	/* FSM78 TO cnt  */
	atsc_write_reg(0x050e, 0x20);
	/* FSM77 TO thres 10dB  */
	atsc_write_reg(0x050f, 0x1a);
	/* FSM78 TO thres 11dB  */
	atsc_write_reg(0x0510, 0x1a);
	/* FSM78 TO thres 11dB  */
	atsc_write_reg(0x05f2, 0x82);
	/* decrease lock time 0x88->0x82  */
	atsc_write_reg(0x05f3, 0x82);
	/* decrease lock time 0x88->0x82  */
	atsc_write_reg(0x736,  0x60);
	atsc_write_reg(0x737,  0x00);
	atsc_write_reg(0x738,  0x00);
	atsc_write_reg(0x739,  0x00);
	atsc_write_reg(0x735,  0x83);
	atsc_write_reg(0x918,  0x0);

	/*filed test bug in sfo*/
	atsc_write_reg(0x53b,  0x0b);
	atsc_write_reg(0x545,  0x0);
	atsc_write_reg(0x546,  0x80);

	if (!field_test_version) {
		/*improve phase nosie 20170820*/
		atsc_write_reg(0x912,  0x10);
		atsc_write_reg(0xf55,  0x00);
		atsc_write_reg(0xf56,  0x00);
		atsc_write_reg(0xf57,  0x00);
		/*improve impulse nosie 20170820*/
		atsc_write_reg(0x546,  0xa0);
		/*improve awgn*/
		atsc_write_reg(0x52d,  0x04);
		atsc_write_reg(0x562,  0x0b);
		atsc_write_reg(0x53b,  0x0d);
		atsc_write_reg(0x735,  0x00);

		/*r2,2 case*/
		atsc_write_reg(0x505, 0x19);
		atsc_write_reg(0x506, 0x15);
		atsc_write_reg(0xf6f, 0xc0);
		atsc_write_reg(0xf6e, 0x09);
		atsc_write_reg(0x562, 0x08);

		if (awgn_flag == TASK4_TASK5)
			atsc_set_performance_register(TASK4_TASK5, 1);
		else if (awgn_flag == AWGN)
			atsc_set_performance_register(AWGN, 1);
		else if (awgn_flag == TASK4_TASK5)
			atsc_set_performance_register(TASK8_R22, 1);
		atsc_write_reg(0x716, atsc_read_reg(0x716) | 0x02);
	} else {
		PR_ATSC("!!!!!! field test !!!!!!!!!");
		atsc_write_reg(0x716, atsc_read_reg(0x716) | 0x02);
		atsc_write_reg(0x552, 0x20);
		atsc_write_reg(0x551, 0x28);
		atsc_write_reg(0x550, 0x08);
		atsc_write_reg(0x54f, 0x08);
		atsc_write_reg(0x54e, 0x08);
		atsc_write_reg(0x54d, 0x08);
		atsc_write_reg(0x54c, 0x08);
		atsc_write_reg(0x53b, 0x0e);
		atsc_write_reg(0x912, 0x50);
	}

	ar_flag = 0;
}

void atsc_initial(struct aml_demod_sta *demod_sta)
{
	int fc, fs, cr, ck, j;
	enum fe_modulation mode;

	mode = demod_sta->ch_mode;

	j = atsc_qam_set(mode);	/* set mode */

	fs = demod_sta->adc_freq;	/* KHZ 25200 */
	fc = demod_sta->ch_if;	/* KHZ 6350 */

	cr = (fc * (1 << 17) / fs) * (1 << 6);
	ck = fs * j / 10 - (1 << 25);
	/* ck_rate = (f_samp / f_vsb /2 -1)*(1<<25);*/
	/*double f_vsb = 10.76238;// double f_64q = 5.056941;*/
	/* // double f_256q = 5.360537; */

	atsc_write_reg(0x070e, cr & 0xff);
	atsc_write_reg(0x070d, (cr >> 8) & 0xff);
	atsc_write_reg(0x070c, (cr >> 16) & 0xff);

	if (demod_sta->ch_mode == VSB_8) {
		atsc_write_reg(0x0711, ck & 0xff);
		atsc_write_reg(0x0710, (ck >> 8) & 0xff);
		atsc_write_reg(0x070f, (ck >> 16) & 0xff);
	}
	PR_ATSC("0x70e is %x, 0x70d is %x, 0x70c is %x\n",
		cr & 0xff, (cr >> 8) & 0xff, (cr >> 16) & 0xff);
	PR_ATSC("fs is %d(SR),fc is %d(IF),cr is %x,ck is %x\n",
				fs, fc, cr, ck);
}

int atsc_set_ch(struct aml_dtvdemod *demod,
		struct aml_demod_atsc *demod_atsc)
{
	int ret = 0;
	u8 demod_mode;
	u8 bw, sr, ifreq, agc_mode;
	u32 ch_freq;

	bw = demod_atsc->bw;
	sr = demod_atsc->sr;
	ifreq = demod_atsc->ifreq;
	agc_mode = demod_atsc->agc_mode;
	ch_freq = demod_atsc->ch_freq;
	demod_mode = demod_atsc->dat0;
	demod->demod_status.ch_mode = demod_atsc->mode; /* TODO */
	demod->demod_status.agc_mode = agc_mode;
	demod->demod_status.ch_freq = ch_freq;
	demod->demod_status.ch_bw = (8 - bw) * 1000;
	/*atsc_initial(demod_sta);*/
	set_cr_ck_rate();
	atsc_reset();
	/*set_cr_ck_rate();*/
	dagc_switch = Dagc_Open;
	PR_ATSC("ATSC mode\n");
	return ret;
}

int read_atsc_fsm(void)
{
	return atsc_read_reg(0x980);
}

unsigned int atsc_read_ser(void)
{
	unsigned int ser;

	if (cpu_after_eq(MESON_CPU_MAJOR_ID_TL1))
		ser = atsc_read_reg_v4(ATSC_FEC_REG_0XFB);
	else
		ser = atsc_read_reg(0x0687) + (atsc_read_reg(0x0686) << 8) +
			(atsc_read_reg(0x0685) << 16) +	(atsc_read_reg(0x0684) << 24);

	return ser;
}

unsigned int atsc_read_ck(void)
{
	unsigned int ck;

	ck = atsc_read_reg_v4(ATSC_DEMOD_REG_0X75);

	return ck;
}

int atsc_find(unsigned int data, unsigned int *ptable, int len)
{
	int end;
	int index;
	int start;
	int cnt = 0;

	start = 0;
	end = len;
	while ((len > 1) && (cnt < 10)) {
		cnt++;
		index = (len / 2);
		if (data > ptable[start + index]) {
			start = start + index;
			len = len - index;
		} else if (data < ptable[start + index]) {
			len = index;
		} else if (data == ptable[start + index]) {
			start = start + index;
			break;
		}
	}
	return start;
}

void atsc_reset(void)
{
	atsc_write_reg(0x0900, 0x01);
	msleep(20);
	atsc_write_reg(0x0900, 0x00);
}

int atsc_read_snr_10(void)
{
	int snr;
	int snr_db;

	if (cpu_after_eq(MESON_CPU_MAJOR_ID_TL1))
		snr = atsc_read_reg_v4(ATSC_EQ_REG_0XC3);
	else
		snr = (atsc_read_reg(0x0511) << 8) + atsc_read_reg(0x0512);

	snr_db = SNR_dB_table[atsc_find(snr, SNR_table, 56)];

	return snr_db;
}

int atsc_read_snr(void)
{
	return atsc_read_snr_10() / 10;
}

int check_snr_ser(int ser_threshholds)
{
	unsigned int ser_be;
	int ser_af;
	int SNR;
	int SNR_dB;

	SNR = (atsc_read_reg(0x0511) << 8) +
		atsc_read_reg(0x0512);
	SNR_dB = SNR_dB_table[atsc_find(SNR, SNR_table, 56)];
	ser_be = atsc_read_ser();
	msleep(100);
	ser_af = atsc_read_ser();
	PR_ATSC("%s [%d][%2d]\n", __func__,
		(ser_af - ser_be), SNR_dB / 10);
	if (((ser_af - ser_be) > ser_threshholds) ||
		(SNR_dB / 10 < 14))
		return -1;
	else
		return 0;
}

int peak[2048];
int cci_run(void)
{
	int tmp0[4], tmp1[4], tmp2[4], tmp3[4];
	int result[4], bin[4], power[4];
	int max_p[2], max_b[2], ck0;
	int cci_cnt = 0;
	int avg_len   = 4;
	int threshold;
	int time[10];

	threshold = avg_len * 200;
	time[0] = jiffies_to_msecs(jiffies);
	for (ck0 = 0; ck0 < 2048; ck0++)
		peak[ck0] = 0;
	for (ck0 = 0; ck0 < 2; ck0++) {
		max_p[ck0] = 0;
		max_b[ck0] = 0;
	}
	time[1] = jiffies_to_msecs(jiffies);
	PR_ATSC("[atsc_time][cci_run1,%d ms]\n",
		(time[1] - time[0]));
	for (ck0 = 0; ck0 < avg_len; ck0++) {
		/* step1: set 0x918[0] = 1;*/
		atsc_write_reg(0x918, 0x3);
		tmp0[1] = atsc_read_reg(0x981);
		tmp0[2] = atsc_read_reg(0x982);
		tmp0[3] = atsc_read_reg(0x983);
		tmp1[1] = atsc_read_reg(0x984);
		tmp1[2] = atsc_read_reg(0x985);
		tmp1[3] = atsc_read_reg(0x986);
		tmp2[1] = atsc_read_reg(0x987);
		tmp2[2] = atsc_read_reg(0x988);
		tmp2[3] = atsc_read_reg(0x989);
		tmp3[1] = atsc_read_reg(0x98a);
		tmp3[2] = atsc_read_reg(0x98b);
		tmp3[3] = atsc_read_reg(0x98c);
		result[0] = (tmp0[3] << 16) +
			(tmp0[2] << 8) + tmp0[1];
		power[0] = result[0] >> 11;
		bin[0] = result[0] & 0x7ff;
		result[1] = (tmp1[3] << 16) +
			(tmp1[2] << 8) + tmp1[1];
		power[1] = result[1] >> 11;
		bin[1] = result[1] & 0x7ff;
		result[2] = (tmp2[3] << 16)
			+ (tmp2[2] << 8) + tmp2[1];
		power[2] = result[2] >> 11;
		bin[2] = result[2] & 0x7ff;
		result[3] = (tmp3[3] << 16) +
			(tmp3[2] << 8) + tmp3[1];
		power[3] = result[3] >> 11;
		bin[3] = result[3] & 0x7ff;

		peak[bin[0]] = peak[bin[0]] + power[0];
		peak[bin[1]] = peak[bin[1]] + power[1];
		peak[bin[2]] = peak[bin[2]] + power[2];
		peak[bin[3]] = peak[bin[3]] + power[3];
		PR_ATSC("[%x]%x,[%x]%x,[%x]%x,[%x]%x\n",
			bin[0], peak[bin[0]], bin[1],
			peak[bin[1]], bin[2], peak[bin[2]],
			bin[3], peak[bin[3]]);
	}
	time[2] = jiffies_to_msecs(jiffies);
	PR_ATSC("[atsc_time][cci_run2,%d ms]\n",
		(time[2] - time[1]));
	cci_cnt = 0;
	for (ck0 = 0; ck0 < 2048; ck0++) {
		if (peak[ck0] > threshold) {
			if (peak[ck0] > max_p[0]) {
				max_p[1] = max_p[0];/*Shift Max*/
				max_b[1] = max_b[0];
				max_p[0] = peak[ck0];
				max_b[0] = ck0;
			} else if (peak[ck0] > max_p[1]) {
				max_p[1] = peak[ck0];
				max_b[1] = ck0;
				}
			cci_cnt = cci_cnt + 1;
		}
	}
	time[3] = jiffies_to_msecs(jiffies);
	PR_ATSC("[atsc_time][cci_run3,%d ms]\n",
		(time[3] - time[2]));
	atsc_write_reg(0x736, ((max_b[0] >> 8) & 0x7) + 0x40);
	atsc_write_reg(0x737, max_b[0] & 0xff);
	atsc_write_reg(0x738, (max_b[1] >> 8) & 0x7);
	atsc_write_reg(0x739, max_b[1] & 0xff);
	atsc_write_reg(0x735, 0x80);
	for (ck0 = 0; ck0 < 2; ck0++) {
		PR_ATSC(" %d - %d CCI: pos %x  power %x .\n",
			cci_cnt, ck0, max_b[ck0], max_p[ck0]);
	}
	time[4] = jiffies_to_msecs(jiffies);
	PR_ATSC("[atsc_time][cci_run4,%d ms]\n", (time[4] - time[3]));
	PR_ATSC("[atsc_time]--------printf cost %d us\n",
		jiffies_to_msecs(jiffies) - time[4]);
	return 0;
}

void atsc_reset_new(void)
{
	union atsc_cntl_reg_0x20 val_0x20;

	val_0x20.bits = atsc_read_reg_v4(ATSC_CNTR_REG_0X20);
	val_0x20.b.cpu_rst = 1;
	atsc_write_reg_v4(ATSC_CNTR_REG_0X20, val_0x20.bits);
	msleep(20);
	val_0x20.b.cpu_rst = 0;
	atsc_write_reg_v4(ATSC_CNTR_REG_0X20, val_0x20.bits);
}

void cci_run_new(struct aml_dtvdemod *demod)
{
	unsigned int result[4] = { 0 }, bin[4] = { 0 }, power[4] = { 0 };
	unsigned int max_p[8] = { 0 }, max_b[8] = { 0 }, ck0 = 0, offset = 0;
	unsigned int position[4] = { 0 }, cci_cnt = 0, dist = 15;
	unsigned int avg_len = 200, threshold = 0;
	union ATSC_EQ_REG_0X92_BITS val_0x92 = { 0 };
	unsigned int time[3] = { 0 };
	struct amldtvdemod_device_s *devp = (struct amldtvdemod_device_s *)demod->priv;

	time[0] = jiffies_to_msecs(jiffies);
	PR_ATSC("%s: [atsc_time][start......]\n", __func__);

	threshold = avg_len * 800;
	val_0x92.bits = atsc_read_reg_v4(ATSC_EQ_REG_0X92);

	memset(&devp->peak, 0, sizeof(devp->peak));

	for (ck0 = 0; ck0 < avg_len; ++ck0) {
		val_0x92.b.cwrmv_enable = 0x1;
		atsc_write_reg_v4(ATSC_EQ_REG_0X92, val_0x92.bits);

		result[0] = atsc_read_reg_v4(ATSC_CNTR_REG_0X29) & 0xffffff;
		power[0] = result[0] >> 11;
		bin[0] = result[0] & 0x7ff;

		result[1] = atsc_read_reg_v4(ATSC_CNTR_REG_0X2A) & 0xffffff;
		power[1] = result[1] >> 11;
		bin[1] = result[1] & 0x7ff;

		result[2] = atsc_read_reg_v4(ATSC_CNTR_REG_0X2B) & 0xffffff;
		power[2] = result[2] >> 11;
		bin[2] = result[2] & 0x7ff;

		result[3] = atsc_read_reg_v4(ATSC_CNTR_REG_0X2C) & 0xffffff;
		power[3] = result[3] >> 11;
		bin[3] = result[3] & 0x7ff;

		devp->peak[bin[0]] = devp->peak[bin[0]] + power[0];
		devp->peak[bin[1]] = devp->peak[bin[1]] + power[1];
		devp->peak[bin[2]] = devp->peak[bin[2]] + power[2];
		devp->peak[bin[3]] = devp->peak[bin[3]] + power[3];

		usleep_range(300, 400);
	}

	time[1] = jiffies_to_msecs(jiffies);
	PR_ATSC("%s: [atsc_time][cci_run1 cost %d ms]\n",
			__func__, time[1] - time[0]);

	cci_cnt = 0;

	for (ck0 = 0; ck0 < 2048; ck0++) {
		if (devp->peak[ck0] > threshold) {
			if (devp->peak[ck0] > max_p[0]) {
				/* Shift Max */
				max_p[7] = max_p[6];
				max_b[7] = max_b[6];
				max_p[6] = max_p[5];
				max_b[6] = max_b[5];
				max_p[5] = max_p[4];
				max_b[5] = max_b[4];
				max_p[4] = max_p[3];
				max_b[4] = max_b[3];
				max_p[3] = max_p[2];
				max_b[3] = max_b[2];
				max_p[2] = max_p[1];
				max_b[2] = max_b[1];
				max_p[1] = max_p[0];
				max_b[1] = max_b[0];
				max_p[0] = devp->peak[ck0];
				max_b[0] = ck0;
			} else if (devp->peak[ck0] > max_p[1]) {
				max_p[7] = max_p[6];
				max_b[7] = max_b[6];
				max_p[6] = max_p[5];
				max_b[6] = max_b[5];
				max_p[5] = max_p[4];
				max_b[5] = max_b[4];
				max_p[4] = max_p[3];
				max_b[4] = max_b[3];
				max_p[3] = max_p[2];
				max_b[3] = max_b[2];
				max_p[2] = max_p[1];
				max_b[2] = max_b[1];
				max_p[1] = devp->peak[ck0];
				max_b[1] = ck0;
			} else if (devp->peak[ck0] > max_p[2]) {
				max_p[7] = max_p[6];
				max_b[7] = max_b[6];
				max_p[6] = max_p[5];
				max_b[6] = max_b[5];
				max_p[5] = max_p[4];
				max_b[5] = max_b[4];
				max_p[4] = max_p[3];
				max_b[4] = max_b[3];
				max_p[3] = max_p[2];
				max_b[3] = max_b[2];
				max_p[2] = devp->peak[ck0];
				max_b[2] = ck0;
			} else if (devp->peak[ck0] > max_p[3]) {
				max_p[7] = max_p[6];
				max_b[7] = max_b[6];
				max_p[6] = max_p[5];
				max_b[6] = max_b[5];
				max_p[5] = max_p[4];
				max_b[5] = max_b[4];
				max_p[4] = max_p[3];
				max_b[4] = max_b[3];
				max_p[3] = devp->peak[ck0];
				max_b[3] = ck0;
			} else if (devp->peak[ck0] > max_p[4]) {
				max_p[7] = max_p[6];
				max_b[7] = max_b[6];
				max_p[6] = max_p[5];
				max_b[6] = max_b[5];
				max_p[5] = max_p[4];
				max_b[5] = max_b[4];
				max_p[4] = devp->peak[ck0];
				max_b[4] = ck0;
			} else if (devp->peak[ck0] > max_p[5]) {
				max_p[7] = max_p[6];
				max_b[7] = max_b[6];
				max_p[6] = max_p[5];
				max_b[6] = max_b[5];
				max_p[5] = devp->peak[ck0];
				max_b[5] = ck0;
			} else if (devp->peak[ck0] > max_p[6]) {
				max_p[7] = max_p[6];
				max_b[7] = max_b[6];
				max_p[6] = devp->peak[ck0];
				max_b[6] = ck0;
			} else if (devp->peak[ck0] > max_p[7]) {
				max_p[7] = devp->peak[ck0];
				max_b[7] = ck0;
			}

			++cci_cnt;
		}
	}

	for (ck0 = 0; ck0 < 8; ++ck0)
		PR_ATSC("cci_cnt %d - ck0 %d CCI: pos %d, power %d.\n",
				cci_cnt, ck0, max_b[ck0], max_p[ck0]);

	if (cci_cnt > 0) {
		position[0] = max_b[0];
		ck0 = 1;
		cci_cnt = 1;

		while (cci_cnt < 4 && ck0 < 8) {
			if (abs(max_b[ck0] - max_b[ck0 - 1]) > dist)
				position[cci_cnt++] = max_b[ck0];

			++ck0;
		}

		for (ck0 = 0; ck0 < cci_cnt; ++ck0)
			PR_ATSC("ck0 %d CCI: pos %d(0x%x).\n",
					ck0, position[ck0], position[ck0]);
	}

	time[2] = jiffies_to_msecs(jiffies);
	PR_ATSC("%s: [atsc_time][cci_run2 cost %d ms]\n",
			__func__, time[2] - time[1]);

	if (cci_cnt > 0) {
		PR_ATSC("Before read 0x33: 0x%x, 0x34: 0x%x.\n",
				front_read_reg(0x33), front_read_reg(0x34));
		PR_ATSC("Before read 0x60: 0x%x, 0x61: 0x%x.\n",
				atsc_read_reg_v4(ATSC_DEMOD_REG_0X60),
				atsc_read_reg_v4(ATSC_DEMOD_REG_0X61));

		atsc_write_reg_bits_v4(ATSC_DEMOD_REG_0X61,
				position[0], 0, 16);

		if (cci_cnt > 1)
			atsc_write_reg_bits_v4(ATSC_DEMOD_REG_0X61,
					position[1], 16, 16);

		/* 2048: fft points.
		 * 10762: fft symbol rate(bps).
		 * 24: sampling rate.
		 * 1 << 28: 2^28.
		 */
		if (cci_cnt > 2) {
			if (position[2] > 512) {
				offset = (position[2] - 512) * 107620 / 2048;
				offset = (50 + offset) * (1 << 28) / 240;
			} else {
				offset = (512 - position[2]) * 107620 / 2048;
				offset = (50 - offset) * (1 << 28) / 240;
			}

			/* cci config2
			 * bit[31]: 0 - enable cci, 1 - bypass.
			 * bit[0-28]: offset.
			 */
			front_write_reg(0x33, offset & 0xfffffff);
		}

		if (cci_cnt > 3) {
			if (position[3] > 512) {
				offset = (position[3] - 512) * 107620 / 2048;
				offset = (50 + offset) * (1 << 28) / 240;
			} else {
				offset = (512 - position[3]) * 107620 / 2048;
				offset = (50 - offset) * (1 << 28) / 240;
			}

			/* cci config2
			 * bit31: 0 - enable cci, 1 - bypass.
			 * bit[0-28]: offset.
			 */
			front_write_reg(0x34, offset & 0xfffffff);
		}

		if (devp->atsc_cr_step_size_dbg) {
			atsc_write_reg_v4(ATSC_DEMOD_REG_0X60,
					devp->atsc_cr_step_size_dbg);
			PR_ATSC("%s: dbg mode, set cr reg(0x60) = 0x%x.\n",
					__func__, devp->atsc_cr_step_size_dbg);
		} else {
			atsc_write_reg_v4(ATSC_DEMOD_REG_0X60, 0x143);
			PR_ATSC("%s: set cr reg(0x60) = 0x143.\n", __func__);
		}

		PR_ATSC("After write 0x33: 0x%x, 0x34: 0x%x.\n",
				front_read_reg(0x33), front_read_reg(0x34));
		PR_ATSC("After write 0x60: 0x%x, 0x61: 0x%x.\n",
				atsc_read_reg_v4(ATSC_DEMOD_REG_0X60),
				atsc_read_reg_v4(ATSC_DEMOD_REG_0X61));
	}

	PR_ATSC("[atsc_time][total cost %d ms]\n",
			jiffies_to_msecs(jiffies) - time[0]);
}

unsigned int atsc_check_cci(struct aml_dtvdemod *demod)
{
	unsigned int fsm_status = 0;
	int time[10] = { 0 }, time_table[10] = { 0 };
	unsigned int ret = CFO_FAIL;
	unsigned int i = 0;

	fsm_status = atsc_read_reg_v4(ATSC_CNTR_REG_0X2E);
	PR_ATSC("fsm[%x]not lock,need to run cci\n", fsm_status);
	time[0] = jiffies_to_msecs(jiffies);
	set_cr_ck_rate_new(demod);
	time[1] = jiffies_to_msecs(jiffies);
	time_table[0] = (time[1] - time[0]);
	fsm_status = atsc_read_reg_v4(ATSC_CNTR_REG_0X2E);
	PR_ATSC("fsm[%x][atsc_time]cci finish cost %d ms\n",
		fsm_status, time_table[0]);
	if (fsm_status >= ATSC_LOCK) {
		goto exit;
	} else if (fsm_status >= CR_PEAK_LOCK) {
	//else if (fsm_status < CR_LOCK) {
		//ret = cfo_run_new();
	//}

		ret = CFO_OK;
		//msleep(100);
	}

	time[2] = jiffies_to_msecs(jiffies);
	time_table[1] = (time[2] - time[1]);
	//PR_ATSC("fsm[%x][atsc_time]cfo done,cost %d ms,\n",
		//atsc_read_reg_v4(ATSC_CNTR_REG_0X2E), time_table[1]);

	if (ret == CFO_FAIL)
		goto exit;

	cci_run_new(demod);
	ret = 2;

	for (i = 0; i < 2; i++) {
		fsm_status = atsc_read_reg_v4(ATSC_CNTR_REG_0X2E);
		if (fsm_status >= ATSC_LOCK) {
			time[3] = jiffies_to_msecs(jiffies);
			PR_ATSC("----------------------\n");
			time_table[2] = (time[3] - time[2]);
			time_table[3] = (time[3] - time[0]);
			time_table[4] = (time[3] - time[5]);
			PR_ATSC("fsm[%x][atsc_time]fec lock cost %d ms\n",
				fsm_status, time_table[2]);
			PR_ATSC("fsm[%x][atsc_time]lock,one cost %d ms,\n",
				fsm_status, time_table[3]);
			break;
		} else if (fsm_status <= IDLE) {
			PR_ATSC("atsc idle,retune, and reset\n");
			set_cr_ck_rate_new(demod);
			atsc_reset_new();
			break;
		}

		msleep(20);
	}

exit:
	return ret;
}

void set_cr_ck_rate_new(struct aml_dtvdemod *demod)
{
	union ATSC_DEMOD_REG_0X6A_BITS val_0x6a;
	union ATSC_EQ_REG_0XA5_BITS val_0xa5;
	union ATSC_DEMOD_REG_0X54_BITS val_0x54;
	union ATSC_DEMOD_REG_0X55_BITS val_0x55;
	union ATSC_DEMOD_REG_0X6E_BITS val_0x6e;

	//Read Reg
	val_0x6a.bits = atsc_read_reg(ATSC_DEMOD_REG_0X6A);
	val_0xa5.bits = atsc_read_reg(ATSC_EQ_REG_0XA5);
	val_0x54.bits = atsc_read_reg(ATSC_DEMOD_REG_0X54);
	val_0x55.bits = atsc_read_reg(ATSC_DEMOD_REG_0X55);
	val_0x6e.bits = atsc_read_reg(ATSC_DEMOD_REG_0X6E);

	//Set Reg
	val_0x6a.b.peak_thd = 0x6;//Let CCFO Quality over 6
	val_0xa5.bits = 0x8c;//increase state 2 to state 3
	if (tuner_find_by_name(&demod->frontend, "r842") &&
		demod->demod_status.ch_if == DEMOD_4_57M_IF)
		val_0x54.bits = 0x185F92; //4.57M IF.
	else
		val_0x54.bits = 0x1aaaaa; //5M IF.
	val_0x55.bits = 0x3ae28d;//24m
	val_0x6e.bits =	0x16e3600;

	//Write Reg
	atsc_write_reg(ATSC_DEMOD_REG_0X6A, val_0x6a.bits);
	atsc_write_reg(ATSC_EQ_REG_0XA5, val_0xa5.bits);
	atsc_write_reg(ATSC_DEMOD_REG_0X54, val_0x54.bits);
	atsc_write_reg(ATSC_DEMOD_REG_0X55, val_0x55.bits);
	atsc_write_reg(ATSC_DEMOD_REG_0X6E, val_0x6e.bits);
}

unsigned int cfo_run_new(void)
{
	int cr_rate0, cr_rate1, cr_rate2, cr_rate;
	int fcent, fs;
	int cfo_sta, cr_peak_sta;
	int i, j;
	int sys_state;
	int table_count;
	int max_count;
	int freq_table[] = {0, -50, 50, -100, 100, -150, 150};
	int scan_range;
	int offset;
	unsigned int ret = 0;

	if (cfo_count == 1)
		max_count = 3;
	else if (cfo_count == 2)
		max_count = 5;
	else
		max_count = 1;//7;

	fcent = DEMOD_5M_IF;/*if khz*/
	fs = ADC_CLK_24M;/*crystal*/
	cfo_sta = 0;
	cr_peak_sta = 0;
	table_count = 0;
	scan_range = 10;
	offset = freq_table[table_count];
	PR_ATSC("Fcent[%d], Fs[%d]\n", fcent, fs);

	for (i = -(scan_range - 1); i <= scan_range + 1; i++) {
		atsc_reset_new();
		cfo_sta = UNLOCK;
		cr_peak_sta = UNLOCK;
		cr_rate = (1 << 10) * (fcent + offset) / fs;
		cr_rate *= (1 << 13);
		cr_rate0 = cr_rate & 0xff;
		cr_rate1 = (cr_rate >> 8) & 0xff;
		cr_rate2 = (cr_rate >> 16) & 0xff;
		atsc_write_reg_v4(ATSC_DEMOD_REG_0X54, cr_rate);
		PR_ATSC("[autoscan]crRate is %x, Offset is %dkhz\n ", cr_rate, offset);

		/*detec cfo signal*/
		for (j = 0; j < 3; j++) {
			sys_state = atsc_read_reg_v4(ATSC_CNTR_REG_0X2E);
			/*sys_state = (sys_state >> 4) & 0x0f;*/
			if (sys_state >= CR_LOCK) {
				cfo_sta = LOCK;
				PR_ATSC("fsm[%x][autoscan]cfo lock\n", sys_state);
				break;
			}
			msleep(20);
		}

		PR_ATSC("fsm[%x]cfo_sta is %d\n", atsc_read_reg_v4(ATSC_CNTR_REG_0X2E), cfo_sta);

		/*detec cr peak signal*/
		if (cfo_sta == LOCK) {
			for (j = 0; j < 5; j++) {
				sys_state = atsc_read_reg_v4(ATSC_CNTR_REG_0X2E);
				PR_ATSC("fsm[%x]in CR LOCK\n",
					atsc_read_reg_v4(ATSC_CNTR_REG_0X2E));
				/*sys_state = (sys_state >> 4) & 0x0f;*/
				if (sys_state >= CR_PEAK_LOCK) {
					cr_peak_sta = LOCK;
					PR_ATSC("fsm[%x][autoscan]cr peak lock\n",
						atsc_read_reg_v4(ATSC_CNTR_REG_0X2E));
					break;
				} else if (sys_state <= 20) {
					PR_ATSC("no signal,break\n");
					break;
				}
				msleep(20);
			}
		} else {
			if (table_count >= (max_count - 1))
				break;
			table_count++;
			offset = freq_table[table_count];
			continue;
		}

		/*reset*/
		if (cr_peak_sta == LOCK) {
			/*atsc_reset();*/
			PR_ATSC("fsm[%x][autoscan]atsc_reset\n",
				atsc_read_reg_v4(ATSC_CNTR_REG_0X2E));
			ret = CFO_OK;
		} else {
			if (table_count >= (max_count - 1)) {
				PR_ATSC("cfo not lock,will try again\n");
				ret = CFO_FAIL;
				break;
			}
			table_count++;
			offset = freq_table[table_count];
		}
	}

	return ret;
}

int cfo_run(void)
{
	int cr_rate0, cr_rate1, cr_rate2, cr_rate;
	int f_cent = DEMOD_5M_IF;/* if khz*/
	int fs = ADC_CLK_24M;/* crystal */
	int cfo_sta = UNLOCK, cr_peak_sta = UNLOCK;
	unsigned int i, j;
	int sys_state;
	int max_count;
	int freq_table[] = {0, -50, 50, -100, 100, -150, 150};
	int Offset;
	int detec_cfo_times = 3;

	if (cfo_count == 1)
		max_count = 3;
	else if (cfo_count == 2)
		max_count = 5;
	else
		max_count = 7;

	/* for field test do 3 times */
	if (field_test_version) {
		max_count = 1;
		detec_cfo_times = 20;
	}

	PR_ATSC("Fcent[%d], Fs[%d]\n", f_cent, fs);

	for (i = 0; i < 7; i++) {
		if (i > (max_count - 1))
			return CFO_FAIL;

		Offset = freq_table[i];
		atsc_reset();
		cfo_sta = UNLOCK;
		cr_peak_sta = UNLOCK;
		cr_rate = (1 << 10) * (f_cent + Offset) / fs;
		cr_rate *= (1 << 13);
		cr_rate0 = cr_rate & 0xff;
		cr_rate1 = (cr_rate >> 8) & 0xff;
		cr_rate2 = (cr_rate >> 16) & 0xff;
		/*set ddc init*/
		atsc_write_reg(0x70e, cr_rate0);
		atsc_write_reg(0x70d, cr_rate1);
		atsc_write_reg(0x70c, cr_rate2);
		PR_ATSC("[autoscan]crRate is %x, Offset is %dkhz\n ",
			cr_rate, Offset);

		/*detec cfo signal*/
		for (j = 0; j < detec_cfo_times; j++) {
			sys_state = read_atsc_fsm();
			/*sys_state = (sys_state >> 4) & 0x0f;*/
			if (sys_state >= CR_LOCK) {
				cfo_sta = LOCK;
				PR_ATSC("fsm[%x][autoscan]cfo lock\n",
					read_atsc_fsm());
				break;
			}
			msleep(20);
		}
		PR_ATSC("fsm[%x]cfo_sta is %d\n", read_atsc_fsm(), cfo_sta);

		/*detec cr peak signal*/
		if (cfo_sta == LOCK) {
			for (j = 0; j < cfo_times; j++) {
				sys_state = read_atsc_fsm();
				PR_ATSC("fsm[%x]in CR LOCK\n",
					read_atsc_fsm());
				/*sys_state = (sys_state >> 4) & 0x0f;*/
				if (sys_state >= CR_PEAK_LOCK) {
					cr_peak_sta = LOCK;
					PR_ATSC("fsm[0x%x]cr peak lock\n",
						read_atsc_fsm());
					break;
				} else if (sys_state <= 20) {
					PR_ATSC("no signal,break\n");
					break;
				}
				msleep(20);
			}
		} else {
			continue;
		}
		/*reset*/
		if (cr_peak_sta == LOCK) {
			/*atsc_reset();*/
			PR_ATSC("fsm[%x][autoscan]atsc_reset\n",
			read_atsc_fsm());
			return CFO_OK;
		}
	}
	return 0;
}

int AR_run(void)
{
	int snr_buffer;

	msleep(100);
	snr_buffer = read_snr_atsc_tune();
	snr_buffer = snr_buffer / 10;
	PR_ATSC("[AR]%s, snr_buffer is %d,ar_flag is %d\n", __func__,
		snr_buffer, ar_flag);
	if (snr_buffer > 15 && ar_flag) {
		atsc_write_reg(0xf2b, 0x4);
		ar_flag = 0;
		PR_ATSC("[AR]close AR\n");
	} else if ((snr_buffer < 12) && !ar_flag) {
		atsc_write_reg(0xf28, 0x8c);
		atsc_write_reg(0xf28, 0xc);
		atsc_write_reg(0xf2b, 0x14);
		ar_flag = 1;
		PR_ATSC("[AR]open AR\n");
	}
	return 0;
}

int atsc_check_fsm_status_oneshot(void)
{
	unsigned int SNR;
	unsigned int atsc_snr = 0;
	unsigned int SNR_dB;
	int tmp[3];
	int cr;
	int ck;
	int SM;
	int ber;
	int ser;
	int cnt;

	cnt = 0;
	ber = 0;
	ser = 0;
	tmp[0] = atsc_read_reg(0x0511);
	tmp[1] = atsc_read_reg(0x0512);
	SNR = (tmp[0] << 8) + tmp[1];
	SNR_dB = SNR_dB_table[atsc_find(SNR, SNR_table, 56)];
	tmp[2] = atsc_read_reg(0x0782);
	tmp[1] = atsc_read_reg(0x0781);
	tmp[0] = atsc_read_reg(0x0780);
	cr = tmp[0] + (tmp[1] << 8) + (tmp[2] << 16);
	tmp[0] = atsc_read_reg(0x0786);
	tmp[1] = atsc_read_reg(0x0787);
	tmp[2] = atsc_read_reg(0x0788);
	ck = (tmp[0] << 16) + (tmp[1] << 8) + tmp[2];
	SM = atsc_read_reg(0x0980);
/* ber per */
	/*Enable SER/BER*/
	atsc_write_reg(0x0601, 0x8);
	ber = atsc_read_reg(0x0683) + (atsc_read_reg(0x0682) << 8) +
		(atsc_read_reg(0x0681) << 16) + (atsc_read_reg(0x0680) << 24);
	ser = atsc_read_reg(0x0687) + (atsc_read_reg(0x0686) << 8) +
		(atsc_read_reg(0x0685) << 16) + (atsc_read_reg(0x0684) << 24);
	PR_ATSC
	    ("SNR %4x SNRdB %2d.%2d FSM %x cr %6x ck %6x",
	     SNR, (SNR_dB / 10)
	     , (SNR_dB - (SNR_dB / 10) * 10)
	     , SM, cr, ck);
	PR_ATSC
		(" ber is %8x, ser is %8x\n",
		ber, ser);

	atsc_snr = (SNR_dB / 10);
	return atsc_snr;
}

int snr_avg_100_times(void)
{
	int i;
	int snr_table[100], snr_all = 0;
	int cnt = 0;

	for (i = 0; i < 100; i++) {
		snr_table[i] = atsc_read_snr_10();
		snr_all += snr_table[i];
		cnt++;
		if (cnt > 10) {
			cnt = 0;
			msleep(20);
		};
	}
	snr_all /= 100;
	PR_ATSC("snr_all is %d\n", snr_all);
	return snr_all / 10;
}

void atsc_set_r22_register(int flag)
{
	if (flag == 1 && awgn_flag == 0) {
		atsc_write_reg(0x5bc, 0x01);
		awgn_flag = 1;
		PR_ATSC("open awgn setting\n");
		msleep(50);
	} else {
		awgn_flag = 0;
		/*atsc_write_reg(0x5bc, 0x08);*/
		PR_ATSC("close awgn setting\n");
	}
}

void atsc_set_performance_register(int flag, int init)
{
	if (flag == TASK4_TASK5) {
		atsc_write_reg(0x912, 0x00);
		atsc_write_reg(0x716, atsc_read_reg(0x716) & ~0x02);
		atsc_write_reg(0x5bc, 0x01);
		awgn_flag = TASK4_TASK5;
	} else if (flag == AWGN) {
		atsc_write_reg(0x912, 0x00);
		atsc_write_reg(0x5bc, 0x01);
		atsc_write_reg(0x716, atsc_read_reg(0x716) | 0x02);
		awgn_flag = AWGN;
	} else {
		atsc_write_reg(0x912, 0x50);
		atsc_write_reg(0x716, atsc_read_reg(0x716) | 0x02);
		if (init == 0) {
			atsc_write_reg(0x5bc, 0x07);
			atsc_write_reg(0xf6e, 0xaf);
		} else {
			atsc_write_reg(0x5bc, 0x8);
			atsc_write_reg(0xf6e, 0x09);
		}
		awgn_flag = TASK8_R22;
	}
}

void atsc_thread(void)
{
	int time_table[10];
	int i;
	int time[10];
	int ret;
	int ser_thresholds;
	static int register_set_flag;
	static int fsm_status;
	int snr_now;
	char *info1 = "[atsc_time]fsm";

	fsm_status = IDLE;
	ser_thresholds = 200;
	time[4] = jiffies_to_msecs(jiffies);
	fsm_status = read_atsc_fsm();

	/*change */
	if (!atsc_thread_enable)
		return;

	if (!field_test_version)
		PR_ATSC("awgn_flag is %d\n", awgn_flag);
	if (fsm_status < ATSC_LOCK) {
		/*step1:open dagc*/

		fsm_status = read_atsc_fsm();
		PR_ATSC("fsm[%x]not lock,need to run cci\n", fsm_status);
		time[0] = jiffies_to_msecs(jiffies);
		/*step2:run cci*/
		set_cr_ck_rate();
		atsc_reset();
		register_set_flag = 0;
		/*step:check AR*/
		if (ar_enable)
			AR_run();
//		if (cci_enable && !field_test_version)
//			ret = cci_run();
		atsc_reset();
		time[1] = jiffies_to_msecs(jiffies);
		time_table[0] = (time[1] - time[0]);
		fsm_status = read_atsc_fsm();
		PR_ATSC("%s[%x]cci finish,need to run cfo,cost %d ms\n",
			info1, fsm_status, time_table[0]);
		if (fsm_status >= ATSC_LOCK) {
			return;
		} else if (fsm_status < CR_LOCK) {
			/*step3:run cfo*/
			ret = cfo_run();
		} else {
			ret = CFO_OK;
			msleep(100);
		}
		time[2] = jiffies_to_msecs(jiffies);
		time_table[1] = (time[2] - time[1]);
		PR_ATSC("fsm[%x][atsc_time]cfo done,cost %d ms,\n",
			read_atsc_fsm(), time_table[1]);
		if (ret == CFO_FAIL)
			return;
		if (cci_enable)
			ret = cci_run();
		for (i = 0; i < 80; i++) {
			fsm_status = read_atsc_fsm();
			if (fsm_status >= ATSC_LOCK) {
				time[3] = jiffies_to_msecs(jiffies);
				PR_ATSC("----------------------\n");
				time_table[2] = (time[3] - time[2]);
				time_table[3] = (time[3] - time[0]);
				time_table[4] = (time[3] - time[5]);
				PR_ATSC("%s[%x]cfo->fec lock cost %d ms\n",
					info1, fsm_status, time_table[2]);
				PR_ATSC("%s[%x]lock,one cost %d ms,\n",
					info1, fsm_status, time_table[3]);
				break;
			} else if (fsm_status <= IDLE) {
				PR_ATSC("atsc idle,retune, and reset\n");
				set_cr_ck_rate();
				atsc_reset();
				awgn_flag = TASK8_R22;
				break;
			}
			msleep(20);
		}
	} else {
		time[4] = jiffies_to_msecs(jiffies);
		atsc_check_fsm_status_oneshot();
		if (ar_enable)
			AR_run();
		fsm_status = read_atsc_fsm();
		PR_ATSC("lock\n");
		msleep(100);
		if (!field_test_version) {
			if (register_set_flag == 0) {
				snr_now = snr_avg_100_times();
				PR_ATSC("snr_now is %d\n", snr_now);
				if (snr_now <= 16 && snr_now >= 10) {
					atsc_set_performance_register
					(AWGN, 0);
				} else if (snr_now < 10) {
					atsc_set_performance_register
					(TASK4_TASK5, 0);
				} else {
					if (snr_now > 23) {
						atsc_set_performance_register
						(TASK4_TASK5, 0);
						PR_ATSC("snr(23)\n");
					} else if ((snr_now > 16) &&
						(snr_now <= 23)) {
						atsc_set_performance_register
						(TASK8_R22, 0);
						PR_ATSC("snr(16,23)\n");
					}
				}
				register_set_flag = 1;
				msleep(200);
				/*%lx to %x*/
				PR_ATSC("912 is %x,5bc is %x\n",
					atsc_read_reg(0x912),
					atsc_read_reg(0x5bc));
			}
		}

		time[5] = jiffies_to_msecs(jiffies);
		PR_ATSC("fsm[%x][atsc_time]check lock %d ms,\n",
					fsm_status, time[5] - time[4]);
	}
}

int find_2(int data, int *table, int len)
{
	int end;
	int index;
	int start;
	int cnt = 0;

	start = 0;
	end = len;
	/* printf("data is %d\n",data); */
	while ((len > 1) && (cnt < 10)) {
		cnt++;
		index = (len / 2);
		if (data > table[start + index]) {
			start = start + index;
			len = len - index - 1;
		}
		if (data < table[start + index]) {
			len = index + 1;
		} else if (data == table[start + index]) {
			start = start + index;
			break;
		}
	}
	return start;
}

int read_atsc_all_reg(void)
{
	return 0;
}

int check_atsc_fsm_status(void)
{
	unsigned int SNR;
	unsigned int atsc_snr = 0;
	unsigned int SNR_dB;
	int tmp[3];
	int cr;
	int ck;
	int SM;
	int tni;
	int ber;
	int ser;
	int cnt;
	unsigned int cap_status, cap_usr_dc_addr;

	cnt = 0;
	ber = 0;
	ser = 0;
	tni = atsc_read_reg((0x08) >> 16);
	tmp[0] = atsc_read_reg(0x0511);
	tmp[1] = atsc_read_reg(0x0512);
	SNR = (tmp[0] << 8) + tmp[1];
	SNR_dB = SNR_dB_table[atsc_find(SNR, SNR_table, 56)];
	tmp[2] = atsc_read_reg(0x0782);
	tmp[1] = atsc_read_reg(0x0781);
	tmp[0] = atsc_read_reg(0x0780);
	cr = tmp[0] + (tmp[1] << 8) + (tmp[2] << 16);
	tmp[0] = atsc_read_reg(0x0786);
	tmp[1] = atsc_read_reg(0x0787);
	tmp[2] = atsc_read_reg(0x0788);
	ck = (tmp[0] << 16) + (tmp[1] << 8) + tmp[2];
	SM = atsc_read_reg(0x0980);
	/* ber per */
	atsc_write_reg(0x0601, 0x8);/* Enable SER/BER*/
	ber = atsc_read_reg(0x0683) + (atsc_read_reg(0x0682) << 8)
		+ (atsc_read_reg(0x0681) << 16) +
		(atsc_read_reg(0x0680) << 24);
	ser = atsc_read_reg(0x0687) + (atsc_read_reg(0x0686) << 8)
		+ (atsc_read_reg(0x0685) << 16) +
		(atsc_read_reg(0x0684) << 24);
	cap_status = app_apb_read_reg(0x196);
	cap_usr_dc_addr = app_apb_read_reg(0x1a1);

/* read_atsc_all_reg(); */

	PR_ATSC
		("INT %x SNR %4x SNRdB %2d.%2d FSM %x cr %6x ck %6x",
		 tni, SNR, (SNR_dB / 10)
		 , (SNR_dB - (SNR_dB / 10) * 10)
		 , SM, cr, ck);
	PR_ATSC
		(" ber is %8x, ser is %8x, cap %4d cap_addr %8x\n",
		ber, ser, cap_status >> 16, cap_usr_dc_addr);

	atsc_snr = (SNR_dB / 10);
	return atsc_snr;
}

void atsc_check_fsm_status(struct aml_dtvdemod *demod)
{
	union ATSC_FA_REG_0XE7_BITS val_0xe7;
	union ATSC_DEMOD_REG_0X72_BITS val_0x72;
	union ATSC_AGC_REG_0X44_BITS val_0x44;
	unsigned int snr_db = 0;
	int cr = 0, ck = 0, sm = 0, ber = 0, ser = 0;

	val_0xe7.bits = atsc_read_reg_v4(ATSC_FA_REG_0XE7);
	val_0x72.bits = atsc_read_reg_v4(ATSC_DEMOD_REG_0X72);
	val_0x44.bits = atsc_read_reg_v4(ATSC_AGC_REG_0X44);

	snr_db = atsc_read_snr_10();
	demod->real_para.snr = snr_db;

	cr = atsc_read_reg_v4(ATSC_DEMOD_REG_0X73);
	ck = atsc_read_reg_v4(ATSC_DEMOD_REG_0X75);
	sm = atsc_read_reg_v4(ATSC_CNTR_REG_0X2E);
	ber = atsc_read_reg_v4(ATSC_FEC_BER);
	ser = atsc_read_reg_v4(ATSC_FEC_REG_0XFB);

	PR_ATSC("SNRdB:%d FSM:0x%x,cr:%d,ck:0x%x,ber is 0x%x, ser is 0x%x\n",
		snr_db / 10, sm, cr, ck, ber, ser);
}

void atsc_write_reg(unsigned int reg_addr, unsigned int reg_data)
{
	unsigned int data;

	if (!get_dtvpll_init_flag())
		return;

	data = (reg_addr & 0xffff) << 8 | (reg_data & 0xff);

	demod_mutex_lock();
	/* printk("[demod][write]%x,data is %x\n",(addr),data);*/
	writel(data, gbase_atsc());
	demod_mutex_unlock();
}

unsigned int atsc_read_reg(unsigned int reg_addr)
{
	unsigned int tmp;

	if (!get_dtvpll_init_flag())
		return 0;

	demod_mutex_lock();

	writel((reg_addr & 0xffff) << 8, gbase_atsc() + 4);
	tmp = readl(gbase_atsc());

	demod_mutex_unlock();

	return tmp & 0xff;
}

/*TL1*/
void atsc_write_reg_v4(unsigned int addr, unsigned int data)
{
	if (!get_dtvpll_init_flag())
		return;

	demod_mutex_lock();

	writel(data, gbase_atsc() + (addr << 2));

	demod_mutex_unlock();
}

void atsc_write_reg_bits_v4(u32 addr, const u32 data, const u32 start, const u32 len)
{
	unsigned int val;
	struct amldtvdemod_device_s *devp = dtvdemod_get_dev();

	if (!get_dtvpll_init_flag() || unlikely(!devp))
		return;

	demod_mutex_lock();
	val = readl(gbase_atsc() + (addr << 2));
	val &= ~(((1L << (len)) - 1) << (start));
	val |= (((data) & ((1L << (len)) - 1)) << (start));
	writel(val, gbase_atsc() + (addr << 2));
	demod_mutex_unlock();

	if (devp->print_on)
		PR_INFO("atsc wrBit 0x%x=0x%x, s:%d,l:%d\n", addr, data, start, len);
}

unsigned int atsc_read_iqr_reg(void)
{
	unsigned int tmp;

	if (!get_dtvpll_init_flag())
		return 0;

	demod_mutex_lock();

	tmp = readl(gbase_atsc() + 8);

	demod_mutex_unlock();

	PR_DBG("[atsc irq] is %x\n", tmp);
	return tmp & 0xffffffff;
}