path: root/package/ifxmips_adsl/src/danube_autoboot_daemon.c

/****************************************************************************

                            Copyright (c) 2005
                         Infineon Technologies AG
               St. Martin Strasse 53; 81669 Munich, Germany

  Any use of this Software is subject to the conclusion of a respective
  License Agreement. Without such a License Agreement no rights to the
  Software are granted.

*****************************************************************************/
/** 
History:
1.02:
09/08/2006 Removed DEMO_ONLY define
1.03:
31/08/2006 Add IOCTL AUTOBOOT_ENABLE_SET
1.04:
14/09/2006 Add min snr margin check for in Annex B DMT mode
1.05:
18/09/2006 Add G.lite support
1.06: 611101:tc.chen
10/11/2006 change quiet mode and showtime lock implement mechanism (old: using cmv, new: using ioctl to kernel mode, and the mei driver keep the value) per the mail from Oliver Salomon on 08/11/2006
1.07: 
13/11/2006 TC Chen: Fix minimal snr issue for ADSL Annex B.
1.08:
08/12/2006 TC Chen: Fix loop diagnostic warning issue
1.09:
27/12/2006 TC Chen: Fix the issue that "The autoboot daemon will call "./translate" which is a problem when started through scripts."
1.10"
1/09/2007 Bing Tao: Fix AnnexJ issue
*/

#define _IFXMIPS_ADSL_APP
//#define IFXMIPS_PORT_RTEMS 1
#define __LINUX__

#if defined(IFXMIPS_PORT_RTEMS)
#include "ifxmips_mei_rtems.h"
#define KERNEL_SPACE_APPLICATION 1
#endif

#define u32	unsigned int
 
#define VERSION_MAJOR	1
#define VERSION_MINOR	10
 
#if defined(__LINUX__)
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <sys/time.h>
#include <fcntl.h>
#include <errno.h>

#include <asm/ifxmips/ifxmips_mei_app.h>
#include <asm/ifxmips/ifxmips_mei_app_ioctl.h>
#include <asm/ifxmips/ifxmips_mei_ioctl.h>
#include <sys/types.h>
#include <string.h>
#include <time.h>

#define IFXMIPS_MEI_DEV 	"/dev/ifxmips/mei"
#endif

#if defined(KERNEL_SPACE_APPLICATION)
#include "ifxmips_adsl_fw.h"
#endif

#define IFXMIPS_GPIO_DEVICE	"/dev/ifxmips_port"
#undef DEMO_ONLY //todo: remove for normal release

#define SEGMENT_SIZE (64*1024)

#define MODE_ALL	0
#define MODE_992_1A	1
#define MODE_992_1B	2
#define MODE_992_3A	3
#define MODE_992_3B	4
#define MODE_992_5A	5
#define MODE_992_5B	6

#define MODE_992_3I 7
#define MODE_992_3J 8
#define MODE_992_3M 9
#define MODE_992_5I 10
#define MODE_992_5J 11
#define MODE_992_5M 12
#define MODE_M_ALL 13 
#define MODE_B_ALL 14 
#define MODE_M_B_ALL 15


#if defined(KERNEL_SPACE_APPLICATION)
extern int mei_ioctl(int ino, int * fil, unsigned int command, unsigned long lon);
#define ioctl(fd,cmd,arg) mei_ioctl(1,0,cmd,(unsigned long)arg)
extern void makeCMV(u8 opcode, u8 group, u16 address, u16 index, int size, u16 * data,u16 *CMVMSG);
#endif

static u16 Message[16]__attribute__ ((aligned(4))); 

#if !defined(KERNEL_SPACE_APPLICATION)
void makeCMV(u8 opcode, u8 group, u16 address, u16 index, int size, u16 * data, u16 *CMVMSG);
void makeCMV(u8 opcode, u8 group, u16 address, u16 index, int size, u16 * data, u16 *CMVMSG)
{
	memset(CMVMSG, 0, 16*2);
	CMVMSG[0]= (opcode<<4) + (size&0xf);
	if(opcode == H2D_DEBUG_WRITE_DM)
		CMVMSG[1]= (group&0x7f);
	else
		CMVMSG[1]= (((index==0)?0:1)<<7) + (group&0x7f);
	CMVMSG[2]= address;
	CMVMSG[3]= index;
	if((opcode == H2D_CMV_WRITE)||(opcode == H2D_DEBUG_WRITE_DM))
		memcpy(CMVMSG+4, data, size*2);
	return;
}
#endif

void print_usage(char *program_name)
{
	printf("Usage: %s ADSL_Firmware ADSL_MODE \n",program_name);
	printf("\tADSL_Firmeare: Specify the ADSL firmware file to use.\n");
	printf("\tADSL_MODE:Specify the ADSL mode to use for training.\n");
	printf("\t\tSupported Mode: all,1a,3a,5a,1b,3b,5b,3i,3j,3m,5i,5j,5m,m_all,b_all,mb_all\n");

}

#if defined(KERNEL_SPACE_APPLICATION)

int Download_Firmware(char *filename, int fd_mei)
{
	extern ssize_t mei_write(char * filp, const char * buf, size_t size, loff_t * loff);
	extern unsigned long cgi_pFileData_modemfw_bin[]; 
	unsigned long offset=0;
	
	mei_write(0,(char *)cgi_pFileData_modemfw_bin,sizeof(cgi_pFileData_modemfw_bin),&offset);
	return 0;
}
#else
int Download_Firmware(char *filename, int fd_mei)
{
	int fd_image=0;
	char *buf=NULL;
	int size=0,read_size = SEGMENT_SIZE;
	struct stat file_stat;

        fd_image=open(filename, O_RDONLY);
	if (fd_image<=0)
	{
                printf("\n open %s fail.\n",filename);
                return -1;
	}
        if(lstat(filename, &file_stat)<0){
                printf("\n lstat error");
                return -1;
        }
        size=file_stat.st_size;
        buf=malloc(read_size);
        if(buf==NULL){
                printf("\n malloc failed in MEI main()");
                return -1;
        }

        lseek(fd_image, 0, SEEK_SET);
        lseek(fd_mei, 0, SEEK_SET);
        while(size>0)
        {
                static flag=1;
                if (size>SEGMENT_SIZE)
                        read_size=SEGMENT_SIZE;
                else
                        read_size=size;
                if(read(fd_image, buf, read_size)<=0){
                        printf("\n amazon_mei_image not present");
                        return -1;
                }
                if(write(fd_mei, buf, read_size)!=read_size){
                        printf("\n write to mei driver fail");
                        free(buf);
                        return -1;
                }
                size-=read_size;
        }
        free(buf);
        close(fd_image);
}
#endif

// 609141:tc.chen :read min margin from CO for Annex B in DMT mode
int read_min_snr_margin(int fd, s16 *rt_ne_ds_min_margin)
{
	makeCMV(H2D_CMV_READ,STAT, 1, 0, 1, NULL, Message);
        if (ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)!=0)
		return -1;
        if (Message[4] == 0x8) //992.1 AnnexB
        {
             	u16 min_margin;
             	makeCMV(H2D_CMV_READ,INFO, 33, 1, 1, NULL, Message);
            	if (ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)!=0)
		{
			return -1;
		}
		// INFO 33 is 6 bits sign value
                min_margin = (Message[4] & 0x3f);
                if (min_margin > 31)
                {
                	*rt_ne_ds_min_margin = min_margin - 64;
                }else
                {
                        *rt_ne_ds_min_margin = min_margin ;
                }
        }else
	{
		*rt_ne_ds_min_margin = 0;
	}
	return 0;
}
// 609141:tc.chen  end

#if !defined(KERNEL_SPACE_APPLICATION)
int main(int argc, char **argv)
#else
int ifxmips_autoboot_main (int argc, char **argv)
#endif
{
        int fd;
	int i,j;
	char systemstr[50];
	u16 all_data = 0;
	u16 zero = 0x0;
	u16 one=0x1;
	u16 mw = 0x10;
	u16 link = 0x2;
	u16 temp=0;
	u16 rt_macrostate;
	meireg meiregister;
	int reboot_flag, rt_ne_los_flag;
	u16 rt_ne_failure_flags=0;
	s16 rt_ne_ds_margin=0;
	s16 rt_ne_ds_min_margin=0; //609141:tc.chen:
	u16 rt_buildcode_lsw=0, rt_buildcode_msw=0;
	u32 rt_buildcode = 0;
	int FarEndResponseReceived;
	time_t start_time;
	int timeout_limit;
	int     tmpShowTimeLockEnabled = 0; 
 	u16 nFECS_L_count=0;
  	u16 nES_L_count=0; 
 	u16 nSES_L_count=0;
	u16 nLOSS_L_count=0; 	
	u16 first_power_on=1;
	int mode = -1;
	int pre_loop_diagnostics_mode=0;
	int loop_diagnostics_mode=0;
	
	if ((argc < 2) || (argc > 5) )
	{	printf("\n Wrong Argument\n");
		print_usage(argv[0]);
		return -1;
	}

//KD
// translate is called with "./translate -ef", but if the autoboot daemon
// is started during system boot, the current directory is "/", which
// makes the "system" call fail.
// Thus we make the program's directory the working directory.
        {
         char *argv0, *prog_dir;
         int argv0_size;
         /* The dirname system call might change its argument,
            thus we need a local copy */
         argv0_size = strlen(argv[0]) + 1;
         argv0 = malloc(argv0_size);
         if (argv0 == 0) {
           printf("\n Insufficient memory\n");
           return -1;
         }
         /* make sure there is no buffer overflow and
            the string is null-terminated */
         strncpy(argv0, argv[0], argv0_size);
         argv0[argv0_size-1] = '\0';

         prog_dir = dirname(argv0);
         chdir(prog_dir);
         free(argv0);
         argv0 = 0;
        }

	//display version info or download firmware
	if(argc==2) 
	{
		if ((strncmp(argv[1], "ver", 3)==0) || (strncmp(argv[1], "VER", 3)==0)){
			printf("\n ifxmips_autoboot_daemon version: %d.%02d.00\n",VERSION_MAJOR,VERSION_MINOR);	
		}else
		{
#if !defined(KERNEL_SPACE_APPLICATION)		
			fd=open(IFXMIPS_MEI_DEV, O_RDWR);
			if(fd<0){
				printf("autoboot open %s fail\n",IFXMIPS_MEI_DEV);
				return -1;
			}
#endif
			// Notify mei driver that it is controlled by autoboot daemon
			i = 1;
			if (ioctl(fd, AUTOBOOT_ENABLE_SET, &i)<0){
				printf("\n\n mei ioctl AUTOBOOT_ENABLE_SET fail.\n");
			}

			Download_Firmware(argv[1],fd);
			if (ioctl(fd, IFXMIPS_MEI_START,NULL)<0){
				printf("\n\n mei start fail.\n");
#if !defined(KERNEL_SPACE_APPLICATION)			
				close(fd);
#endif			
				return -1;
			}
#if !defined(KERNEL_SPACE_APPLICATION)			
			close(fd);
#endif			
		}
		return 0;
	}

	if (strncmp(argv[2], "all", 3) == 0)
		mode = MODE_ALL;
	else if ((strncmp(argv[2], "1a", 2) == 0) || (strncmp(argv[2], "1A", 2) == 0))
		mode = MODE_992_1A;
	else if ((strncmp(argv[2], "1b", 2) == 0) || (strncmp(argv[2], "1B", 2) == 0))
		mode = MODE_992_1B;
	else if ((strncmp(argv[2], "3a", 2) == 0) || (strncmp(argv[2], "3A", 2) == 0))
		mode = MODE_992_3A;
	else if ((strncmp(argv[2], "3b", 2) == 0) || (strncmp(argv[2], "3B", 2) == 0))
		mode = MODE_992_3B;
	else if ((strncmp(argv[2], "5a", 2) == 0) || (strncmp(argv[2], "5A", 2) == 0))
		mode = MODE_992_5A;
	else if ((strncmp(argv[2], "5b", 2) == 0) || (strncmp(argv[2], "5B", 2) == 0))
		mode = MODE_992_5B;

	else if ((strncmp(argv[2], "3i",2) == 0) || (strncmp(argv[2], "3I",2) == 0))
		mode = MODE_992_3I;
	else if ((strncmp(argv[2], "3j",2) == 0) || (strncmp(argv[2], "3J",2) == 0))
		mode = MODE_992_3J;
	else if ((strncmp(argv[2], "3m",2) == 0) || (strncmp(argv[2], "3M",2) == 0))
		mode = MODE_992_3M;
	else if ((strncmp(argv[2], "5i",2) == 0) || (strncmp(argv[2], "5I",2) == 0))
		mode = MODE_992_5I;
	else if ((strncmp(argv[2], "5j",2) == 0) || (strncmp(argv[2], "5J",2) == 0))
		mode = MODE_992_5J;
	else if ((strncmp(argv[2], "5m",2) == 0) || (strncmp(argv[2], "5M",2) == 0))
		mode = MODE_992_5M;
        else if (strncmp(argv[2], "m_all",5) == 0) 
        	mode = MODE_M_ALL; 
        else if (strncmp(argv[2], "b_all",5) == 0) 
                mode = MODE_B_ALL; 
	else if (strncmp(argv[2], "mb_all",6) == 0) 
                mode = MODE_M_B_ALL; 

	if (mode == -1)
	{	printf("\n Wrong Argument\n");
		print_usage(argv[0]);
		return -1;
	}

#if !defined(KERNEL_SPACE_APPLICATION)
	fd=open(IFXMIPS_MEI_DEV, O_RDWR);
	if(fd<0){
		printf("autoboot open %s fail\n",IFXMIPS_MEI_DEV);
		return -1;
	}
#endif
fw_download:
	i = 1;
	if (ioctl(fd, AUTOBOOT_ENABLE_SET, &i)<0){
		printf("\n\n mei ioctl AUTOBOOT_ENABLE_SET fail.\n");
	}
	Download_Firmware(argv[1],fd);

	if (ioctl(fd, IFXMIPS_MEI_START,NULL)<0){
		printf("\n\n mei start fail.\n");
		ioctl(fd, IFXMIPS_MEI_REBOOT,NULL);
		goto fw_download;
	}

	// test Annex A or B
	makeCMV(H2D_CMV_READ, INFO, 54,1, 1, &temp, Message);
	if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
		printf("\n\n read INFO 54 1 fail");
		return -1;
	}

	if(((Message[4]>>8)&0x3f)==0x1){//Annex A
		all_data = 0x9105; 
		if ((mode == MODE_992_1B) || (mode == MODE_992_3B) || (mode == MODE_992_5B))
		{	printf("\n\nWrong Argument, Annex A is running!\n\n");
			return -1;
		}
	}
	else if(((Message[4]>>8)&0x3f)==0x2){// Annex B
		all_data=0x4208;
		if ( (mode == MODE_992_1A) || (mode == MODE_992_3A) || (mode == MODE_992_5A)\
// changed by xu bingtao 09/01/2007
/*
		|| (mode == MODE_992_3I) || (mode == MODE_992_3J) ||(mode == MODE_992_3M)\
		|| (mode == MODE_992_5I) || (mode == MODE_992_5J) || (mode == MODE_992_5M))
*/
		|| (mode == MODE_992_3I) ||(mode == MODE_992_3M)\
		|| (mode == MODE_992_5I) || (mode == MODE_992_5M))
// changed by xu bingtao 09/01/2007
		{	printf("\n\nWrong Argument, Annex B is running!\n\n");
			return -1;	
		}
	}
	else{
		printf("\n\n Firmware Neither Annex A nor B\n\n");
		return -1;
	}

	/* add by tc chen */
	system("echo \"0\" > /tmp/adsl_status");

	makeCMV(H2D_CMV_READ, INFO, 55, 0, 1, &temp, Message);
	if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
		printf("\n\n read INFO 55 0 fail");
		return -1;
	}

	rt_buildcode_lsw = Message[4];
	
	makeCMV(H2D_CMV_READ, INFO, 55, 1, 1, &temp, Message);
	if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
		printf("\n\n read INFO 55 1 fail");
		return -1;
	}
	rt_buildcode_msw = Message[4];

	rt_buildcode = rt_buildcode_lsw + (rt_buildcode_msw << 16);
	printf("date: %d, month: %d, hour: %d, minute: %d\n",
		(rt_buildcode >> 0) & 0xFF,
		(rt_buildcode >> 8) & 0xFF,
		(rt_buildcode >> 16) & 0xFF,
		(rt_buildcode >> 25) & 0xFF
	      );

	while(1){
		makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &zero, Message);
		if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
			printf("\n\n write OPTN 0 0 fail");
			goto rt_reboot;
		}
		if (mode == MODE_992_1A)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x4;
			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_3A)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x100;
			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_5A)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x8100;
			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_1B)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x8;
			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_3B)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x200;
			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_5B)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x4200;
			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot;
			}
		}

		else if (mode == MODE_992_3I)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x400;
			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_3J)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x800;
			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_3M)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x2000;
			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_5I)
		{	makeCMV(H2D_CMV_READ, OPTN, 7, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 7 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x1;
			makeCMV(H2D_CMV_WRITE, OPTN, 7, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 7 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_5J)
		{	makeCMV(H2D_CMV_READ, OPTN, 7, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 7 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x2;
			makeCMV(H2D_CMV_WRITE, OPTN, 7, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 7 0 fail");
				goto rt_reboot;
			}
		}
		else if (mode == MODE_992_5M)
		{	makeCMV(H2D_CMV_READ, OPTN, 7, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 7 0 fail");
				goto rt_reboot;
			}
			temp = Message[4];
			temp|=0x4;
			makeCMV(H2D_CMV_WRITE, OPTN, 7, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 7 0 fail");
				goto rt_reboot;
			}
		}
                else if (mode == MODE_M_ALL){
			makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
                        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
                                printf("\n\n read OPTN 0 0 fail");
                                goto rt_reboot;
                        }
                        temp = Message[4];
                        temp|=0x2000;
                        makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
                        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
                                printf("\n\n write OPTN 0 0 fail");
                                goto rt_reboot;
                        }

                        makeCMV(H2D_CMV_READ, OPTN, 7, 0, 1, &temp, Message);
                        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
                                printf("\n\n read OPTN 7 0 fail");
                                goto rt_reboot;
                        }
                        temp = Message[4];
                        temp|=0x4;
                        makeCMV(H2D_CMV_WRITE, OPTN, 7, 0, 1, &temp, Message);
                        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
                                printf("\n\n write OPTN 7 0 fail");
                                goto rt_reboot;
                        }
                }
                else if (mode == MODE_B_ALL){
                        makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
                        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
                                printf("\n\n read OPTN 0 0 fail");
                                goto rt_reboot;
                        }
                        temp = Message[4];
                        temp|=0x4208;
                        makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
                        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
                                printf("\n\n write OPTN 0 0 fail");
                                goto rt_reboot;
                        }
                }else if (mode == MODE_M_B_ALL){
                        makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
                        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
                                printf("\n\n read OPTN 0 0 fail");
                                goto rt_reboot;
                }
                        temp = Message[4];
                        temp|=0x6208;
                        makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
                        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
                                printf("\n\n write OPTN 0 0 fail");
                                goto rt_reboot;
                        }
                }
		else if (mode == MODE_ALL)
		{	makeCMV(H2D_CMV_READ, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 0 0 fail");
				goto rt_reboot; 
			}
			temp = Message[4];
			temp|=all_data;
			temp|= 2; //609181:tc.chen support G.lite

			makeCMV(H2D_CMV_WRITE, OPTN, 0, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 0 0 fail");
				goto rt_reboot; 
			}
		}

		if(ioctl(fd, GET_ADSL_LOOP_DIAGNOSTICS_MODE, &j)<0){
			printf("\n\n ioctl GET_ADSL_LOOP_DIAGNOSTICS_MODE fail");
			goto rt_reboot;
		}
		if (j == 1) // LOOP DIAGNOSTICS enabled
		{
			makeCMV(H2D_CMV_READ, OPTN, 9, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n read OPTN 9 0 fail");
				goto rt_reboot; 
			}
			temp = Message[4];
			temp |= 1<<2;
			//temp = 1<<2;
			makeCMV(H2D_CMV_WRITE, OPTN, 9, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n write OPTN 9 0 fail");
				goto rt_reboot; 
			}
		}

		/************ remove in future ***********/		

		if(argc==4){	//execute script file
			strncpy(systemstr, "./translate -ef ",16);
			strcpy(systemstr+16, argv[3]);
			system(systemstr);
		}

#ifdef DEMO_ONLY
		if (mode == MODE_992_1A)
			temp=0x303;
		else
			temp=0x300;
		makeCMV(H2D_CMV_WRITE, OPTN, 1, 0, 1, &temp, Message);
		if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
			printf("\n\n write OPTN 1 0 fail");
			return -1;
		}
		temp=0x8f78;
		makeCMV(H2D_CMV_WRITE, OPTN, 2, 0, 1, &temp, Message);
		if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
			printf("\n\n write OPTN 2 0 fail");
			return -1;
		}
#endif

		makeCMV(H2D_CMV_WRITE, CNTL, 0, 0, 1, &link, Message);
		if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
			printf("\n\n set CNTL 0 0 fail");
			goto rt_reboot;
		}
		
		FarEndResponseReceived=0;
		time(&start_time);		
		timeout_limit=60;
			
		while(1){
			int	tmpQuietModeEnabled;
			tmpQuietModeEnabled = 0;
                        if(ioctl(fd, QUIET_MODE_GET, &tmpQuietModeEnabled)<0){
                                printf("\n\n ioctl QUIET_MODE_GET fail");
                                goto rt_reboot;
                        }
#if 0 // 611101:tc.chen : change to use ioctl QUIET_MODE_GET
                        makeCMV(H2D_CMV_READ, INFO, 94, 0, 1, &temp, Message);
                        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
                                printf("\n\n INFO 94 0 read fail");
                                goto rt_reboot;
                        }
			if( Message[4] == 0x0 )
				tmpQuietModeEnabled = 1;
#endif
			// check if loop diagnostic mode is changed
			if(ioctl(fd, GET_ADSL_LOOP_DIAGNOSTICS_MODE, &loop_diagnostics_mode)<0)
			{
				printf("\n\n ioctl GET_ADSL_LOOP_DIAGNOSTICS_MODE fail");
				goto rt_reboot;
			}
			if (loop_diagnostics_mode != pre_loop_diagnostics_mode)
			{
				pre_loop_diagnostics_mode = loop_diagnostics_mode;
				goto rt_reboot;
			}

			makeCMV(H2D_CMV_READ, STAT, 0, 0, 1, &rt_macrostate, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n STAT read fail");
				goto rt_reboot;
			}
	
			if(Message[4]==2)
			{
				if( tmpQuietModeEnabled == 0 ) 
					break;
			} 
		
			if((FarEndResponseReceived==0) && ((Message[4]==5) || (Message[4]==6))){
				FarEndResponseReceived=1;
				timeout_limit=60;
				time(&start_time);
			}
			
			if(Message[4]==9){
				timeout_limit=120;
				if(FarEndResponseReceived==0){
					FarEndResponseReceived=1;
					time(&start_time);
				}
			}

			if(Message[4]==3){
				if( tmpQuietModeEnabled == 0 ){ 
					sleep(5);
					break;
				} 
			}

			if(Message[4]==7){
				break;
			}
			
			if(time((time_t *)0)-start_time > timeout_limit){
				if( tmpQuietModeEnabled == 0 ) 
					break;
			}
			usleep(100000);
		}
		
		if (Message[4] != 7)
		{
			if (Message[4] == 3) // Done with loop diagnostics
			{
				ioctl(fd,LOOP_DIAGNOSTIC_MODE_COMPLETE,NULL);
				while(1)
				{
					if(ioctl(fd, GET_ADSL_LOOP_DIAGNOSTICS_MODE, &loop_diagnostics_mode)<0)
					{
						printf("\n\n ioctl GET_ADSL_LOOP_DIAGNOSTICS_MODE fail");
						goto rt_reboot;
					}
					if (loop_diagnostics_mode == 0)
					{
						pre_loop_diagnostics_mode = loop_diagnostics_mode;
						goto rt_reboot;
					}
					sleep(1);
				}
			}else
			{
				printf("\n\n Keep trying to reboot!"); 
				goto rt_reboot;	
			}
		}

		j=0;
		reboot_flag=0;
		while(reboot_flag==0){
			if(ioctl(fd, GET_ADSL_LOOP_DIAGNOSTICS_MODE, &loop_diagnostics_mode)<0)
			{
				printf("\n\n ioctl GET_ADSL_LOOP_DIAGNOSTICS_MODE fail");
				goto rt_reboot;
			}
			if (loop_diagnostics_mode != pre_loop_diagnostics_mode)
			{
				pre_loop_diagnostics_mode = loop_diagnostics_mode;
				goto rt_reboot;
			}

			makeCMV(H2D_CMV_READ, PLAM, 0, 0, 1, &rt_ne_failure_flags, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n PLAM 0 0 read fail");
				goto rt_reboot;
			}

			rt_ne_failure_flags = Message[4];
			rt_ne_los_flag=rt_ne_failure_flags & 0x1;
			
#ifndef DEMO_ONLY
			// MIB count start
			ioctl(fd, IFXMIPS_MIB_LO_ATUC, (u32*)rt_ne_failure_flags);
			makeCMV(H2D_CMV_READ, PLAM, 1, 0, 1, &temp, Message);
			
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n PLAM 1 0 read fail");
				goto rt_reboot;
			}

			ioctl(fd, IFXMIPS_MIB_LO_ATUR, (u32*)Message[4]);
			//MIB count end
#endif
			
			rt_ne_ds_margin = 0;
			makeCMV(H2D_CMV_READ, PLAM, 46, 0, 1, &rt_ne_ds_margin, Message);
			
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n PLAM 46 0 read fail");
				goto rt_reboot;
			}

			rt_ne_ds_margin = (s16)Message[4];

			if(ioctl(fd, SHOWTIME_LOCK_GET, &tmpShowTimeLockEnabled)<0){
				printf("\n\n ioctl SHOWTIME_LOCK_GET fail!");
				goto rt_reboot;
			}
#if 0 //611101:tc.chen change to ioctl SHOWTIME_LOCK
			makeCMV(H2D_CMV_READ, TEST, 29, 0, 1, &temp, Message);
			if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
				printf("\n\n TEST 29 0 read fail");
				goto rt_reboot;
			}
			if( Message[4] == 0xffff )
				tmpShowTimeLockEnabled = 1;
#endif
			/* rt_ne_ds_margin is SNR *2  */	
			if((rt_ne_los_flag!=0)|| ( rt_ne_ds_margin<(rt_ne_ds_min_margin * 2))){
				if(tmpShowTimeLockEnabled == 1) {
// changed by xu bingtao 09/01/2007 
/*
					printf("NE_LOS or NE_DS_MARGIN detected but no rebooting because of the showtime lock\n");
*/
					printf("NE_LOS or NE_DS_MARGIN detected but no rebooting because of the showtime lock\n");
					printf("  Minimum Margin: %d/2 dB  -  Expected Margin: %d dB -  LOS : %d\n",rt_ne_ds_margin, rt_ne_ds_min_margin, rt_ne_los_flag);	
// changed by xu bingtao 09/01/2007 
				}
				else
					reboot_flag=1;
			}

			usleep(1500000);

			if(j<3){//wait for several seconds before setting showtime
				makeCMV(H2D_CMV_READ, STAT, 4, 0, 1, &temp, Message);
				if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
					printf("\n\n STAT 4 0 read fail");
					goto rt_reboot;
				}
				if((Message[4]&0x2)==0x2){
					printf("\n\n setting showtime to driver\n\n");
					system("/etc/rc.d/adsl_up &"); //000001:tc.chen
					system("echo \"7\" > /tmp/adsl_status");
					printf("ADSL SHOWTIME!!\n");
					sleep(1);			
//joelin 04/16/2005
#ifndef DEMO_ONLY
					if (!first_power_on){
		
						makeCMV(H2D_CMV_WRITE,PLAM, 6, 0, 1, &nFECS_L_count, Message); 
						ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message);
	 	
						makeCMV(H2D_CMV_WRITE,PLAM, 7, 0, 1, &nES_L_count, Message); 
						ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message);
	 
	 		 		
				 		makeCMV(H2D_CMV_WRITE,PLAM, 8, 0, 1, &nSES_L_count, Message); 
						ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message);
	
	 		
						makeCMV(H2D_CMV_WRITE,PLAM, 9, 0, 1, &nLOSS_L_count, Message); 
						ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message);
			  		}									
#endif
					ioctl(fd, IFXMIPS_MEI_SHOWTIME,NULL); 	//set showtime=1 in driver			
					// 609141:tc.chen :read min margin from CO for Annex B in DMT mode
					// read adsl link mode
					read_min_snr_margin(fd, &rt_ne_ds_min_margin);
					j=1000;				
				}
				j++;
				if(j==3){//timeout, set showtimei
					printf("\n\n timeout, setting showtime to driver\n\n");
					//system("echo \"7\" > /tmp/adsl_status");
					printf("ADSL SHOWTIME!!\n");
					sleep(1);			
					ioctl(fd, IFXMIPS_MEI_SHOWTIME,NULL); 	//set showtime=1 in driver
					// 609141:tc.chen :read min margin from CO for Annex B in DMT mode
					// read adsl link mode
					read_min_snr_margin( fd, &rt_ne_ds_min_margin);
				}								
			}
		}
rt_reboot:
			        
#ifndef DEMO_ONLY
		makeCMV(H2D_CMV_READ,PLAM, 6, 0, 1, &temp, Message); 
		ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message);
 		nFECS_L_count=nFECS_L_count+Message[4];
 	
		makeCMV(H2D_CMV_READ,PLAM, 7, 0, 1, &temp, Message); 
		ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message);
 		nES_L_count=nES_L_count+Message[4]; 
 		 		
 		makeCMV(H2D_CMV_READ,PLAM, 8, 0, 1, &temp, Message); 
		ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message);
 		nSES_L_count=nSES_L_count+Message[4];
 		
		makeCMV(H2D_CMV_READ,PLAM, 9, 0, 1, &temp, Message); 
		ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message);
 		nLOSS_L_count=nLOSS_L_count+Message[4]; 
#endif

		/* add by tc chen */
		system("echo \"0\" > /tmp/adsl_status");
		printf("\n Rebooting ARC\n");
reboot_adsl:
		ioctl(fd, IFXMIPS_MEI_REBOOT,NULL);
		Download_Firmware(argv[1],fd);
		if (ioctl(fd, IFXMIPS_MEI_START,NULL)<0){
			printf("\n\n mei start fail.\n");
			goto reboot_adsl;
		}
	}

#if !defined(KERNEL_SPACE_APPLICATION)			
	close(fd);
#endif
        return 0;
}