add ifx adsl tools

SVN-Revision: 9900

1 files changed, 216 insertions, 0 deletions

diff --git a/package/ifxmips_adsl/src/cmvread.c b/package/ifxmips_adsl/src/cmvread.c
new file mode 100644
index 0000000000..7e5eecd0f6
--- /dev/null
+++ b/package/ifxmips_adsl/src/cmvread.c
@@ -0,0 +1,216 @@
+/*
+ *   This program is free software; you can redistribute it and/or modify
+ *   it under the terms of the GNU General Public License as published by
+ *   the Free Software Foundation; either version 2 of the License, or
+ *   (at your option) any later version.
+ *
+ *   This program is distributed in the hope that it will be useful,
+ *   but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *   GNU General Public License for more details.
+ *
+ *   You should have received a copy of the GNU General Public License
+ *   along with this program; if not, write to the Free Software
+ *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
+ */
+//-----------------------------------------------------------------------
+//Description:	
+// read the CMV register under Linux for Amazon
+//-----------------------------------------------------------------------
+//Author:	Joe.Lin@infineon.com
+//Created:	31-December-2004
+//-----------------------------------------------------------------------
+/* History
+ * Last changed on:
+ *  000002:tc.chen 2005/06/10 add get_adsl_rate and ifx_makeCMV api
+ * Last changed by: 
+ *
+*/
+
+#define _IFXMIPS_ADSL_APP
+//#define DEBUG
+#define u32 unsigned int
+#define u16 unsigned short
+#define u8  unsigned char
+#define IFXMIPS_MEI_DEV  "/dev/ifxmips/mei"
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <string.h>
+#include <time.h>
+#include <getopt.h>
+#include <sys/types.h>
+#include <sys/ioctl.h>
+#include <sys/stat.h>
+#include <sys/time.h>
+#include <sys/mman.h>
+#include <asm/ifxmips/ifxmips_mei_app_ioctl.h>
+#include <asm/ifxmips/ifxmips_mei_app.h>
+#include <asm/ifxmips/ifxmips_mei_ioctl.h>
+#include <asm/ifxmips/ifxmips_mei.h>
+
+#ifdef IFX_MULTILIB_UTIL 
+#define main	cmvread_main
+#define	display_version	cmvread_display_version
+#endif
+
+/*============================definitions======================*/
+#define OPTN 5
+#define CNFG 8
+#define CNTL 1
+#define STAT 2
+#define RATE 6
+#define PLAM 7
+#define INFO 3
+#define TEST 4
+
+typedef unsigned short UINT16;
+typedef unsigned long UINT32;
+
+
+
+/*=============================================================*/
+
+
+/*=============================global variables================*/
+int c=0;
+int input_flag=0;
+int digit_optind=0;
+FILE* script_file;
+void (*func)()=NULL;
+int fd;
+
+UINT16 var16[8];
+UINT32 var32[8];
+UINT16 Message[16];
+
+/*=============================================================*/
+
+int ifx_makeCMV(unsigned char opcode, unsigned char group, unsigned short address, unsigned short index, int size, unsigned short * data, unsigned short *Message, int msg_len)
+{
+        if (msg_len < 16*2)
+                return -1;
+        memset(Message, 0, 16*2);
+        Message[0]= (opcode<<4) + (size&0xf);
+        if(opcode == H2D_DEBUG_WRITE_DM)
+                Message[1]= (group&0x7f);
+        else
+                Message[1]= (((index==0)?0:1)<<7) + (group&0x7f);
+        Message[2]= address;
+        Message[3]= index;
+        if((opcode == H2D_CMV_WRITE)||(opcode == H2D_DEBUG_WRITE_DM))
+                memcpy(Message+4, data, size*2);
+
+        return 0;
+}
+
+void display_version()
+{
+   printf("adsl cmv reader version1.0\nby Joe Lin \nJoe.Lin@infineon.com\n");
+   return;
+}
+
+
+void cmvreader_help()
+{
+    printf("Usage:cmvread [options] [group name][address][index][size] ...\n");
+    printf("options:\n");
+    printf("	-h --help            Display help information\n");       
+    printf("	-v --version         Display version information\n");
+    printf("group name:			--group name of CMV to read\n");
+    printf("	OPTN --Read CMV Group 5 \n");
+    printf("	CNFG --Read CMV Group 8 \n");
+    printf("	CNTL --Read CMV Group 1 \n"); 
+    printf("	STAT --Read CMV Group 2 \n");  
+    printf("	RATE --Read CMV Group 6 \n");  
+    printf("	PLAM --Read CMV Group 7 \n");  
+    printf("	INFO --Read CMV Group 3 \n");  
+    printf("	TEST --REad CMV Group 4 \n");  
+    printf("address --address value of CMV to read\n"); 
+    printf("index --index value of CMV to read\n");     
+    printf("size  --number of words(16bits) to read \n");        
+   
+    
+ 
+    return;
+}
+
+int main (int argc, char** argv) {
+     
+	UINT16 Message[16]; //000002:tc.chen
+  	char *endptr; 
+        int group=0,address,index,size;
+
+ 	if (argc < 2)
+	{
+	  cmvreader_help();
+	  return;
+	}
+ 
+ 	if (strstr(argv[1], "-h") != NULL){
+ 	  cmvreader_help();
+	  return;
+ 	}
+ 
+  	if (strstr(argv[1], "-v") != NULL){
+ 	  display_version();
+	  return;
+ 	}
+ 
+        fd=open(IFXMIPS_MEI_DEV, O_RDWR);
+        if(fd<0){
+                printf("\n\n autoboot open device fail\n");
+                return -1;
+        }
+        
+	if((strcmp(argv[1],"optn")==0)||(strcmp(argv[1],"OPTN")==0))
+	group=OPTN;
+	else if((strcmp(argv[1],"cnfg")==0)||(strcmp(argv[1],"CNFG")==0))
+	group=CNFG;
+	else if((strcmp(argv[1],"cntl")==0)||(strcmp(argv[1],"CNTL")==0))
+	group=CNTL;
+	else if((strcmp(argv[1],"stat")==0)||(strcmp(argv[1],"STAT")==0))
+	group=STAT;
+	else if((strcmp(argv[1],"rate")==0)||(strcmp(argv[1],"RATE")==0))
+	group=RATE;
+	else if((strcmp(argv[1],"plam")==0)||(strcmp(argv[1],"PLAM")==0))
+	group=PLAM;
+	else if((strcmp(argv[1],"info")==0)||(strcmp(argv[1],"INFO")==0))
+	group=INFO;
+	else if((strcmp(argv[1],"test")==0)||(strcmp(argv[1],"TEST")==0))
+	group=TEST;
+	else 
+	 {
+	   printf("wrong group type!\nplease slect group:OPTN CNFG CNTL STAT RATE PLAM INFO TEST \n");
+                close(fd);
+                exit(0);
+	 }
+	 
+	address = strtoul(argv[2], &endptr, 0);
+	index = strtoul(argv[3], &endptr, 0);
+	size = strtoul(argv[4], &endptr, 0);
+        //makeCMV(H2D_CMV_READ, group, address, index, size, NULL);
+        ifx_makeCMV(H2D_CMV_READ, group, address, index, size, NULL,Message,sizeof(Message));
+        if(ioctl(fd, IFXMIPS_MEI_CMV_WINHOST, &Message)<0){
+                printf("cr read %d %d %d fail",group,address,index);
+                close(fd);
+                exit(0);
+        }
+
+	int i;
+	for (i=0;i<size;i++) printf ("0x%X\n",Message[i+4]);
+	
+        
+//	return Message[4];
+        
+        
+        
+   
+	close(fd);
+ 	return 0;	     
+}
+
+
+