add ifx adsl tools
SVN-Revision: 9900
This commit is contained in:
John Crispin
221
package/ifxmips_adsl/src/cmvwrite.c
Normal file
221
package/ifxmips_adsl/src/cmvwrite.c
Normal file
@@ -0,0 +1,221 @@
|
||||
/*
|
||||
* 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:
|
||||
* 507051:linmars 2005/07/5 fix makeCMV problem
|
||||
* 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 cmvwrite_main
|
||||
#define display_version cmvwrite_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================*/
|
||||
#ifdef IFX_MULTILIB_UTIL
|
||||
extern int c;
|
||||
extern int input_flag;
|
||||
extern int digit_optind;
|
||||
extern FILE* script_file;
|
||||
extern void (*func)();
|
||||
extern int fd;
|
||||
|
||||
UINT16 var16[8];
|
||||
UINT32 var32[8];
|
||||
UINT16 Message[16];
|
||||
#else
|
||||
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];
|
||||
#endif
|
||||
/*=============================================================*/
|
||||
/*165001:henryhsu 2005/9/7 Modify some error in cmvwrite utility*/
|
||||
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 write version1.0\nby Joe Lin \nJoe.Lin@infineon.com\n");
|
||||
return;
|
||||
}
|
||||
|
||||
//165001:henryhsu 2005/9/7 No need to check this any more
|
||||
//#ifndef IFX_MULTILIB_UTIL
|
||||
|
||||
//void cmvreader_help()
|
||||
void cmvwrite_help()
|
||||
{
|
||||
printf("Usage:cmvwrite [options] [group name][address][index][data] ...\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 -- CMV Group 5 \n");
|
||||
printf(" CNFG -- CMV Group 8 \n");
|
||||
printf(" CNTL -- CMV Group 1 \n");
|
||||
printf(" STAT -- CMV Group 2 \n");
|
||||
printf(" RATE -- CMV Group 6 \n");
|
||||
printf(" PLAM -- CMV Group 7 \n");
|
||||
printf(" INFO -- CMV Group 3 \n");
|
||||
printf(" TEST -- CMV Group 4 \n");
|
||||
printf("address --address value of CMV to write\n");
|
||||
printf("index --index value of CMV to write\n");
|
||||
printf("data --data to write in Hex.\n");
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
int main (int argc, char** argv) {
|
||||
|
||||
char *endptr;
|
||||
unsigned short value;
|
||||
if (argc < 2)
|
||||
{
|
||||
cmvwrite_help();
|
||||
return;
|
||||
}
|
||||
|
||||
if (strstr(argv[1], "-h") != NULL){
|
||||
cmvwrite_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;
|
||||
}
|
||||
|
||||
|
||||
|
||||
int group=0,address,index,size;
|
||||
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, 10);
|
||||
index = strtoul(argv[3], &endptr, 10);
|
||||
|
||||
value = strtoul(argv[4],NULL,0);
|
||||
ifx_makeCMV(H2D_CMV_WRITE, group, address, index, 1, &value, 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);
|
||||
}
|
||||
|
||||
printf ("write %s %d %d 0x%X\n",argv[1],address,index,value);
|
||||
|
||||
close(fd);
|
||||
return 0;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user