datastream.cpp

#include "datastream.h"
#include "protocol.h"

void CRocPixel::DecodeRaw(  )
{
  ph = ( raw & 0x0f ) + ( ( raw >> 1 ) & 0xf0 );
  int c = ( raw >> 21 ) & 7;
  c = c * 6 + ( ( raw >> 18 ) & 7 );
  int r = ( raw >> 15 ) & 7;
  r = r * 6 + ( ( raw >> 12 ) & 7 );
  r = r * 6 + ( ( raw >> 9 ) & 7 );
  y = 80 - r / 2;
  x = 2 * c + ( r & 1 );
}

// === CDtbSource (CSource<uint16_t>) ================================

uint16_t CDtbSource::FillBuffer(  )
{
  pos = 0;
  do {
    dtbState = tb.Daq_Read( buffer, DTB_SOURCE_BLOCK_SIZE, dtbRemainingSize );

    /* if( dtbRemainingSize < 100000)
       {
       if      (dtbRemainingSize > 1000) tb.mDelay(  1);
       else if( dtbRemainingSize >    0) tb.mDelay( 10);
       else                              tb.mDelay(100);
       }
    */
    if( buffer.size(  ) == 0 ) {
      if( stopAtEmptyData )
        throw DS_empty(  );
      if( dtbState )
        throw DS_buffer_overflow(  );
    }

  }
  while( buffer.size(  ) == 0 );

  /* printf("----------------\n");
     for (unsigned int i=0; i<buffer.size(); i++)
     printf(" %4X", (unsigned int)(buffer[i]));
     printf("\n----------------\n");
  */
  return lastSample = buffer[pos++];
}

// === CBinaryFileSource (CSource<uint16_t>) ================================

uint16_t CBinaryFileSource::FillBuffer(  )
{
  pos = 0;
  do {
    buffer.resize( FILE_SOURCE_BLOCK_SIZE );
    size =
      fread( buffer.data(  ), sizeof( uint16_t ), FILE_SOURCE_BLOCK_SIZE, f );
  }
  while( size == 0 );

  return lastSample = buffer[pos++];
}


// === CDataRecordScanner (CDataPipe<uint16_t, CRecord*>) =============

CDataRecord *CDataRecordScanner::Read(  )
{
  record.Clear(  );

  if( GetLast(  ) & 0x4000 )
    Get(  );
  if( !( GetLast(  ) & 0x8000 ) ) {
    record.SetStartError(  );
    while( !( GetLast(  ) & 0x8000 ) )
      Get(  );
  }

  do {
    if( record.GetSize(  ) >= 40000 ) {
      record.SetOverflow(  );
      break;
    }
    record.Add( GetLast(  ) & 0x0fff );

  }
  while( ( Get(  ) & 0xc000 ) == 0 );

  if( GetLast(  ) & 0x4000 )
    record.Add( GetLast(  ) & 0x0fff );
  else
    record.SetEndError(  );

  /* for (unsigned int i=0; i<record.data.size(); i++)
     printf(" %4X", (unsigned int)(record.data[i]));
     printf("\n");
  */
  return &record;
}


// === CDecoder (CDataRecord*, CRocEvent*) =====================================

CRocEvent *CRocDecoder::Read(  )
{
  CDataRecord *sample = Get(  );
  roc_event.header = 0;
  roc_event.pixel.clear(  );
  unsigned int n = sample->GetSize(  );
  if( n > 0 ) {
    if( n > 1 )
      roc_event.pixel.reserve( ( n - 1 ) / 2 );
    roc_event.header = ( *sample )[0];
    unsigned int pos = 1;
    while( pos < n - 1 ) {
      CRocPixel pix;
      pix.raw = ( *sample )[pos++] << 12;
      pix.raw += ( *sample )[pos++];
      pix.DecodeRaw(  );
      roc_event.pixel.push_back( pix );
    }
  }

  /* printf("====== %03X ======\n", (unsigned int)(roc_event.header));
     for (unsigned int i=0; i<roc_event.pixel.size(); i++)
     printf(" %06X (%05o) [%3i, %3i, %3i]\n", 
     (unsigned int)(roc_event.pixel[i].raw), (unsigned int)(roc_event.pixel[i].raw >> 9),
     int(roc_event.pixel[i].x), int(roc_event.pixel[i].y), int(roc_event.pixel[i].ph));
     printf("\n");
  */
  return &roc_event;
}