ParseMeasurementPersistentConfigData.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/ParseMeasurementPersistentConfigData.h>

#include <sick_safetyscanners/cola2/Command.h>

namespace sick {
namespace data_processing {

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


bool ParseMeasurementPersistentConfigData::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.setEndAngle(readEndAngle(data_ptr));
  return true;
}

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

uint32_t ParseMeasurementPersistentConfigData::readEndAngle(const uint8_t* data_ptr) const
{
  return m_reader_ptr->readuint32_tLittleEndian(data_ptr, 20);
}

} // namespace data_processing
} // namespace sick