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

#include <sick_safetyscanners/cola2/Command.h>

namespace sick {
namespace data_processing {

ParseFirmwareVersion::ParseFirmwareVersion() {}


bool ParseFirmwareVersion::parseTCPSequence(const datastructure::PacketBuffer& buffer,
                                            datastructure::FirmwareVersion& firmware_version) const
{
  // Keep our own copy of the shared_ptr to keep the iterators valid
  const std::shared_ptr<std::vector<uint8_t> const> vec_ptr = buffer.getBuffer();
  std::vector<uint8_t>::const_iterator data_ptr             = vec_ptr->begin();
  firmware_version.setFirmwareVersion(readFirmwareVersion(data_ptr));
  return true;
}


std::string
ParseFirmwareVersion::readFirmwareVersion(std::vector<uint8_t>::const_iterator data_ptr) const
{
  uint16_t string_length = read_write_helper::readUint16LittleEndian(data_ptr + 0);

  std::string result;
  for (uint16_t i = 0; i < string_length; i++)
  {
    result.push_back(read_write_helper::readUint16LittleEndian(data_ptr + 2 + i));
  }
  return result;
}


} // namespace data_processing
} // namespace sick