UsbI2cBus.cpp

Go to the documentation of this file.

// $Id: $
// Include files


// local
#include "UsbI2cBus.h"

//-----------------------------------------------------------------------------
// Implementation file for class : UsbI2cBus
//
// 2006-10-23 :
//-----------------------------------------------------------------------------

//=============================================================================
// Standard constructor, initializes variables
//=============================================================================
UsbI2cBus::UsbI2cBus(  ) {
  setName("UsbI2cBus");
  setType("UsbI2cBus");

  m_regAddress=new Register();
  m_regData=new Register();

  m_regAddress->setName("AddReg");
  m_regData   ->setName("DataReg");

  m_regAddress->io()->defDataU8(4);
  m_regAddress->io()->setAddress(0);

  m_regData->io()->setAddress(0);

  m_regAddress->io()->setWordSize(IOdata::Byte);
  m_regData   ->io()->setWordSize(IOdata::Byte);

  addChild(m_regAddress);
  addChild(m_regData);
}
//=============================================================================
// Destructor
//=============================================================================
UsbI2cBus::~UsbI2cBus() {
//  delete m_regData;
//  delete m_regAddress;
}

//=============================================================================
//
//=============================================================================
StatusCode UsbI2cBus::init() {
  if (0==m_connection){
    if (0==this->parent()){
      fatal("Cannot define connection for "+type()+". No parent found.",
          "UsbI2cBus::init");
        return StatusCode::FAILURE;
    }
    return setConnection(this->parent());
  }
  else return StatusCode::SUCCESS;
}

//=============================================================================
//
//=============================================================================
StatusCode UsbI2cBus::read(IOdata* io){
  U8* buffer=m_regAddress->io()->dataU8();
  buffer[0]=(U8)(io->address());
  buffer[1]=(U8)(0);
  buffer[2]=(U8)(0);
  buffer[3]=(U8)(0);
  m_regData->io()->setDataU8(io->dataU8(),io->length());
  Interface* connection = dynamic_cast<Interface*> (m_connection);
  if (connection->write(m_regAddress->io()).isFailure()){
    warning("Cannot write Address register on UsbI2cBus",
      "UsbI2cBus::read");
    return StatusCode::FAILURE;
  }
  if (connection->read(m_regData->io()).isFailure()){
    warning("Cannot read Data register on UsbI2cBus",
        "UsbI2cBus::read");  ;
    return StatusCode::FAILURE;
  }
  return StatusCode::SUCCESS;
}

//=============================================================================
//
//=============================================================================
StatusCode UsbI2cBus::write(IOdata* io){
  U8* buffer=m_regAddress->io()->dataU8();
  buffer[0]=(U8)(io->address());
  buffer[1]=(U8)(0);
  buffer[2]=(U8)(0);
  buffer[3]=(U8)(0);
  m_regData->io()->setDataU8(io->dataU8(),io->length());
  Interface* connection = dynamic_cast<Interface*> (m_connection);
  if (connection->write(m_regAddress->io()).isFailure()){
    warning("Cannot write Address register on UsbI2cBus",
        "UsbI2cBus::write");
    return StatusCode::FAILURE;
  }
  if (connection->write(m_regData->io()).isFailure()){
    warning("Cannot write Data register on UsbI2cBus","UsbI2cBus::write");
    return StatusCode::FAILURE;
  }
  return StatusCode::SUCCESS;
}

//=============================================================================