ICPhaser.cpp

Go to the documentation of this file.

//$Id: ICPhaser.cpp,v 1.9 2006/09/28 13:02:24 fmachefe Exp $
//------------------------------------------------------------------------------
//
//  Package    : ICPhaser
//
//  Description:
//
//  Author(s)  : 
//  Date       : 
//
//------------------------------------------------------------------------------

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

void ICPhaser::read( ){
  m_regConfig->io()->setAddress(address());
  U8* buffer=m_regConfig->io()->dataU8();
  buffer[2]=((m_regConfig->io()->subAddress())&0x1F)+(128);
  buffer[1]=0;
  buffer[0]=0;
  if (m_regConfig->read().isFailure()){
    warning("ICPhaser configuration register read failure.","ICPhaser::read");
  }
  else {
    U8* buffer=m_regConfig->io()->dataU8();
    m_phase[0] = buffer[0];
    m_phase[1] = buffer[1];
    debug("reading "+name()+" phases : "+
        itos(m_phase[0])+" "+
        itos(m_phase[1])+" "+
        itos(m_phase[2])+" "+
        itos(m_phase[3]),
        "ICPhaser::read");
  }
}

void ICPhaser::status( ){
  m_regStatus->io()->setAddress(address());
  U8* buffer=m_regStatus->io()->dataU8();
  buffer[1]=((m_regStatus->io()->subAddress())&0x1F)+(160);
  buffer[0]=0;
  if (m_regStatus->read().isFailure()){
    warning("ICPhaser status register read failure.","ICPhaser::read");
  }
  m_regStatus->io()->dump(1);
}

void ICPhaser::reset(){
  U8* buffer=m_regConfig->io()->dataU8();
  buffer[2]=64;
  buffer[1]=0;
  buffer[0]=0;
  if (m_regConfig->write().isFailure()){
    warning("ICPhaser configuration register write failure. Cannot reset ICPhaser",
        "ICPhaser::write");
  }
}

void ICPhaser::write(){
  U8* buffer=m_regConfig->io()->dataU8();
  buffer[2]=(m_regConfig->io()->subAddress())&0x1F;
  buffer[1]=m_phase[0]&0xff;
  buffer[0]=m_phase[1]&0xff;
  // phase[2] and phase[3] not implemented - only for test purpose
  debug("Setting "+name()+" phases : "+itos(m_phase[0])+" "+
      itos(m_phase[1])+" "+itos(m_phase[2])+" "+itos(m_phase[3]),
      "ICPhaser::write");
  m_regConfig->io()->dump(0);
  if (m_regConfig->write().isFailure()){
    warning("ICPhaser configuration register write failure.",
        "ICPhaser::write");
  }
}