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

#include <sick_safetyscanners/cola2/Command.h>

namespace sick {
namespace data_processing {

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


bool ParseDeviceName::parseTCPSequence(const datastructure::PacketBuffer& buffer,
                                       std::string& device_name) const
{
  const uint8_t* data_ptr(buffer.getBuffer().data());
  device_name = readDeviceName(data_ptr);
  return true;
}


std::string ParseDeviceName::readDeviceName(const uint8_t*& data_ptr) const
{
  uint16_t string_length = m_reader_ptr->readuint16_tLittleEndian(data_ptr, 0);

  std::string name;
  for (uint16_t i = 0; i < string_length; i++)
  {
    name.push_back(m_reader_ptr->readuint16_tLittleEndian(data_ptr, 2 + i));
  }
  return name;
}


} // namespace data_processing
} // namespace sick