(root)/pts/PtsModule.c - Rev 81
Rev 15 |
Blame |
Compare with Previous |
Last modification |
View Log
| RSS feed
// ./pts -a 0x1000000 -v 1 -w 2 turn LED ON
// ./pts -a 0x1000000 -v 1 -w 1 turn LED OFF
#include <stdlib.h>
#include <stdio.h>
#include <stdint.h>
#include <ctype.h>
#include <unistd.h>
#include <string.h>
#include "PtsModule.h"
#include <getopt.h>
void Delay
(double t
){
usleep
(t
*1e6);
}
uint32_t ptaddr
=0;
int Pts_write
(uint32_t addr
, uint32_t data
){
fprintf(stderr
, "Pts_write ADDR 0x%04x 0x%04x ",addr
,ptaddr
+addr
);
int nb
=VME_A32D32_W
(ptaddr
+addr
,&data
);
fprintf(stderr
, " nb=%d\n",nb
);
return nb
;
}
int Pts_Mwrite
(uint32_t addr
, uint32_t data
){
VME_A32D32_MW
(ptaddr
+addr
,&data
);
return 1;
}
int Pts_read
(uint32_t addr
, uint32_t *data
){
fprintf(stderr
, "Pts_read ADDR 0x%04x 0x%04x ",addr
,ptaddr
+addr
);
int nb
=VME_A32D32_R
(ptaddr
+addr
,data
);
fprintf(stderr
, " nb=%d\n",nb
);
return nb
;
}
int Pts_erase
( int verbose
) {
uint32_t dum
= 0;
Pts_write
( ADR_CSR1
, 0 );
Delay
(0.1);
Pts_read
( ADR_CSR1
, &dum
);
if( verbose
) fprintf( stderr
, "CSR1(0x%02x) = 0x%04x <<<<\n", ADR_CSR1
,
dum
& 0xffff );
Pts_write
( ADR_CSR1
, CSR1_PROGRAM_
);
Delay
(0.1);
Pts_read
( ADR_CSR1
, &dum
);
if( verbose
) fprintf(stderr
, "CSR1(0x%02x) = 0x%04x >>>>>\n", ADR_CSR1
,
dum
& 0xffff );
return 1;
}
/*
int Pts_configure( const char *filename, int mode, int verbose ) {
int len = strlen( filename );
if( len > 4 ) {
const char *p = filename+len-4;
if( strcmp(p,".bit")==0 ) return Pts_configure_bit( filename, mode, verbose );
if( strcmp(p,".rbt")==0 ) return Pts_configure_rbt( filename, mode, verbose );
}
if( verbose ) fprintf( stderr, "Bad filename: \"%s\" .\n" );
return -1;
}
int PtsModule::configure_rbt( const char *filename, int mode, int verbose ) {
long n, pos;
char cs[1024];
FILE *fp;
if( ( fp = fopen( filename, "r" ) ) == NULL ) {
if( verbose ) fprintf( stderr, "cannot open \"%s\"\n", filename );
return -1;
}
if( verbose ) printf( "file \"%s\" opened.\n", filename );
do{
pos = ftell(fp);
fgets( cs, sizeof(cs), fp );
puts(cs);
n=strlen(cs);
} while( n==0 || strspn( cs, " \t\n01" )!=n );
fseek( fp, pos, SEEK_SET );
long nchar = 0;
if( mode == SLAVESERIAL_MODE ) {
write( ADR_MODE, SLAVESERIAL_MODE );
erase( verbose );
int c;
const long bit_per_dot = BYTE_PER_DOT*8;
while( (c=getc(fp))!=EOF ){
if( c=='0' || c=='1' ) {
write( ADR_CFG, c=='0' ? 0 : 1 );
nchar++;
if( verbose && ++nchar%bit_per_dot==0 ) putchar('.');
}
else if( isspace(c) ) continue;
else {
fprintf( stderr, "(%ld) illegal character : %c\n", nchar, c );
fclose(fp);
return -1;
}
}
} else if(mode == SELECTMAP_MODE) {
if(verbose) fprintf(stderr, "\nselectmap mode (rbt file) not supported\n");
return -1;
} else {
if(verbose) fprintf(stderr, "\nIllegal mode\n");
return -1;
}
if(verbose) printf("\ntotal %ld bits\n", nchar);
fclose(fp);
return check_configure( verbose );
}
*/
int Pts_configure_bit
( const char *filename
, int mode
, int verbose
) {
int c
,j
;
int dummyword
;
FILE
*fp
;
const long byte_per_dot
= BYTE_PER_DOT
;
unsigned long nchar
= 0;
if( ( fp
= fopen( filename
, "rb" ) ) == NULL
) {
if( verbose
) fprintf( stderr
, "cannot open \"%s\"\n", filename
);
return -1;
}
if(verbose
) printf( "Verbose= %d File \"%s\" opened.\n", verbose
,filename
);
/* ------------------------------------------------------------ *\
The data for the configuration start from 0xffff_ffff_aa99_aa66
( cf. xapp138; we don't know the definition of the BIT file )
\* ------------------------------------------------------------ */
dummyword
= 0;
do{
if( (c
= getc( fp
)) == EOF
) {
if(verbose
) fprintf(stderr
, "EOF detected. Exit.\n");
return -1;
}
(c
== 0xff) ? dummyword
++ : (dummyword
=0);
} while( dummyword
< 4 );
// const long byte_per_dot = BYTE_PER_DOT;
// unsigned long nchar = 0;
if( mode
== SLAVESERIAL_MODE
) {
if(verbose
) fprintf(stderr
, "slave serial mode");
Pts_write
( ADR_MODE
, mode
);
Pts_erase
( verbose
);
for( j
=0; j
<32; j
++ ) Pts_write
( ADR_CFG
, 0x1 );
while(!feof(fp
))
{
int nb
= fread(&c
,1,1,fp
);
if (nb
<=0) continue;
//while( (c=getc(fp))!=EOF ){
for( j
=0; j
<8; j
++ ) Pts_write
( ADR_CFG
, (c
>>(7-j
))&0x1 );
nchar
++;
if( verbose
&& nchar
%byte_per_dot
==0 ) putchar('.');
}
} else if( mode
== SELECTMAP_MODE
) {
if( verbose
) fprintf(stderr
, "select map mode ....");
Pts_write
( ADR_MODE
, SELECTMAP_MODE
);
Pts_erase
( verbose
);
fprintf(stderr
, "-------------\n");
//if( verbose ) fprintf(stderr, "program ....\n");
for( j
=0; j
<4; j
++ ) {
fprintf(stderr
, "%d ------------\n", j
);
Pts_write
( ADR_CFG
, 0xff );
}
fprintf(stderr
, "at line %d -------------\n", __LINE__
);
VME_MWRST
();
while(!feof(fp
))
{
int nb
= fread(&c
,1,1,fp
);
if (nb
<=0) continue;
// while ( (c=getc(fp))!=EOF ){
if (feof(fp
)) {
if(verbose
) fprintf(stderr
, "feof detected. Exit.\n");
return -1;
}
int cc
= 0;
for(j
=0; j
<8; j
++) cc
|= ((c
&(1<<j
))>>j
)<<(7-j
);
//fprintf(stderr, "s");
Pts_Mwrite
( ADR_CFG
, cc
);
nchar
++;
if( verbose
&& nchar
%byte_per_dot
==0 ) {
fprintf(stderr
, "#");
VME_MWEXEC
();
VME_MWRST
();
fprintf(stderr
, ".");
}
}
} else {
if(verbose
) fprintf(stderr
, "\nIllegal mode\n");
return -1;
}
if(verbose
) fprintf(stderr
, "\ntotal %ld bits\n", nchar
);
if (fp
) fclose(fp
);
return Pts_check_configure
( verbose
);
}
int Pts_check_configure
( int verbose
) {
uint32_t csr1_value
;
Pts_read
(ADR_CSR1
,&csr1_value
);
if(verbose
) printf("CSR1(0x%02x)=0x%04x\n",ADR_CSR1
,csr1_value
&0xffff);
if(csr1_value
&CSR1_DONE
) {
if(verbose
) fprintf(stderr
, "configure complete.\n");
return 1;
} else {
if(verbose
) fprintf(stderr
, "configure not complete.\n");
return -1;
}
}
int Pts_reset
( int verbose
) {
Pts_write
(ADR_CSR0
,1);
if( verbose
) printf( "CSR0(0x%02x) = 0x01\n", ADR_CSR0
);
return 1;
}
int Pts_write_csr
( int verbose
, uint32_t value
) {
Pts_write
(ADR_CSR0
,value
);
if( verbose
) printf( "Pts_write_csr 0x%08x\n", value
);
return 1;
}
void help
(char *argv
){
printf("Usage: %s -a <ptsaddr> -v <verbose> -c .... Pts_check_configure\n", argv
);
printf("Usage: %s -a <ptsaddr> -v <verbose> -i <filename> -b mode (2) ... Pts_configure_bit\n", argv
);
printf("Usage: %s -a <ptsaddr> -v <verbose> -e .... Pts_erase\n", argv
);
printf("Usage: %s -a <ptsaddr> -v <verbose> -x .... Pts_reset\n", argv
);
printf("Usage: %s -a <ptsaddr> -v <verbose> -c .... Pts_check_configure\n", argv
);
printf("Usage: %s -a <ptsaddr> -v <verbose> -r .... vme read\n", argv
);
printf("Usage: %s -a <ptsaddr> -v <verbose> -w <value> .... vme write\n", argv
);
printf("Usage: %s -a <ptsaddr> -v <verbose> -s <value> .... Pts_write_csr\n", argv
);
printf("Example: %s --address 0x1000000 --verbose 1 --erase\n", argv
);
printf("Example: %s --address 0x1000000 --verbose 1 --input pts_scaler.bit --load-bit 2\n", argv
);
printf("Example: %s --address 0x1000004 --write-csr 0x7600\n", argv
);
}
static const char *optString
= "v:rxea:cs:w:i:b:h";
static const struct option longOpts
[] = {
{ "verbose", required_argument
, NULL
, 'v' },
{ "reset" , no_argument
, NULL
, 'x' },
{ "erase" , no_argument
, NULL
, 'e' },
{ "address", required_argument
, NULL
, 'a' },
{ "check-configure", no_argument
, NULL
, 'c' },
{ "write-csr", required_argument
, NULL
, 's' },
{ "input", required_argument
, NULL
, 'i' },
{ "load-bit", required_argument
, NULL
, 'b' },
{ "read", no_argument
, NULL
, 'r' },
{ "write",required_argument
, NULL
, 'w' },
{ "help", no_argument
, NULL
, 'h' },
{ NULL
, no_argument
, NULL
, 0 }
};
int main
(int argc
, char ** argv
){
uint32_t value
;
int verbose
=0;
char filename
[256]="file.bit";
int c
;
opterr
= 0;
int longIndex
= 0;
if (argc
<2) {
help
(argv
[0]);
exit(-1);
}
VME_START
(NULL
);
c
= getopt_long
( argc
, argv
, optString
, longOpts
, &longIndex
);
while( c
!= -1 )
// while ((c = getopt (argc, argv, "v:xrea:csw:i:b:h")) != -1)
{
switch (c
)
{
case 'v':
verbose
= atoi(optarg
);
break;
case 'x':
Pts_reset
(verbose
);
break; // reset
case 'e':
Pts_erase
(verbose
);
break; // erase
case 'a':
ptaddr
= strtoul (optarg
,NULL
,0);
break; // address
case 'c':
Pts_check_configure
( verbose
);
break;
case 'w':
value
= strtoul (optarg
,NULL
,0);
Pts_write
( 0 , value
);
break;
case 'r':
value
= 0;
Pts_read
( 0 , &value
);
break;
case 's':
value
= strtoul (optarg
,NULL
,0);
Pts_write_csr
( verbose
, value
);
break;
case 'i':
sprintf(filename
,"%s",optarg
);
break; // data width
case 'b':
//#define SELECTMAP_MODE 2
//#define SLAVESERIAL_MODE 3
value
= strtoul (optarg
,NULL
,0);
Pts_configure_bit
( filename
, value
, verbose
);
break;
case 'h':
help
(argv
[0]);
break;
default:
printf("Unknown command %c\n",c
);
}
c
= getopt_long
( argc
, argv
, optString
, longOpts
, &longIndex
);
}
VME_STOP
();
}