/*******************************v1.0********************************

Functions to read AC physics data (ACphysics) and AC calibration
data (ACcalib).
Author: Petter Hofverberg, petter@particle.kth.se

0410 v1.0 alive

Errors: (returned to the main program as the variable "err")
err=
0xFF - data (physics or calibration) from both cards found
0xF0 - only data from main card found
0x0F - only data from extra card found
0x00 - no data found

******************************************************************/

#include <stdio.h>
#include "AC.h"

int i,found,j;
unsigned short buffer[1000];
unsigned short tmp1,tmp2;
unsigned char err;

struct physicsstruct physicsdata[2];
struct physicsstruct *physicspointer;

struct calibstruct calibdata[2];
struct calibstruct *calibpointer;



unsigned char ACphysics(int length,unsigned char* datapointer,struct physicsstruct* physicspointer)
{

 int iter=2;
  physicspointer[0]=physicsdata[0];
  physicspointer[1]=physicsdata[1];

  //look for top header ACAC, then unpack data to main card buffer or extra card buffer depending on the subheader
  //AC11 for main, AC22 for extra
  while(found<2 && iter<length)
    {
      tmp1 = ((*datapointer) << 8) | *(datapointer+1);
      tmp2 = ((*(datapointer+2)) << 8) | *(datapointer+3);

      if(tmp1 == 0xAC11 && ((tmp2 == 0xAC11 && (err&0xF0)==0x0) || (tmp2 == 0xAC22 && (err&0x0F)==0x0)))
	{ 
	 
	  for(i=0;i<64;i++)
	    {
	      buffer[i]=((*datapointer) << 8) | *(datapointer+1);
	      datapointer=datapointer+2;
	    }
	  
	  if(tmp2==0xAC11){          //main card
	    fillphys(0,&buffer[0]);
	    err |= 0xF0;
	  }
	  else{                      //extra card
	    fillphys(1,&buffer[0]);
	    err |= 0x0F;
	  } 
	  tmp1=tmp2=0x0000;
	  found++;
	}
      else{
	datapointer++;
	iter=iter+1;}
    }

  return err;

}


unsigned char ACcalib(int length, unsigned char* datapointer, struct calibstruct* calibpointer)
{

  int iter=2;
	    
  //point struct-pointer to calibdata
  calibpointer[0]=calibdata[0];  //card1
  calibpointer[1]=calibdata[1];  //card2

  //look for the top header 0xACCA, then the subheaders 0xAC11 and 0xAC22, and unpack the data
  //to each card depending on these.
  while(found<2 && iter<length)
    {
      tmp1 = ((*datapointer) << 8) | *(datapointer+1);
      tmp2 = ((*(datapointer+2)) << 8) | *(datapointer+3);

      if(tmp1 == 0xACCA && ((tmp2 == 0xAC11 && (err&0xF0)==0x0) || (tmp2 == 0xAC22 && (err&0x0F)==0x0)))
	{
	  for(i=0;i<8256;i++)
	    {
	      buffer[i]=((*datapointer) << 8) | *(datapointer+1);
	      datapointer=datapointer+2;
	    }
	 
	  if(tmp2==0xAC11){          //main
	    fillcalib(0,&buffer[0]);
	    err |= 0xF0;
	  }
	  else{                      //extra
	    fillcalib(1,&buffer[0]);
	    err |= 0x0F; 
	  }
	   tmp1=tmp2=0x0000;
	  found++;
	}
      else{
	datapointer++;
	iter=iter+1;}
    }

  return err;
}

//Fill physicsdata from buffer
void fillphys(int k,unsigned short *buff)
{
  for(i=0;i<2;i++) physicsdata[k].header[i]=buff[i];
  physicsdata[k].status=buff[2];
  physicsdata[k].hitmap=buff[3];
  for(i=0;i<6;i++) physicsdata[k].regist[i]=buff[4+i];
  for(i=0;i<16;i++) physicsdata[k].shift[i]=buff[10+i];
  for(i=0;i<16;i++) physicsdata[k].counters[i]=buff[26+i];
  for(i=0;i<8;i++) physicsdata[k].coinc[i]=buff[42+i];
  physicsdata[k].trigg=buff[50];
  for(i=0;i<2;i++) physicsdata[k].clock[i]=buff[51+i];
  for(i=0;i<2;i++) physicsdata[k].temp[i]=buff[53+i];
  for(i=0;i<8;i++) physicsdata[k].DAC[i]=buff[55+i];
  physicsdata[k].CRC=buff[63];

}

//Fill calibdata from buffer
void fillcalib(int k,unsigned short *buff)
{
  calibdata[k].header=buff[0];
  for(i=0;i<5;i++) calibdata[k].status[i]=buff[1+i];
  for(i=0;i<8;i++) calibdata[k].temp[i]=buff[6+i];
  for(i=0;i<8;i++) calibdata[k].DAC1[i]=buff[14+i];
  for(i=0;i<8;i++) calibdata[k].DAC2[i]=buff[22+i];
  for(i=0;i<6;i++) calibdata[k].regist[i]=buff[30+i];
  for(i=0;i<8;i++) calibdata[k].time[i]=buff[36+i];
  calibdata[k].n_tr=buff[44];
  for(i=0;i<16;i++) calibdata[k].hitmap_tr[i]=buff[45+i];
  for(i=0;i<4096;i++) calibdata[k].curve1[i]=buff[61+i];
  for(i=0;i<4096;i++) calibdata[k].curve2[i]=buff[4157+i];
  calibdata[k].iCRC=buff[8253];
  calibdata[k].tail=buff[8254];
  calibdata[k].CRC=buff[8255];
}