Rev 109 | Details | Compare with Previous | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line | 
|---|---|---|---|
| 109 | f9daq | 1 | #include <stdio.h> | 
        
| 2 | #include <stdlib.h> | 
        ||
| 3 | #include <string.h> | 
        ||
| 4 | #include <unistd.h> | 
        ||
| 5 | #include <sys/mman.h> | 
        ||
| 6 | #include <sys/ioctl.h> | 
        ||
| 7 | #include <errno.h> | 
        ||
| 8 | #include <signal.h> | 
        ||
| 9 | #include <ctype.h> | 
        ||
| 10 | #include <time.h> | 
        ||
| 11 | #include <sys/time.h> | 
        ||
| 12 | |||
| 13 | #include "wusbxx_dll.h" /* the header of the shared library */ | 
        ||
| 14 | #include "daq.h" | 
        ||
| 15 | |||
| 16 | #define DEVICE_NAME "/dev/cc32_1" | 
        ||
| 17 | #define PRRES(X) printf(">>> %s -> %d\n",#X,(X)) | 
        ||
| 18 | |||
| 19 | |||
| 20 | |||
| 21 | /* definiram lokacije enot*/ | 
        ||
| 22 | //#define NTDC 23         /* TDC LeCroy 2277*/ | 
        ||
| 23 | #define NTDC 16         /* TDC LeCroy 2277*/ | 
        ||
| 24 | #define END_MARKER 0xFAF5 | 
        ||
| 25 | int ctrlc=0;  | 
        ||
| 26 | int timer_out=0;  | 
        ||
| 27 | |||
| 28 | void SigInt (int sig)  | 
        ||
| 29 | { | 
        ||
| 30 | ctrlc = 1;  | 
        ||
| 31 | timer_out=1;  | 
        ||
| 32 | |||
| 33 | } | 
        ||
| 34 | |||
| 35 | struct sigaction oact;  | 
        ||
| 36 | void timerast (int signumber)  | 
        ||
| 37 | { | 
        ||
| 38 | timer_out = 1;  | 
        ||
| 39 | printf("->>> TIMEOUT !!!\n");  | 
        ||
| 40 | } | 
        ||
| 41 | |||
| 42 | void tmlnk (int tout)  | 
        ||
| 43 | { | 
        ||
| 44 | timer_out = 0;  | 
        ||
| 45 | struct sigaction act;  | 
        ||
| 46 | struct itimerval tdelay;  | 
        ||
| 47 | |||
| 48 | act.sa_handler = timerast;  | 
        ||
| 49 | sigemptyset (&act.sa_mask);  | 
        ||
| 50 | act.sa_flags = 0;  | 
        ||
| 51 | |||
| 52 | tdelay.it_value.tv_sec = tout / 100;  | 
        ||
| 53 | tdelay.it_value.tv_usec = 10000 * (tout % 100);  | 
        ||
| 54 | tdelay.it_interval.tv_sec = 0;  | 
        ||
| 55 | tdelay.it_interval.tv_usec = 0;  | 
        ||
| 56 | |||
| 57 | if (sigaction (SIGALRM, &act, &oact) < 0)  | 
        ||
| 58 | { | 
        ||
| 59 | perror ("sigaction(tmlnk)");  | 
        ||
| 60 | exit (EXIT_FAILURE);  | 
        ||
| 61 |     } | 
        ||
| 62 | if (setitimer (ITIMER_REAL, &tdelay, NULL) < 0)  | 
        ||
| 63 |     { | 
        ||
| 64 | perror ("setitimer(tmlnk)");  | 
        ||
| 65 | exit (EXIT_FAILURE);  | 
        ||
| 66 |     } | 
        ||
| 67 | } | 
        ||
| 68 | |||
| 69 | void tmulk ()  | 
        ||
| 70 | { | 
        ||
| 71 | struct itimerval tdelay;  | 
        ||
| 72 | |||
| 73 | tdelay.it_value.tv_sec = 0;  | 
        ||
| 74 | tdelay.it_value.tv_usec = 0;  | 
        ||
| 75 | tdelay.it_interval.tv_sec = 0;  | 
        ||
| 76 | tdelay.it_interval.tv_usec = 0;  | 
        ||
| 77 | |||
| 78 | if (setitimer (ITIMER_REAL, &tdelay, NULL) < 0)  | 
        ||
| 79 |     { | 
        ||
| 80 | perror ("setitimer(tmulk)");  | 
        ||
| 81 | exit (EXIT_FAILURE);  | 
        ||
| 82 |     } | 
        ||
| 83 | if (sigaction (SIGALRM, &oact, NULL) < 0)  | 
        ||
| 84 |     { | 
        ||
| 85 | perror ("sigaction(tmulk)");  | 
        ||
| 86 | exit (EXIT_FAILURE);  | 
        ||
| 87 |     } | 
        ||
| 88 | } | 
        ||
| 89 | |||
| 90 | |||
| 91 | |||
| 92 | |||
| 93 | void CAMAC_status(void)  | 
        ||
| 94 | { | 
        ||
| 95 | unsigned short id,fpga,modid,inhibit,lam;  | 
        ||
| 96 | unsigned short dum;  | 
        ||
| 97 | |||
| 98 | |||
| 99 | long cres;  | 
        ||
| 100 | int q,x;  | 
        ||
| 101 | |||
| 102 | CSSA_RQX(0,0,0,&cres,&q,&x);  | 
        ||
| 103 | dum = cres;  | 
        ||
| 104 | id = (dum & 0xF000) >> 12;  | 
        ||
| 105 | fpga = (dum & 0x0F00) >> 8;  | 
        ||
| 106 | modid = (dum & 0x00F0) >> 4;  | 
        ||
| 107 | q = (dum & 0x0008) >> 3;  | 
        ||
| 108 | x = (dum & 0x0004) >> 2;  | 
        ||
| 109 | inhibit= (dum & 0x0002) >> 1;  | 
        ||
| 110 | lam = (dum & 0x0001);  | 
        ||
| 111 | printf ("CC32 CSR ID=%x FPGA=%x modID=%x Q=%d X=%d INHIBIT=%d LAM=%d \n",id,fpga,modid, q,x,inhibit,lam);  | 
        ||
| 112 | } | 
        ||
| 113 | |||
| 114 | int daq::init(){  | 
        ||
| 115 | |||
| 116 | printf("DAQ init at 0x%x\n",(unsigned int *) udev);  | 
        ||
| 117 | if (udev == NULL) connect();  | 
        ||
| 118 | if (udev == NULL) printf("udev == NULL\n");  | 
        ||
| 119 | xxusb_register_write(udev,1,0x0); // Stop DAQ mode  | 
        ||
| 120 | while (xxusb_usbfifo_read(udev, (int*) stackdump,BUFF_L,100)>0);  | 
        ||
| 121 | |||
| 122 | printf("DAQ init finished\n");  | 
        ||
| 123 |   CCCZ; | 
        ||
| 124 |   CCCC; | 
        ||
| 125 | |||
| 126 |   CREM_I; | 
        ||
| 127 | long cres;  | 
        ||
| 128 | int q,x;  | 
        ||
| 129 | |||
| 130 |   // set status registerdevices_find | 
        ||
| 131 |   //int tdcreg2277=0x8C00; // status register common start (green LED),Front panel timeout ,leading+trailing | 
        ||
| 132 |   //  tdcreg2277= 0xC00;   //  status register common stop (red LED)                        ,leading + trailing edge recording | 
        ||
| 133 | int tdcreg2277= 0xCC00; // status register common start (green LED),8192 ns timeout ,leading+trailing  | 
        ||
| 134 | |||
| 135 | CSSA_WQX(NTDC,0,17,tdcreg2277,&q,&x);  | 
        ||
| 136 | CSSA_RQX(NTDC,0,17,&cres,&q,&x);  | 
        ||
| 137 | |||
| 138 | printf("LC2277 SetRegister 0x%04x GetRegister 0x%04x\n",tdcreg2277,(unsigned int)cres);  | 
        ||
| 139 | |||
| 140 | CAMAC_status();  | 
        ||
| 141 | |||
| 142 |   // listmode data ----------------------------------------------- | 
        ||
| 143 | |||
| 144 | long k=1;  | 
        ||
| 145 | |||
| 146 | |||
| 147 |   /* | 
        ||
| 148 |     stackwrite[k++]=(NAF(NTDC,0,8))| 0x8000 ; // test lam | 
        ||
| 149 |     stackwrite[k++]=0x80 ; // wait for lam | 
        ||
| 150 | |||
| 151 | |||
| 152 |     stackwrite[k++]=(NAF(NTDC,1,27))| 0x8000;  // test buffering | 
        ||
| 153 |     stackwrite[k++]=0x10 | 0x8000 ; //until Q=0 | 
        ||
| 154 |     stackwrite[k++]=0xF ; //max repetitions | 
        ||
| 155 | |||
| 156 |     stackwrite[k++]=NAFS(0,0,16); | 
        ||
| 157 |     stackwrite[k++]=0xbeef; | 
        ||
| 158 | |||
| 159 |     stackwrite[k++]=(NAF(NTDC,9,27))| 0x8000;  // test buffering | 
        ||
| 160 |     stackwrite[k++]=0x10 | 0x8000 ; //until Q=0 | 
        ||
| 161 |     stackwrite[k++]=0xFF ; //max repetitions | 
        ||
| 162 | |||
| 163 |     stackwrite[k++]=NAFS(0,0,16); | 
        ||
| 164 |     stackwrite[k++]=0xbeef; | 
        ||
| 165 | */ | 
        ||
| 166 | |||
| 167 | |||
| 168 | stackwrite[k++]=(NAF(NTDC,0,0))| 0x8000; // read TDC  | 
        ||
| 169 | stackwrite[k++]=0x10 | 0x8000 ; //until Q=0  | 
        ||
| 170 | stackwrite[k++]=0xF ; //max repetitions  | 
        ||
| 171 | |||
| 172 | stackwrite[k++]=NAF(NTDC,0,9) ; // clear tdc  | 
        ||
| 173 | |||
| 174 | stackwrite[k++]=NAF(NTDC,0,10) ; // clear lam  | 
        ||
| 175 | |||
| 176 | |||
| 177 | //    stackwrite[k++]=NAF(NTDC,0,1);  // read status register | 
        ||
| 178 | stackwrite[k++]=NAFS(0,0,16);  | 
        ||
| 179 | stackwrite[k++]=END_MARKER;  | 
        ||
| 180 | stackwrite[0]=k-1;  | 
        ||
| 181 | |||
| 182 | for(unsigned int i=0;i<stackwrite[0];i++) printf("0x%04lx\n",stackwrite[i+1]);  | 
        ||
| 183 | |||
| 184 | CAMAC_LED_settings(udev, 1,1,0,0);  | 
        ||
| 185 | xxusb_stack_write(udev,0x2,(long int *)stackwrite);  | 
        ||
| 186 | PRRES(xxusb_stack_read(udev,0x2,(long int *) stackdata));  | 
        ||
| 187 | for(int i=0;i<13;i++) printf("0x%04lx\n",stackdata[i]);  | 
        ||
| 188 | |||
| 189 | PRRES(CAMAC_register_read(udev,0,&k));  | 
        ||
| 190 | char tbline[300];  | 
        ||
| 191 | sprintf(tbline,"Firmware ID -> 0x%08lX",k);  | 
        ||
| 192 | printf("%s\n",tbline);  | 
        ||
| 193 | |||
| 194 | CAMAC_register_read(udev,1,&k);  | 
        ||
| 195 | sprintf(tbline,"Global Mode -> 0x%08lX",k);  | 
        ||
| 196 | printf("%s\n",tbline);  | 
        ||
| 197 | k=(k&0xF000)|0x0006;  | 
        ||
| 198 |     //                    k=0x0002; | 
        ||
| 199 | k=7;// Start DAQ mode Buffopt=7 single event  | 
        ||
| 200 | CAMAC_register_write(udev,1,k);  | 
        ||
| 201 | CAMAC_register_write(udev,2,0x80); // wait 0x80 us  | 
        ||
| 202 | CAMAC_register_write(udev,3,0x0);  | 
        ||
| 203 | CAMAC_register_write(udev,9,0x0);  | 
        ||
| 204 | CAMAC_register_write(udev,14,0x0);  | 
        ||
| 205 | |||
| 206 | return 0;  | 
        ||
| 207 | } | 
        ||
| 208 | |||
| 209 | int daq::connect(){  | 
        ||
| 210 | /*xxusb_device_type devices[100]; | 
        ||
| 211 | struct usb_device *dev; | 
        ||
| 212 | dev = devices[0].usbdev; | 
        ||
| 213 | udev = xxusb_device_open(dev);*/ | 
        ||
| 214 | WUSBXX_load (NULL);  | 
        ||
| 215 | //    WUSBXX_open ((char *)"CC0126"); | 
        ||
| 216 | WUSBXX_open ((char *)"CC0130");  | 
        ||
| 217 | printf("daq::connect()\n");  | 
        ||
| 218 | return 0;  | 
        ||
| 219 | } | 
        ||
| 220 | |||
| 221 | int daq::disconnect(){  | 
        ||
| 222 |   /* zakljuci */ | 
        ||
| 223 | |||
| 224 | printf("daq::disconnect()\n");  | 
        ||
| 225 | return 0;  | 
        ||
| 226 | } | 
        ||
| 227 | |||
| 228 | |||
| 229 | int daq::event(unsigned int *data, int maxn){  | 
        ||
| 230 | |||
| 231 |   //int events=0;   | 
        ||
| 232 | |||
| 233 | short ret;  | 
        ||
| 234 | |||
| 235 | |||
| 236 | |||
| 237 |   //while ((events==0)&&(!fStop)){  | 
        ||
| 238 | int tout=100; /* 1/100 of a second */  | 
        ||
| 239 | tmlnk (tout);  | 
        ||
| 240 | |||
| 241 | ret=xxusb_usbfifo_read(udev,(int *) data,BUFF_L,500);  | 
        ||
| 242 | tmulk();  | 
        ||
| 243 | |||
| 244 | |||
| 245 |   // printf("ret=%d,events=0x%08x\n",ret,data[0]); | 
        ||
| 246 |   //} | 
        ||
| 247 | |||
| 248 | |||
| 249 | return ret*2;  | 
        ||
| 250 | } | 
        ||
| 251 | |||
| 252 | |||
| 253 | |||
| 254 | daq::daq(){  | 
        ||
| 255 | // intercept routine | 
        ||
| 256 | if (signal (SIGINT, SigInt) == SIG_ERR) perror ("sigignore");  | 
        ||
| 257 | |||
| 258 | fStop=0;  | 
        ||
| 259 | connect();  | 
        ||
| 260 | init();  | 
        ||
| 261 | xxusb_register_write(udev,1,0x1); // Start DAQ mode  | 
        ||
| 262 | } | 
        ||
| 263 | |||
| 264 | daq::~daq(){  | 
        ||
| 265 | xxusb_register_write(udev,1,0x0); // Stop DAQ mode  | 
        ||
| 266 | while (xxusb_usbfifo_read(udev,(int *)stackdump,BUFF_L,30)>0);  | 
        ||
| 267 | |||
| 268 | disconnect();  | 
        ||
| 269 | } | 
        ||
| 270 | |||
| 271 | #ifdef MAIN | 
        ||
| 272 | |||
| 273 | |||
| 274 | |||
| 275 | int main (int argc, char **argv){  | 
        ||
| 276 | |||
| 277 | int debug=0;  | 
        ||
| 278 | int neve=1000000;  | 
        ||
| 279 | char fname[0xFF];  | 
        ||
| 280 | sprintf(fname, "test.dat");  | 
        ||
| 281 | if (argc==1) {  | 
        ||
| 282 | printf("Uporaba: %s stevilo_dogodkov ime_datoteke\n",argv[0]);  | 
        ||
| 283 | printf("Meritev prekini s Ctrl-C, ce je nabranih dogodkov ze dovolj\n");  | 
        ||
| 284 | exit(0);  | 
        ||
| 285 |   } | 
        ||
| 286 | if (argc>1) neve = atoi(argv[1]);  | 
        ||
| 287 | if (argc>2) sprintf(fname,"%s", argv[2]);  | 
        ||
| 288 | if (argc>3) debug = atoi(argv[3]);  | 
        ||
| 289 | |||
| 290 | |||
| 291 | |||
| 292 |   // odpremo datoteko za pisanje | 
        ||
| 293 | FILE *fp=fopen(fname,"w");  | 
        ||
| 294 | |||
| 295 | int hdr[4]={1};  | 
        ||
| 296 | |||
| 297 |   #define BSIZE 10000 | 
        ||
| 298 | unsigned int data[BSIZE];  | 
        ||
| 299 | daq *d= new daq();  | 
        ||
| 300 | |||
| 301 | for (int ieve=0;ieve!=neve && !ctrlc ;ieve++){  | 
        ||
| 302 |     //int tout=100; /* 1/100 of a second */ | 
        ||
| 303 |     //tmlnk (tout); | 
        ||
| 304 | int nb=d->event(data,BSIZE);  | 
        ||
| 305 |     //tmulk(); | 
        ||
| 306 |     // zapis v datoteko    | 
        ||
| 110 | f9daq | 307 | if (nb<0){  | 
        
| 308 |       ieve--; | 
        ||
| 309 | continue;  | 
        ||
| 310 |     } | 
        ||
| 109 | f9daq | 311 | hdr[1]=nb+4*sizeof(int);  | 
        
| 312 | hdr[2]=time(NULL);  | 
        ||
| 313 | hdr[3]=ieve;  | 
        ||
| 314 | |||
| 315 | fwrite(hdr, sizeof(int),4 , fp);  | 
        ||
| 316 | fwrite(data, sizeof(int),nb, fp);  | 
        ||
| 317 | //***************** | 
        ||
| 318 | int evsize=0;  | 
        ||
| 319 | int events=0;  | 
        ||
| 320 | int ib=1,count=0;  | 
        ||
| 321 | events = data[0];  | 
        ||
| 322 | evsize = data[ib++]&0xffff;  | 
        ||
| 323 | if (ieve %100 == 0) printf("nb=%d Event:%d events=%d EvSize:%d\n",nb, ieve, events, evsize);  | 
        ||
| 110 | f9daq | 324 | if (evsize<2) {  | 
        
| 325 |       ieve--; | 
        ||
| 326 | continue;  | 
        ||
| 327 |     } | 
        ||
| 109 | f9daq | 328 | for (int i=0;i<evsize;i++) {  | 
        
| 329 |        //if (debug) printf("%d\t%08x\n", ib, data[ib]); | 
        ||
| 330 | if (data[ib]== END_MARKER) break;  | 
        ||
| 110 | f9daq | 331 | if (ib%2==0) {  | 
        
| 109 | f9daq | 332 | unsigned short word1 =data[ib ]&0xFFFF;  | 
        
| 333 | unsigned short word2 =data[ib+1]&0xFFFF;  | 
        ||
| 334 | unsigned short tdc = word1;  | 
        ||
| 335 | unsigned short ch = (word2 >> 1 ) &0x1F;  | 
        ||
| 336 | unsigned short edge = word2 & 0x1;  | 
        ||
| 337 | unsigned short q = (word2 >> 8) &0x1;  | 
        ||
| 338 | unsigned short x = (word2 >> 9) &0x1;  | 
        ||
| 339 | if (debug) printf("%d. [ch=%2d] edge=%d data=%d q=%d x=%d\n",count,ch,edge,tdc, q, x);  | 
        ||
| 340 |           count++; | 
        ||
| 341 |        } | 
        ||
| 342 |        ib++; | 
        ||
| 343 |     } | 
        ||
| 344 | if (data[evsize+1]!=END_MARKER) printf("Error! END_MARKER not found\n");  | 
        ||
| 345 | //*****************    | 
        ||
| 346 | |||
| 347 | |||
| 348 |   } | 
        ||
| 349 | fclose(fp);  | 
        ||
| 350 | printf("Podatki so v datoteki %s\n", fname);  | 
        ||
| 351 | |||
| 352 | |||
| 353 |   delete d; | 
        ||
| 354 | |||
| 355 | return 0;  | 
        ||
| 356 | } | 
        ||
| 357 | #endif |