#include <stdio.h>
|
#include <stdio.h>
|
#include <stdlib.h>
|
#include <stdlib.h>
|
#include <ctype.h>
|
#include <ctype.h>
|
#include <stdint.h>
|
#include <stdint.h>
|
#include <unistd.h> // getopt
|
#include <unistd.h> // getopt
|
#include <inttypes.h>
|
#include <inttypes.h>
|
#include <string.h>
|
#include <string.h>
|
#include "jtag.h"
|
#include "jtag.h"
|
|
|
|
|
|
|
/* functions */
|
/* functions */
|
int send_binary_file();
|
int send_binary_file();
|
int read_mem();
|
int read_mem();
|
void usage();
|
void usage();
|
void processArgs (int , char** );
|
void processArgs (int , char** );
|
int send_data ();
|
int send_data ();
|
int hexcut( char * , unsigned * , int );
|
int hexcut( char * , unsigned * , int );
|
void vdr_large (unsigned , char * , char *);
|
void vdr_large (unsigned , char * , char *);
|
void hexgen( char * , unsigned *, int );
|
void hexgen( char * , unsigned *, int );
|
|
|
int main(int argc, char **argv) {
|
int main(int argc, char **argv) {
|
|
|
processArgs (argc, argv );
|
processArgs (argc, argv );
|
printf("index num=%u\n",index_num);
|
printf("index num=%u\n",index_num);
|
printf("Initial Vjtag for %s & %s\n",hardware_name,dev_num);
|
printf("Initial Vjtag for %s & %s.\n",hardware_name,dev_num);
|
if (jtag_init(hardware_name,dev_num)){
|
if (jtag_init(hardware_name,dev_num)){
|
fprintf (stderr, "Error openning jtag IP with %d index num\n",index_num);
|
fprintf (stderr, "Error openning jtag IP with %d index num\n",index_num);
|
return -1;
|
return -1;
|
}
|
}
|
|
printf("Vjtag is initilized\n");
|
if (enable_binary_send) {
|
if (enable_binary_send) {
|
if( send_binary_file() == -1) return -1;
|
if( send_binary_file() == -1) return -1;
|
}
|
}
|
|
|
if (enable_binary_read){
|
if (enable_binary_read){
|
if( read_mem() == -1) return -1;
|
if( read_mem() == -1) return -1;
|
|
|
}
|
}
|
|
|
if (write_data!=0){
|
if (write_data!=0){
|
printf("send %s to jtag\n",write_data);
|
printf("send %s to jtag\n",write_data);
|
send_data();
|
send_data();
|
|
|
|
|
}
|
}
|
|
|
return 0;
|
return 0;
|
}
|
}
|
|
|
|
|
|
|
void usage(){
|
void usage(){
|
|
|
printf ("usage:./jtag_main [-n index number] [-i file_name][-c][-s rd/wr offset address][-d string]\n");
|
printf ("usage:./jtag_main [-n index number] [-i file_name][-c][-s rd/wr offset address][-d string]\n");
|
printf ("\t-a hardware_name to be matched: i.e. \"DE-SoC *\" for den10-nano or \"USB-Blaster*\" for de0-nano \n");
|
printf ("\t-a hardware_name to be matched: i.e. \"DE-SoC *\" for den10-nano or \"USB-Blaster*\" for de0-nano \n");
|
printf ("\t-b device number in chain: i.e. \"@2*\" for den10-nano (second dev in chain) or \"@1*\" for de0-nano (first dev in chain)\n");
|
printf ("\t-b device number in chain: i.e. \"@2*\" for den10-nano (second dev in chain) or \"@1*\" for de0-nano (first dev in chain)\n");
|
printf ("\t-n index number: the target jtag IP core index number. The default number is 126\n");
|
printf ("\t-n index number: the target jtag IP core index number. The default number is 126\n");
|
printf ("\t-i file_name: input binary file name (.bin file)\n");
|
printf ("\t-i file_name: input binary file name (.bin file)\n");
|
printf ("\t-r read memory content and display in terminal\n");
|
printf ("\t-r read memory content and display in terminal\n");
|
printf ("\t-w bin file word width in byte. default is 4 bytes (32 bits)\n");
|
printf ("\t-w bin file word width in byte. default is 4 bytes (32 bits)\n");
|
printf ("\t-c verify after write\n");
|
printf ("\t-c verify after write\n");
|
printf ("\t-s memory wr/rd offset address in byte (hex format). The default value is 0x0000000\n");
|
printf ("\t-s memory wr/rd offset address in byte (hex format). The default value is 0x0000000\n");
|
printf ("\t-e memory boundary address in byte (hex format). The default value is 0xFFFFFFFF\n");
|
printf ("\t-e memory boundary address in byte (hex format). The default value is 0xFFFFFFFF\n");
|
printf ("\t-d string: use for setting instruction or data value to jtag tap. string format : \"instr1,instr2,...,instrn\"\n \tinstri = I:instruct_num: send instruct_num to instruction register \n \tD:data_size_in_bit:data : send data in hex to data register\n \tR:data_size_in_bit:data : Read data register and show it on screan then write given data in hex to data register\n");
|
printf ("\t-d string: use for setting instruction or data value to jtag tap. string format : \"instr1,instr2,...,instrn\"\n \tinstri = I:instruct_num: send instruct_num to instruction register \n \tD:data_size_in_bit:data : send data in hex to data register\n \tR:data_size_in_bit:data : Read data register and show it on screan then write given data in hex to data register\n");
|
|
|
}
|
}
|
|
|
void processArgs (int argc, char **argv )
|
void processArgs (int argc, char **argv )
|
{
|
{
|
char c;
|
char c;
|
int p;
|
int p;
|
|
|
/* don't want getopt to moan - I can do that just fine thanks! */
|
/* don't want getopt to moan - I can do that just fine thanks! */
|
opterr = 0;
|
opterr = 0;
|
if (argc < 2) usage();
|
if (argc < 2) usage();
|
while ((c = getopt (argc, argv, "s:e:d:n:i:w:a:b:cr")) != -1)
|
while ((c = getopt (argc, argv, "s:e:d:n:i:w:a:b:cr")) != -1)
|
{
|
{
|
switch (c)
|
switch (c)
|
{
|
{
|
case 'a': /* hardware_name */
|
case 'a': /* hardware_name */
|
hardware_name = optarg;
|
hardware_name = optarg;
|
break;
|
break;
|
case 'b': /* device number in chain */
|
case 'b': /* device number in chain */
|
dev_num = optarg;
|
dev_num = optarg;
|
break;
|
break;
|
|
|
|
|
case 'n': /* index number */
|
case 'n': /* index number */
|
index_num = atoi(optarg);
|
index_num = atoi(optarg);
|
break;
|
break;
|
case 'i': /* input binary file name */
|
case 'i': /* input binary file name */
|
binary_file_name = optarg;
|
binary_file_name = optarg;
|
enable_binary_send=1;
|
enable_binary_send=1;
|
break;
|
break;
|
case 'r': /* read memory */
|
case 'r': /* read memory */
|
enable_binary_read=1;
|
enable_binary_read=1;
|
break;
|
break;
|
case 'w': /* word width in byte */
|
case 'w': /* word width in byte */
|
word_width= atoi(optarg);
|
word_width= atoi(optarg);
|
break;
|
break;
|
case 'c': /* enable write verify */
|
case 'c': /* enable write verify */
|
write_verify= 1;
|
write_verify= 1;
|
break;
|
break;
|
case 'd': /* send string */
|
case 'd': /* send string */
|
write_data= optarg;
|
write_data= optarg;
|
break;
|
break;
|
case 's': /* set offset address*/
|
case 's': /* set offset address*/
|
|
|
p=sscanf(optarg,"%x",&memory_offset);
|
p=sscanf(optarg,"%x",&memory_offset);
|
if( p==0){
|
if( p==0){
|
fprintf (stderr, "invalid memory offset adress format `%s'.\n", optarg);
|
fprintf (stderr, "invalid memory offset adress format `%s'.\n", optarg);
|
usage();
|
usage();
|
exit(1);
|
exit(1);
|
}
|
}
|
//printf("p=%d,memory_offset=%x\n",p,memory_offset);
|
//printf("p=%d,memory_offset=%x\n",p,memory_offset);
|
break;
|
break;
|
case 'e': /* wmemory boundary address */
|
case 'e': /* wmemory boundary address */
|
p=sscanf(optarg,"%x",&memory_boundary);
|
p=sscanf(optarg,"%x",&memory_boundary);
|
if( p==0){
|
if( p==0){
|
fprintf (stderr, "invalid memory boundary adress format `%s'.\n", optarg);
|
fprintf (stderr, "invalid memory boundary adress format `%s'.\n", optarg);
|
usage();
|
usage();
|
exit(1);
|
exit(1);
|
}
|
}
|
break;
|
break;
|
|
|
case '?':
|
case '?':
|
if (isprint (optopt))
|
if (isprint (optopt))
|
fprintf (stderr, "Unknown option `-%c'.\n", optopt);
|
fprintf (stderr, "Unknown option `-%c'.\n", optopt);
|
else
|
else
|
fprintf (stderr,
|
fprintf (stderr,
|
"Unknown option character `\\x%x'.\n",
|
"Unknown option character `\\x%x'.\n",
|
optopt);
|
optopt);
|
default:
|
default:
|
usage();
|
usage();
|
exit(1);
|
exit(1);
|
}
|
}
|
}
|
}
|
}
|
}
|
|
|
unsigned * read_file (FILE * fp, unsigned int * n ){
|
unsigned * read_file (FILE * fp, unsigned int * n ){
|
|
|
unsigned * buffer;
|
unsigned * buffer;
|
unsigned val;
|
unsigned val;
|
unsigned char ch;
|
unsigned char ch;
|
unsigned int i=0;
|
unsigned int i=0;
|
char cnt=0;
|
char cnt=0;
|
unsigned int num=0;
|
unsigned int num=0;
|
unsigned int width= (BYTE_NUM < sizeof(unsigned )) ? BYTE_NUM : sizeof(unsigned ); //max is 4 then
|
unsigned int width= (BYTE_NUM < sizeof(unsigned )) ? BYTE_NUM : sizeof(unsigned ); //max is 4 then
|
fseek(fp, 0, SEEK_END); // seek to end of file
|
fseek(fp, 0, SEEK_END); // seek to end of file
|
num = ftell(fp); // get current file pointer
|
num = ftell(fp); // get current file pointer
|
*n=num;// number of bytes from the beginning of the file
|
*n=num;// number of bytes from the beginning of the file
|
|
|
|
|
|
|
|
|
num=(num/width)+2;
|
num=(num/width)+2;
|
fseek(fp, 0, SEEK_SET);
|
fseek(fp, 0, SEEK_SET);
|
//printf ("num=%u\n",num);
|
//printf ("num=%u\n",num);
|
buffer = (unsigned *) malloc(num * sizeof(unsigned ) ); //memory allocated using malloc
|
buffer = (unsigned *) malloc(num * sizeof(unsigned ) ); //memory allocated using malloc
|
if(buffer == NULL)
|
if(buffer == NULL)
|
{
|
{
|
printf("Error! memory not allocated.");
|
printf("Error! memory not allocated.");
|
exit(0);
|
exit(0);
|
}
|
}
|
ch=fgetc(fp);
|
ch=fgetc(fp);
|
|
|
while(!feof(fp)){
|
while(!feof(fp)){
|
val<<=8;
|
val<<=8;
|
val|=ch;
|
val|=ch;
|
cnt++;
|
cnt++;
|
//printf("ch=%x\t",ch);
|
//printf("ch=%x\t",ch);
|
if(cnt==width){
|
if(cnt==width){
|
//printf("%d:%x\n",i,val);
|
//printf("%d:%x\n",i,val);
|
buffer[i] = val;
|
buffer[i] = val;
|
val=0;
|
val=0;
|
cnt=0;
|
cnt=0;
|
i++;
|
i++;
|
}
|
}
|
ch=fgetc(fp);
|
ch=fgetc(fp);
|
}
|
}
|
if( cnt>0){
|
if( cnt>0){
|
val<<=(8 *(width-cnt));
|
val<<=(8 *(width-cnt));
|
printf("%d:%x\n",i,val);
|
printf("%d:%x\n",i,val);
|
buffer[i] = val;
|
buffer[i] = val;
|
|
|
}
|
}
|
|
|
return buffer;
|
return buffer;
|
|
|
}
|
}
|
|
|
|
|
|
|
int send_data ()
|
int send_data ()
|
{
|
{
|
char * pch;
|
char * pch;
|
char string[100];
|
char string[100];
|
int bit=0, inst=0, d=0;
|
int bit=0, inst=0, d=0;
|
char out[100];
|
char out[100];
|
pch = strtok (write_data,",");
|
pch = strtok (write_data,",");
|
//printf("%s\n",pch);
|
//printf("%s\n",pch);
|
while (pch != NULL)
|
while (pch != NULL)
|
{
|
{
|
while(1){
|
while(1){
|
d=1;
|
d=1;
|
if(sscanf( pch, "D:%d:%s", &bit, string )) break;
|
if(sscanf( pch, "D:%d:%s", &bit, string )) break;
|
if(sscanf( pch, "d:%d:%s", &bit, string )) break;
|
if(sscanf( pch, "d:%d:%s", &bit, string )) break;
|
//if(sscanf( pch, "D:%d:" PRIx64 , &bit, &data )) break;
|
//if(sscanf( pch, "D:%d:" PRIx64 , &bit, &data )) break;
|
//if(sscanf( pch, "d:%d:%016x", &bit, &data )) break;
|
//if(sscanf( pch, "d:%d:%016x", &bit, &data )) break;
|
d=2;
|
d=2;
|
if(sscanf( pch, "R:%d:%s",&bit, string)) break;
|
if(sscanf( pch, "R:%d:%s",&bit, string)) break;
|
if(sscanf( pch, "r:%d:%s",&bit, string)) break;
|
if(sscanf( pch, "r:%d:%s",&bit, string)) break;
|
d=0;
|
d=0;
|
if(sscanf( pch, "I:%d", &inst)) break;
|
if(sscanf( pch, "I:%d", &inst)) break;
|
if(sscanf( pch, "i:%d", &inst)) break;
|
if(sscanf( pch, "i:%d", &inst)) break;
|
printf("invalid format : %s\n",pch);
|
printf("invalid format : %s\n",pch);
|
return -1;
|
return -1;
|
|
|
}
|
}
|
if(d==1){
|
if(d==1){
|
//printf ("(bit=%d, data=%s)\n",bit, string);
|
//printf ("(bit=%d, data=%s)\n",bit, string);
|
//jtag_vdr(bit, data, 0);
|
//jtag_vdr(bit, data, 0);
|
vdr_large(bit,string,0);
|
vdr_large(bit,string,0);
|
}if(d==2){
|
}if(d==2){
|
|
|
vdr_large(bit,string,out);
|
vdr_large(bit,string,out);
|
vdr_large(bit,string,out);
|
vdr_large(bit,string,out);
|
printf("###read data#%s###read data#\n",out);
|
printf("###read data#%s###read data#\n",out);
|
}else{
|
}else{
|
|
|
jtag_vir(inst);
|
jtag_vir(inst);
|
//printf("%d\n",inst);
|
//printf("%d\n",inst);
|
}
|
}
|
|
|
pch = strtok (NULL, ",");
|
pch = strtok (NULL, ",");
|
|
|
}
|
}
|
return 0;
|
return 0;
|
}
|
}
|
|
|
int compare_values( unsigned * val1, unsigned * val2, int words, unsigned int address){
|
int compare_values( unsigned * val1, unsigned * val2, int words, unsigned int address){
|
|
|
int i,error=0;
|
int i,error=0;
|
for(i=0;i<words;i++){
|
for(i=0;i<words;i++){
|
if (val1[i] != val2[i]) error=1;
|
if (val1[i] != val2[i]) error=1;
|
}
|
}
|
if(error){
|
if(error){
|
printf ("Error: missmatched at location %d. Expected 0X",address);
|
printf ("Error: missmatched at location %d. Expected 0X",address);
|
for(i=0;i<words;i++) printf("%08X",val1[i] );
|
for(i=0;i<words;i++) printf("%08X",val1[i] );
|
printf (" but read 0X");
|
printf (" but read 0X");
|
for(i=0;i<words;i++) printf("%08X",val2[i] );
|
for(i=0;i<words;i++) printf("%08X",val2[i] );
|
printf ("\n");
|
printf ("\n");
|
|
|
}
|
}
|
return error;
|
return error;
|
|
|
|
|
}
|
}
|
|
|
void print_values( unsigned * val2, int words){
|
void print_values( unsigned * val2, int words){
|
int i;
|
int i;
|
for(i=0;i<words;i++) printf("%08X",val2[words-i-1] );
|
for(i=0;i<words;i++) printf("%08X",val2[words-i-1] );
|
printf ("\n");
|
printf ("\n");
|
}
|
}
|
|
|
|
|
void reorder_buffer(unsigned * buff, unsigned int words){
|
void reorder_buffer(unsigned * buff, unsigned int words){
|
unsigned tmp;
|
unsigned tmp;
|
unsigned int i;
|
unsigned int i;
|
for(i=0;i<words/2;i++){
|
for(i=0;i<words/2;i++){
|
tmp= buff[i];
|
tmp= buff[i];
|
buff[i]=buff[i+words-1];
|
buff[i]=buff[i+words-1];
|
buff[i+words-1]=tmp;
|
buff[i+words-1]=tmp;
|
}
|
}
|
}
|
}
|
|
|
|
|
|
|
|
|
int send_binary_file(){
|
int send_binary_file(){
|
FILE *fp;
|
FILE *fp;
|
int i=0;
|
int i=0;
|
unsigned out;
|
unsigned out;
|
unsigned int file_size=0;
|
unsigned int file_size=0;
|
unsigned int num=0;
|
unsigned int num=0;
|
unsigned int mem_size;
|
unsigned int mem_size;
|
unsigned int memory_offset_in_word;
|
unsigned int memory_offset_in_word;
|
unsigned * small_buff;
|
unsigned * small_buff;
|
int words= (BYTE_NUM % sizeof(unsigned )) ? (BYTE_NUM / sizeof(unsigned ) )+1 : (BYTE_NUM / sizeof(unsigned ));
|
int words= (BYTE_NUM % sizeof(unsigned )) ? (BYTE_NUM / sizeof(unsigned ) )+1 : (BYTE_NUM / sizeof(unsigned ));
|
|
|
small_buff = (unsigned *) malloc(words * sizeof(unsigned ) );
|
small_buff = (unsigned *) malloc(words * sizeof(unsigned ) );
|
unsigned * read_buff;
|
unsigned * read_buff;
|
read_buff = (unsigned *) calloc(words , sizeof(unsigned ) );
|
read_buff = (unsigned *) calloc(words , sizeof(unsigned ) );
|
|
|
|
|
printf("send %s to the wishbone bus\n",binary_file_name);
|
printf("send %s to the wishbone bus\n",binary_file_name);
|
fp = fopen(binary_file_name,"rb");
|
fp = fopen(binary_file_name,"rb");
|
if (!fp) {
|
if (!fp) {
|
fprintf (stderr,"Error: can not open %s file in read mode\n",binary_file_name);
|
fprintf (stderr,"Error: can not open %s file in read mode\n",binary_file_name);
|
return -1;
|
return -1;
|
}
|
}
|
unsigned * buffer;
|
unsigned * buffer;
|
buffer=read_file (fp, &file_size);
|
buffer=read_file (fp, &file_size);
|
mem_size=memory_boundary-memory_offset;
|
mem_size=memory_boundary-memory_offset;
|
if(file_size>mem_size){
|
if(file_size>mem_size){
|
printf("\n\n Warning: %s file size (%x) is larger than the given memory size (%x). I will stop writing on end of memory address\n\n",binary_file_name,file_size,mem_size);
|
printf("\n\n Warning: %s file size (%x) is larger than the given memory size (%x). I will stop writing on end of memory address\n\n",binary_file_name,file_size,mem_size);
|
file_size=mem_size;
|
file_size=mem_size;
|
}
|
}
|
fclose(fp);
|
fclose(fp);
|
|
|
//disable the cpu
|
//disable the cpu
|
jtag_vir(RD_WR_STATUS);
|
jtag_vir(RD_WR_STATUS);
|
jtag_vdr(BIT_NUM, 0x1, &out);
|
jtag_vdr(BIT_NUM, 0x1, &out);
|
jtag_vir(UPDATE_WB_ADDR);
|
jtag_vir(UPDATE_WB_ADDR);
|
|
|
|
|
// change memory sizes from byte to word
|
// change memory sizes from byte to word
|
memory_offset_in_word=memory_offset /BYTE_NUM;
|
memory_offset_in_word=memory_offset /BYTE_NUM;
|
//size of buffer
|
//size of buffer
|
num= (BYTE_NUM < sizeof(unsigned )) ? file_size /BYTE_NUM : file_size /sizeof(unsigned );
|
num= (BYTE_NUM < sizeof(unsigned )) ? file_size /BYTE_NUM : file_size /sizeof(unsigned );
|
|
|
jtag_vdr(BIT_NUM, memory_offset_in_word, 0);
|
jtag_vdr(BIT_NUM, memory_offset_in_word, 0);
|
jtag_vir(UPDATE_WB_WR_DATA);
|
jtag_vir(UPDATE_WB_WR_DATA);
|
|
|
printf ("start programing\n");
|
printf ("start programing\n");
|
//printf ("num=%d\n",num);
|
//printf ("num=%d\n",num);
|
for(i=0;i<num;i++){
|
for(i=0;i<num;i++){
|
//printf("%d:%x\n",i,buffer[i]);
|
//printf("%d:%x\n",i,buffer[i]);
|
|
|
if(BYTE_NUM <= sizeof(unsigned )){
|
if(BYTE_NUM <= sizeof(unsigned )){
|
//printf("%d:%x\n",i,buffer[i]);
|
//printf("%d:%x\n",i,buffer[i]);
|
jtag_vdr(BIT_NUM, buffer[i], 0);
|
jtag_vdr(BIT_NUM, buffer[i], 0);
|
}else {
|
}else {
|
//printf("%d:%x\n",i,buffer[i]);
|
//printf("%d:%x\n",i,buffer[i]);
|
reorder_buffer(&buffer[i],words);
|
reorder_buffer(&buffer[i],words);
|
jtag_vdr_long(BIT_NUM, &buffer[i], 0, words);
|
jtag_vdr_long(BIT_NUM, &buffer[i], 0, words);
|
i+= (words-1);
|
i+= (words-1);
|
|
|
}
|
}
|
}
|
}
|
|
|
//printf ("done programing\n");
|
//printf ("done programing\n");
|
if(write_verify){
|
if(write_verify){
|
if(!(fp = fopen(binary_file_name,"rb"))){
|
if(!(fp = fopen(binary_file_name,"rb"))){
|
fprintf (stderr,"Error: can not open %s file in read mode\n",binary_file_name);
|
fprintf (stderr,"Error: can not open %s file in read mode\n",binary_file_name);
|
return -1;
|
return -1;
|
}
|
}
|
buffer=read_file (fp, &file_size);
|
buffer=read_file (fp, &file_size);
|
|
|
|
|
|
|
//fclose(fp);
|
//fclose(fp);
|
jtag_vir(UPDATE_WB_RD_DATA);
|
jtag_vir(UPDATE_WB_RD_DATA);
|
jtag_vdr(BIT_NUM,memory_offset_in_word+0, &out);
|
jtag_vdr(BIT_NUM,memory_offset_in_word+0, &out);
|
jtag_vdr(BIT_NUM,memory_offset_in_word+1, &out);
|
jtag_vdr(BIT_NUM,memory_offset_in_word+1, &out);
|
|
|
|
|
if(BYTE_NUM <= sizeof(unsigned )){
|
if(BYTE_NUM <= sizeof(unsigned )){
|
//printf("vdr\n");
|
//printf("vdr\n");
|
for(i=2;i<=num; i++){
|
for(i=2;i<=num; i++){
|
jtag_vdr(BIT_NUM, memory_offset_in_word+i, &out);
|
jtag_vdr(BIT_NUM, memory_offset_in_word+i, &out);
|
if(out!=buffer[i-2]) printf ("Error: missmatched at location %d. Expected %x but read %x\n",i-2,buffer[i-2], out);
|
if(out!=buffer[i-2]) printf ("Error: missmatched at location %d. Expected %x but read %x\n",i-2,buffer[i-2], out);
|
}
|
}
|
jtag_vdr(BIT_NUM, 0, &out);
|
jtag_vdr(BIT_NUM, 0, &out);
|
if(out!=buffer[i-2]) printf ("Error: missmatched at location %d. Expected %x but read %x\n",i-2,buffer[i-2], out);i++;
|
|
jtag_vdr(BIT_NUM, 1, &out);
|
|
if(out!=buffer[i-2]) printf ("Error: missmatched at location %d. Expected %x but read %x\n",i-2,buffer[i-2], out);
|
if(out!=buffer[i-2]) printf ("Error: missmatched at location %d. Expected %x but read %x\n",i-2,buffer[i-2], out);
|
|
jtag_vdr(BIT_NUM, 1, &out);
|
|
if(out!=buffer[i-1]) printf ("Error: missmatched at location %d. Expected %x but read %x\n",i-1,buffer[i-1], out);
|
|
|
}
|
}
|
else{
|
else{
|
//printf("vdr_long\n");
|
//printf("vdr_long\n");
|
for(i=2*words;i<=num; i+=words){
|
for(i=2*words;i<=num; i+=words){
|
read_buff[0]= memory_offset_in_word+i/words;
|
read_buff[0]= memory_offset_in_word+i/words;
|
jtag_vdr_long(BIT_NUM, read_buff, small_buff, words);
|
jtag_vdr_long(BIT_NUM, read_buff, small_buff, words);
|
reorder_buffer(&buffer[i-2*words],words);
|
reorder_buffer(&buffer[i-2*words],words);
|
compare_values(&buffer[i-2*words],small_buff,words,i/words);
|
compare_values(&buffer[i-2*words],small_buff,words,i/words);
|
|
|
}
|
}
|
|
|
}
|
}
|
printf ("write is verified\n");
|
printf ("write is verified\n");
|
|
|
}
|
}
|
//enable the cpu
|
//enable the cpu
|
jtag_vir(RD_WR_STATUS);
|
jtag_vir(RD_WR_STATUS);
|
jtag_vdr(BIT_NUM, 0, &out);
|
jtag_vdr(BIT_NUM, 0, &out);
|
//printf ("status=%x\n",out);
|
//printf ("status=%x\n",out);
|
free(buffer);
|
free(buffer);
|
return 0;
|
return 0;
|
}
|
}
|
|
|
|
|
int read_mem(){
|
int read_mem(){
|
int i=0;
|
int i=0;
|
unsigned int num=0;
|
unsigned int num=0;
|
unsigned int mem_size;
|
unsigned int mem_size;
|
unsigned int memory_offset_in_word;
|
unsigned int memory_offset_in_word;
|
unsigned out;
|
unsigned out;
|
unsigned * small_buff;
|
unsigned * small_buff;
|
int words= (BYTE_NUM % sizeof(unsigned )) ? (BYTE_NUM / sizeof(unsigned ) )+1 : (BYTE_NUM / sizeof(unsigned ));
|
int words= (BYTE_NUM % sizeof(unsigned )) ? (BYTE_NUM / sizeof(unsigned ) )+1 : (BYTE_NUM / sizeof(unsigned ));
|
|
|
small_buff = (unsigned *) malloc(words * sizeof(unsigned ) );
|
small_buff = (unsigned *) malloc(words * sizeof(unsigned ) );
|
unsigned * read_buff;
|
unsigned * read_buff;
|
read_buff = (unsigned *) calloc(words , sizeof(unsigned ) );
|
read_buff = (unsigned *) calloc(words , sizeof(unsigned ) );
|
memory_offset_in_word=memory_offset /BYTE_NUM;
|
memory_offset_in_word=memory_offset /BYTE_NUM;
|
mem_size=memory_boundary-memory_offset;
|
mem_size=memory_boundary-memory_offset;
|
num= (BYTE_NUM < sizeof(unsigned )) ? mem_size /BYTE_NUM : mem_size /sizeof(unsigned );
|
num= (BYTE_NUM < sizeof(unsigned )) ? mem_size /BYTE_NUM : mem_size /sizeof(unsigned );
|
|
|
jtag_vir(UPDATE_WB_RD_DATA);
|
jtag_vir(UPDATE_WB_RD_DATA);
|
jtag_vdr(BIT_NUM, memory_offset_in_word+0, &out);
|
jtag_vdr(BIT_NUM, memory_offset_in_word+0, &out);
|
jtag_vdr(BIT_NUM, memory_offset_in_word+1, &out);
|
jtag_vdr(BIT_NUM, memory_offset_in_word+1, &out);
|
|
|
printf("\n###read data#\n");
|
printf("\n###read data#\n");
|
|
|
if(BYTE_NUM <= sizeof(unsigned )){
|
if(BYTE_NUM <= sizeof(unsigned )){
|
//printf("vdr\n");
|
//printf("vdr\n");
|
for(i=2;i<=num; i++){
|
for(i=2;i<=num; i++){
|
jtag_vdr(BIT_NUM, memory_offset_in_word+i, &out);
|
jtag_vdr(BIT_NUM, memory_offset_in_word+i, &out);
|
printf("%X\n",out);
|
printf("%X\n",out);
|
}
|
}
|
jtag_vdr(BIT_NUM, 0, &out);
|
jtag_vdr(BIT_NUM, 0, &out);
|
printf("%X\n",out);
|
printf("%X\n",out);
|
|
|
jtag_vdr(BIT_NUM, 1, &out);
|
jtag_vdr(BIT_NUM, 1, &out);
|
printf("%X\n",out);
|
printf("%X\n",out);
|
|
|
|
|
}
|
}
|
else{
|
else{
|
//printf("vdr_long\n");
|
//printf("vdr_long\n");
|
for(i=2*words;i<=num+2; i+=words){
|
for(i=2*words;i<=num+2; i+=words){
|
//printf("%d,%d,%d\n",i,words,num);
|
//printf("%d,%d,%d\n",i,words,num);
|
read_buff[0]= memory_offset_in_word+i/words;
|
read_buff[0]= memory_offset_in_word+i/words;
|
jtag_vdr_long(BIT_NUM, read_buff, small_buff, words);
|
jtag_vdr_long(BIT_NUM, read_buff, small_buff, words);
|
print_values(small_buff, words);
|
print_values(small_buff, words);
|
|
|
}
|
}
|
|
|
}
|
}
|
printf("\n###read data#\n");
|
printf("\n###read data#\n");
|
|
|
//enable the cpu
|
//enable the cpu
|
jtag_vir(RD_WR_STATUS);
|
jtag_vir(RD_WR_STATUS);
|
jtag_vdr(BIT_NUM, 0, &out);
|
jtag_vdr(BIT_NUM, 0, &out);
|
//printf ("status=%x\n",out);
|
//printf ("status=%x\n",out);
|
free(read_buff);
|
free(read_buff);
|
return 0;
|
return 0;
|
}
|
}
|
|
|
|
|
|
|
void vdr_large (unsigned sz, char * string, char *out){
|
void vdr_large (unsigned sz, char * string, char *out){
|
int words= (sz%32)? (sz/32)+1 : sz/32;
|
int words= (sz%32)? (sz/32)+1 : sz/32;
|
unsigned val[64],val_o[64];
|
unsigned val[64],val_o[64];
|
//printf("data=%s\t",string);
|
//printf("data=%s\t",string);
|
hexcut(string, val, words );
|
hexcut(string, val, words );
|
|
|
|
|
if( out == 0) {
|
if( out == 0) {
|
jtag_vdr_long(sz,val,0,words);
|
jtag_vdr_long(sz,val,0,words);
|
return;
|
return;
|
}
|
}
|
jtag_vdr_long(sz,val,val_o,words);
|
jtag_vdr_long(sz,val,val_o,words);
|
//printf("rdata=%s\n",out);
|
//printf("rdata=%s\n",out);
|
hexgen( out, val_o, words );
|
hexgen( out, val_o, words );
|
|
|
|
|
|
|
}
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|