SpecsSlave.cpp

Go to the documentation of this file.

//$Id: SpecsSlave.cpp,v 1.10 2006/07/03 09:02:07 fmachefe Exp $
//------------------------------------------------------------------------------
//
//  Package    : SpecsSlave
//
//  Description:
//
//  Author(s)  : F. Machefert
//  Date       : 12 February 2004
//
//------------------------------------------------------------------------------

// CATCore include files
#include "Tools.h"
#include "SpecsI2c.h"
#include "SpecsParallelBus.h"

// Specslib include files
#ifndef _NODEVICE_
#include "Specs.h"
#endif

// CATCore include files
#include "SpecsMaster.h"

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

//=============================================================================
// 
//=============================================================================
SpecsSlave::SpecsSlave(){ 
  debug("SpecsSlave built.","SpecsSlave::SpecsSlave");

  setAddress(0x0);
  setType("SpecsSlave");
  setId(0);
  add(Attrib::ELEMENT); add (Attrib::HARDWARE);
}

//=============================================================================
// 
//=============================================================================
SpecsSlave::~SpecsSlave(){  
}

//=============================================================================
// 
//=============================================================================
void SpecsSlave::setAddress(unsigned char add){
  m_address=add;
#ifndef _NODEVICE_
  specsSlave.SpecsslaveAdd=add;
#endif
}

//=============================================================================
// 
//=============================================================================
#ifndef _NODEVICE_
SPECSSLAVE* SpecsSlave::specsSlaveDevice(){
  return &specsSlave;
}
#endif

//=============================================================================
// 
//=============================================================================
StatusCode SpecsSlave::init(){
#ifndef _NODEVICE_
  SPECSMASTER* master=specsMasterDevice();
  if (0!=master){
    SpecsError status = specs_slave_open ( master, address() , &specsSlave );
    if (0!=status){
      warning("SpecsSlave " + name() + "could not be initialized correctly [code:" +
              itos(status) + "].","SpecsSlave::initSpecs");
      return StatusCode::FAILURE;
    }
    else{
      int nAttempts = 10;
      for (int i=0 ; i<nAttempts ; ++i){
        U16 rd;
        U16 wr = (U16)(rand()&&0xFFFC);
        //  specsWriteRegister(3,wr);
        //  specsReadRegister (3,rd);
        rd=wr;
        if (wr!=rd){
          warning("Specs Slave "+name()+" [Add="+itos (address())+"] : wrong connection [attempt "+
                  itos(i)+"/"+itos (nAttempts)+"]. Further use of this slave is hazardeous.",
                  "SpecsSlave::init");
          return StatusCode::FAILURE; 
        }
      }
      info("SpecsSlave "+name()+" initialized and connected to master.","SpecsSlave::init");
    }
  }
  else{
    fatal("Could not initialize SpecsSlave "+name()+".","SpecsSlave::init");
    return StatusCode::FAILURE; 
  }
#else
  debug("Compilation in the _NODEVICE_ mode.","SpecsSlave::init");
#endif
  resetInternal();
  reset();
  return StatusCode::SUCCESS;
}

//=============================================================================
// 
//=============================================================================
bool SpecsSlave::detect( ){
#ifndef _NODEVICE_
  SPECSMASTER* master=specsMasterDevice();
  if (0!=master){
    SpecsError status = specs_slave_open ( master, address() , &specsSlave );
    if (0!=status){
      info("SpecsSlave "+name()+"could not be initialized correctly [code:"+
           itos(status) + "].","initSpecs");
      return false;
    }
    else{
      SPECSSLAVE *specsSlv=specsSlaveDevice();
      if ( 0==specsSlv ){
        warning("Could not reach proper Specs Master and/or Slave.",
                "SpecsElement::specsWriteI2c");
        return false;
      }
      
      U16 value ;
      U8 reg = 8 ;
      status = specs_register_read ( specsSlv , reg , &value );
      
      if (0!=status){
        debug("No SpecsSlave detected at address " + 
              itos (address()) + "[code=" + itos(status) + "]",
              "specsSlave::detect");
        specsMaster()->reset();
        return false;
      }
      else {
        info("SpecsSlave detected at address " + 
             itos (address()) + "[date=" + itos(value)+"]",
             "specsSlave::detect");
        return true;
      }
    }    
  }
#endif
  return false;
}

//=============================================================================
// 
//=============================================================================
void SpecsSlave::recursiveInitCommunications(){
  init();
  std::vector<Hierarchy*> list = this->children();
  std::vector<Hierarchy*>::iterator iter;
  for (iter=list.begin() ; iter!=list.end() ; ++iter){
    dynamic_cast<Element*>((*iter))->recursiveInitCommunications();
  }
}

//=============================================================================
// 
//=============================================================================
void SpecsSlave::addI2c(Hierarchy *element){
  element->setParent(i2c);
  i2c->addChild(element);
  debug(element->name()+" added to the i2c child tree.","SpecsSlave::addI2c");
}

//=============================================================================
// 
//=============================================================================
void SpecsSlave::resetInternal(){
#ifndef _NODEVICE_
  SPECSSLAVE *specsSlv=specsSlaveDevice();
  SpecsError status = specs_slave_internal_reset ( specsSlv );
  if (0!=status){
    warning("SpecsSlave " + name() +
            ": failure in performing the internal reset [code:" +
            itos(status) + "].",
            "SpecsSlave::reset" );   }
  else{
    info("internal reset of the specs slave "+
         name()+" "+" [address="+itos(address())+"].",
         "SpecsSlave::resetInternal");
  }
#endif
}

//=============================================================================
// 
//=============================================================================
void SpecsSlave::reset(){
#ifndef _NODEVICE_
  SPECSSLAVE *specsSlv=specsSlaveDevice();
  SpecsError status = specs_slave_external_reset ( specsSlv );
  if (0!=status){
    warning("SpecsSlave " + name() +
            ": failure in performing the SpecsSlave reset [code:" +
            itos(status) + "].",
            "SpecsSlave::reset" );   }
  else{
    debug("reset of the specs slave "+
          name()+" "+" [address="+itos(address())+"]." ,
          "SpecsSlave::reset");
  }
#endif
}