Subversion Repositories f9daq

// ./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();

}