Phaser.cpp

Go to the documentation of this file.

//$Id: Phaser.cpp,v 1.9 2006/09/28 13:02:24 fmachefe Exp $
//------------------------------------------------------------------------------
//
//  Package    : Phaser
//
//  Description:
//
//  Author(s)  : F. Machefert -
//  Date       : 10 February 2004
//
//------------------------------------------------------------------------------

// include files
#ifndef WIN32
#include <unistd.h>
#endif
#include <algorithm>

// local include file
#include "Phaser.h"


void Phaser::read( ){
  if (m_reg->read().isFailure()){
    warning("Phaser register read failure.","Phaser::read");
  }
  else {
    U8* buffer=m_reg->io()->dataU8();
    unsigned int d0 = (  buffer[0] & 0x1F );
    unsigned int d1 = (( buffer[0] & 0xE0 ) >> 5 ) | (( buffer[1] & 0x3 ) << 3 );
    unsigned int d2 = (( buffer[1] >> 2 ) & 0x1F );
    unsigned int d3 = (( buffer[1] >> 7 ) & 0x1 )  | ((buffer[2] & 0xF) << 1);
    debug("reading "+name()+" phases : "+
        itos(d0)+" "+
        itos(d1)+" "+
        itos(d2)+" "+
        itos(d3),
        "Phaser::read");
    m_phase[0]=d0;
    m_phase[1]=d1;
    m_phase[2]=d2;
    m_phase[3]=d3;
  }
}

void Phaser::write(){
  U8* buffer=m_reg->io()->dataU8();
  buffer[0]=(m_phase[0] & 0x1F) | ((m_phase[1] & 0x7)<<5);
  buffer[1]=((m_phase[1]>>3)& 0x3) |
      ((m_phase[2]& 0x1F)<<2) |
      ((m_phase[3]&0x1)<<7);
  buffer[2]=(m_phase[3]>>1)&0xF;
  debug("setting "+name()+" phases : "+itos(m_phase[0])+" "+
      itos(m_phase[1])+" "+itos(m_phase[2])+" "+itos(m_phase[3]),
      "Phaser::write");
  if (m_reg->write().isFailure()){
    warning("Phaser register write failure.","Phaser::write");
  }
}