| 1 | 
kusanagi | 
1.1 | 
#include <stdio.h> | 
| 2 | 
  | 
  | 
#include "ACcalib.h" | 
| 3 | 
  | 
  | 
 | 
| 4 | 
  | 
  | 
 | 
| 5 | 
kusanagi | 
1.2 | 
int ACcalib(int length, unsigned short* datapointer, struct datastruct* calibpointer){ | 
| 6 | 
  | 
  | 
 | 
| 7 | 
  | 
  | 
struct datastruct calibdata; | 
| 8 | 
  | 
  | 
 | 
| 9 | 
  | 
  | 
//pointer to struct | 
| 10 | 
  | 
  | 
struct datastruct *calibpointer; | 
| 11 | 
  | 
  | 
 | 
| 12 | 
  | 
  | 
int fd,i,j,err,found; | 
| 13 | 
  | 
  | 
unsigned short buffer[10000]; | 
| 14 | 
  | 
  | 
unsigned short tmp1,tmp2; | 
| 15 | 
  | 
  | 
 | 
| 16 | 
  | 
  | 
  | 
| 17 | 
  | 
  | 
  int iter=2; | 
| 18 | 
kusanagi | 
1.1 | 
 | 
| 19 | 
  | 
  | 
  //point struc-pointer to calibdata | 
| 20 | 
  | 
  | 
  *calibpointer=calibdata;   | 
| 21 | 
  | 
  | 
 | 
| 22 | 
  | 
  | 
  //look for header 0xACCA | 
| 23 | 
kusanagi | 
1.2 | 
  while(found==0 && iter<length) | 
| 24 | 
kusanagi | 
1.1 | 
    { | 
| 25 | 
  | 
  | 
      tmp1=*datapointer; | 
| 26 | 
  | 
  | 
      tmp2=*(datapointer+1); | 
| 27 | 
  | 
  | 
      if(tmp1==0xCAAC) | 
| 28 | 
  | 
  | 
        { | 
| 29 | 
  | 
  | 
          found=1; | 
| 30 | 
  | 
  | 
          for(i=0;i<8256;i++) | 
| 31 | 
  | 
  | 
            { | 
| 32 | 
  | 
  | 
              buffer[i]=*datapointer; | 
| 33 | 
  | 
  | 
              datapointer++; | 
| 34 | 
  | 
  | 
            } | 
| 35 | 
  | 
  | 
          tmp1=0x0000; | 
| 36 | 
  | 
  | 
        } | 
| 37 | 
kusanagi | 
1.2 | 
      else if((tmp1&0x00FF) + (tmp2&0xFF00)==0xACCA) | 
| 38 | 
kusanagi | 
1.1 | 
        { | 
| 39 | 
  | 
  | 
          found=1; | 
| 40 | 
  | 
  | 
          for(i=0;i<8256;i++) | 
| 41 | 
  | 
  | 
            { | 
| 42 | 
  | 
  | 
              buffer[i]=(tmp1&0x00FF) + (tmp2&0xFF00); | 
| 43 | 
  | 
  | 
              datapointer++; | 
| 44 | 
  | 
  | 
              tmp1=tmp2; | 
| 45 | 
  | 
  | 
              tmp2=*(datapointer+1); | 
| 46 | 
  | 
  | 
            } | 
| 47 | 
  | 
  | 
        } | 
| 48 | 
kusanagi | 
1.2 | 
      else{ | 
| 49 | 
kusanagi | 
1.1 | 
      datapointer++; | 
| 50 | 
kusanagi | 
1.2 | 
      iter=iter+2;} | 
| 51 | 
kusanagi | 
1.1 | 
 | 
| 52 | 
  | 
  | 
    } | 
| 53 | 
  | 
  | 
 | 
| 54 | 
kusanagi | 
1.2 | 
  //check errors | 
| 55 | 
  | 
  | 
  if(iter>=length) | 
| 56 | 
  | 
  | 
    err=2; | 
| 57 | 
  | 
  | 
  else if(buffer[8254]==0x22AC) | 
| 58 | 
kusanagi | 
1.1 | 
    err=0; | 
| 59 | 
  | 
  | 
  else | 
| 60 | 
  | 
  | 
    err=1; | 
| 61 | 
  | 
  | 
 | 
| 62 | 
  | 
  | 
  //Fill calibdata from buffer | 
| 63 | 
  | 
  | 
  calibdata.header=buffer[0]; | 
| 64 | 
  | 
  | 
  for(i=0;i<5;i++) calibdata.status[i]=buffer[1+i]; | 
| 65 | 
  | 
  | 
  for(i=0;i<8;i++) calibdata.temp[i]=buffer[6+i]; | 
| 66 | 
  | 
  | 
  for(i=0;i<16;i++) calibdata.DAC[i]=buffer[14+i]; | 
| 67 | 
  | 
  | 
  for(i=0;i<6;i++) calibdata.regist[i]=buffer[30+i]; | 
| 68 | 
  | 
  | 
  for(i=0;i<8;i++) calibdata.time[i]=buffer[36+i]; | 
| 69 | 
  | 
  | 
  calibdata.n_tr=buffer[44]; | 
| 70 | 
  | 
  | 
  for(i=0;i<16;i++) calibdata.hitmap_tr[i]=buffer[45+i]; | 
| 71 | 
  | 
  | 
  for(i=0;i<4096;i++) calibdata.curve1[i]=buffer[61+i]; | 
| 72 | 
  | 
  | 
  for(i=0;i<4096;i++) calibdata.curve2[i]=buffer[4157+i]; | 
| 73 | 
  | 
  | 
  calibdata.iCRC=buffer[8253]; | 
| 74 | 
  | 
  | 
  calibdata.tail=buffer[8254]; | 
| 75 | 
  | 
  | 
  calibdata.CRC=buffer[8255]; | 
| 76 | 
kusanagi | 
1.2 | 
   | 
| 77 | 
kusanagi | 
1.1 | 
  /* | 
| 78 | 
  | 
  | 
  //debug | 
| 79 | 
  | 
  | 
  printf("header: %hx\n",calibdata.header); | 
| 80 | 
  | 
  | 
  printf("status: %hx\n",calibdata.status[0]); | 
| 81 | 
  | 
  | 
  printf("temp: %hx\n",calibdata.temp[0]); | 
| 82 | 
  | 
  | 
  printf("DAC: %hx\n",calibdata.DAC[0]); | 
| 83 | 
  | 
  | 
  printf("regist: %hx\n",calibdata.regist[0]); | 
| 84 | 
  | 
  | 
  printf("time: %hx\n",calibdata.time[0]); | 
| 85 | 
  | 
  | 
  printf("n_tr: %hx\n",calibdata.n_tr); | 
| 86 | 
  | 
  | 
  printf("hitmap_tr: %hx\n",calibdata.hitmap_tr[0]); | 
| 87 | 
  | 
  | 
  printf("curve1: %hx\n",calibdata.curve1[0]); | 
| 88 | 
  | 
  | 
  printf("curve2: %hx\n",calibdata.curve2[0]); | 
| 89 | 
  | 
  | 
  printf("iCRC: %hx\n",calibdata.iCRC); | 
| 90 | 
  | 
  | 
  printf("tail: %hx\n",calibdata.tail); | 
| 91 | 
  | 
  | 
  printf("CRC: %hx\n",calibdata.CRC); | 
| 92 | 
  | 
  | 
  printf("err: %d\n",err); | 
| 93 | 
  | 
  | 
  */ | 
| 94 | 
  | 
  | 
 | 
| 95 | 
  | 
  | 
  return err; | 
| 96 | 
  | 
  | 
} |