diff options
Diffstat (limited to 'package/ifxmips_adsl/src/danube_autoboot_daemon.c')
| -rw-r--r-- | package/ifxmips_adsl/src/danube_autoboot_daemon.c | 1011 |
1 files changed, 0 insertions, 1011 deletions
diff --git a/package/ifxmips_adsl/src/danube_autoboot_daemon.c b/package/ifxmips_adsl/src/danube_autoboot_daemon.c deleted file mode 100644 index 9563b5b..0000000 --- a/package/ifxmips_adsl/src/danube_autoboot_daemon.c +++ /dev/null @@ -1,1011 +0,0 @@ -/**************************************************************************** - - 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; -} |