ParseMeasurementCurrentConfigData.cpp

Go to the documentation of this file.

// this is for emacs file handling -*- mode: c++; indent-tabs-mode: nil -*-

// -- BEGIN LICENSE BLOCK ----------------------------------------------

// -- END LICENSE BLOCK ------------------------------------------------

//----------------------------------------------------------------------
//----------------------------------------------------------------------

#include <sick_safetyscanners/data_processing/ParseMeasurementCurrentConfigData.h>

#include <sick_safetyscanners/cola2/Command.h>

namespace sick {
namespace data_processing {

ParseMeasurementCurrentConfigData::ParseMeasurementCurrentConfigData()
{
  m_reader_ptr = std::make_shared<sick::data_processing::ReadWriteHelper>();
}


bool ParseMeasurementCurrentConfigData::parseTCPSequence(
  const datastructure::PacketBuffer& buffer, datastructure::ConfigData& config_data) const
{
  const uint8_t* data_ptr(buffer.getBuffer().data());
  config_data.setStartAngle(readStartAngle(data_ptr));
  config_data.setAngularBeamResolution(readAngularBeamResolution(data_ptr));
  return true;
}

uint32_t ParseMeasurementCurrentConfigData::readStartAngle(const uint8_t* data_ptr) const
{
  return m_reader_ptr->readuint32_tLittleEndian(data_ptr, 36);
}

uint32_t ParseMeasurementCurrentConfigData::readAngularBeamResolution(const uint8_t* data_ptr) const
{
  return m_reader_ptr->readuint32_tLittleEndian(data_ptr, 40);
}

} // namespace data_processing
} // namespace sick