Command.h

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 ------------------------------------------------

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

#ifndef SICK_SAFETYSCANNERS_COLA2_COMMAND_H
#define SICK_SAFETYSCANNERS_COLA2_COMMAND_H

#include <ros/ros.h>

#include <vector>

#include <sick_safetyscanners/datastructure/PacketBuffer.h>

#include <sick_safetyscanners/data_processing/ParseTCPPacket.h>
#include <sick_safetyscanners/data_processing/ReadWriteHelper.h>

#include <boost/thread/mutex.hpp>

namespace sick {
namespace cola2 {

class Cola2Session;


class Command
{
public:
  Command(sick::cola2::Cola2Session& session,
          const uint16_t& command_type,
          const uint16_t& command_mode);

  virtual ~Command() {}


  void lockExecutionMutex();

  void constructTelegram(sick::datastructure::PacketBuffer::VectorBuffer& telegram) const;

  void processReplyBase(const sick::datastructure::PacketBuffer::VectorBuffer& packet);


  void waitForCompletion();


  uint32_t getSessionID() const;


  void setSessionID(const uint32_t& session_id);


  bool wasSuccessful() const;


  uint8_t getCommandType() const;

  void setCommandType(const uint8_t& command_type);

  uint8_t getCommandMode() const;

  void setCommandMode(const uint8_t& command_mode);

  uint16_t getRequestID() const;

  void setRequestID(const uint16_t& request_id);

  std::vector<uint8_t> getDataVector() const;

  void setDataVector(const std::vector<uint8_t>& data);

protected:
  sick::cola2::Cola2Session& m_session;

private:
  std::shared_ptr<sick::data_processing::ParseTCPPacket> m_tcp_parser_ptr;
  std::shared_ptr<sick::data_processing::ReadWriteHelper> m_writer_ptr;

  boost::mutex m_execution_mutex;

  bool m_was_successful;

  uint8_t m_command_mode;
  uint8_t m_command_type;

  uint32_t m_session_id;
  uint16_t m_request_id;

  std::vector<uint8_t> m_data_vector;

  virtual bool processReply()                                                                   = 0;
  virtual void addTelegramData(sick::datastructure::PacketBuffer::VectorBuffer& telegram) const = 0;

  void addTelegramHeader(sick::datastructure::PacketBuffer::VectorBuffer& telegram) const;
  sick::datastructure::PacketBuffer::VectorBuffer prepareHeader() const;
  void writeCola2StxToDataPtr(uint8_t*& data_ptr) const;
  void writeLengthToDataPtr(uint8_t*& data_ptr,
                            datastructure::PacketBuffer::VectorBuffer& telegram) const;
  void writeCola2HubCntrToDataPtr(uint8_t*& data_ptr) const;
  void writeCola2NoCToDataPtr(uint8_t*& data_ptr) const;
  void writeSessionIdToDataPtr(uint8_t*& data_ptr) const;
  void writeRequestIdToDataPtr(uint8_t*& data_ptr) const;
  void writeCommandTypeToDataPtr(uint8_t*& data_ptr) const;
  void writeCommandModeToDataPtr(uint8_t*& data_ptr) const;
  void writeDataToDataPtr(uint8_t*& data_ptr,
                          datastructure::PacketBuffer::VectorBuffer& telegram) const;
};


} // namespace cola2
} // namespace sick


#endif // SICK_SAFETYSCANNERS_COLA2_COMMAND_H