#include #include #include #include #include #include #include #include #include #include "tprTrigAlign.hh" #include FILE* ofd = 0; static void sigHandler(int signal) { psignal(signal, "closing output file"); if (ofd) fclose(ofd); ::exit(signal); } using namespace TprTrigAlign; static const double CLK_FREQ = 1300e6/7.; extern int optind; static void usage(const char* p) { printf("Usage: %s [options]\n",p); printf(" -d : \n"); printf(" -x : set XBar\n"); printf(" -X : set XBar to loopback\n"); printf(" -r : reset NC\n"); printf(" -R : reset SC\n"); printf(" -s : fast scan\n"); printf(" -S : slow scan\n"); printf(" -f : output data filename\n"); } int main(int argc, char** argv) { extern char* optarg; char tprid='a'; int c; bool lUsage = false; bool setXbar = false; bool setXbarLb = false; bool resetNC = false; bool resetSC = false; bool lfast = false; bool lslow = false; const char* fname = 0; while ( (c=getopt( argc, argv, "d:f:FSxXrRh?")) != EOF ) { switch(c) { case 'd': tprid = optarg[0]; if (strlen(optarg) != 1) { printf("%s: option `-r' parsing error\n", argv[0]); lUsage = true; } break; case 'f': fname = optarg; break; case 'F': lfast = true; lslow = false; break; case 'r': resetNC = true; break; case 'R': resetSC = true; break; case 'S': lfast = false; lslow = true; break; case 'x': setXbar = true; break; case 'X': setXbarLb = true; break; case 'h': usage(argv[0]); exit(0); case '?': default: lUsage = true; break; } } if (optind < argc) { printf("%s: invalid argument -- %s\n",argv[0], argv[optind]); lUsage = true; } if (lUsage) { usage(argv[0]); exit(1); } struct sigaction sa; sa.sa_handler = sigHandler; sa.sa_flags = SA_RESETHAND; sigaction(SIGINT ,&sa,NULL); sigaction(SIGABRT,&sa,NULL); sigaction(SIGKILL,&sa,NULL); sigaction(SIGSEGV,&sa,NULL); { LockCore* p = reinterpret_cast(0); printf("version @%p\n",&p->version); printf("xbar @%p\n",&p->xbar); printf("app @%p\n",&p->app); printf("coreNC @%p\n",&p->coreNC); printf("coreSC @%p\n",&p->coreSC); } { char evrdev[16]; sprintf(evrdev,"/dev/tpr%c",tprid); printf("Using tpr %s\n",evrdev); int fd = open(evrdev, O_RDWR); if (fd<0) { perror("Could not open"); return -1; } void* ptr = mmap(0, sizeof(LockCore), PROT_READ|PROT_WRITE, MAP_SHARED, fd, 0); if (ptr == MAP_FAILED) { perror("Failed to map"); return -2; } LockCore& reg = *reinterpret_cast(ptr); printf("FpgaVersion: %08X\n", reg.version.FpgaVersion); printf("BuildStamp: %s\n", reg.version.buildStamp().c_str()); if (setXbar) { reg.xbar.setEvr( XBar::StraightIn ); reg.xbar.setEvr( XBar::StraightOut); reg.xbar.setTpr( XBar::StraightIn ); reg.xbar.setTpr( XBar::StraightOut); } if (setXbarLb) { reg.xbar.setEvr( XBar::LoopIn ); reg.xbar.setEvr( XBar::LoopOut); reg.xbar.setTpr( XBar::LoopIn ); reg.xbar.setTpr( XBar::LoopOut); } if (resetNC) reg.coreNC.resetRx(); if (resetSC) reg.coreSC.resetRx(); reg.coreNC.resetCounts(); reg.coreSC.resetCounts(); usleep(100000); reg.xbar.dump(); printf("-- coreNC --\n"); TprCore cache(reg.coreNC); cache.dump(); for(unsigned i=0; i<5; i++) { usleep(1000000); // reg.coreNC.dump(cache); reg.coreNC.dump(); } printf("-- coreSC --\n"); cache = reg.coreSC; reg.coreSC.dump(); for(unsigned i=0; i<5; i++) { usleep(1000000); printf("--\n"); // reg.coreSC.dump(cache); reg.coreSC.dump(); } // Just monitor the lock if (fname) { ofd = fopen(fname,"w"); if (ofd == 0) perror("Opening output file"); } unsigned iter=0; LockApp dc; while(1) { printf("-- Iteration %u\n",iter); reg.app.dump(dc); if (lfast) for(unsigned i=0; i<1000; i++) { reg.app.psincdec = 1; usleep(1000); } else usleep(1000000); if (lslow) reg.app.psincdec = 1; printf("\n"); if (ofd) fprintf(ofd, "%u: %u %u %u %u\n", iter++, dc.clks, dc.phase, dc.phaseN, dc.valid); } } return 0; }