SickPLSMessage.hh

Go to the documentation of this file.

#ifndef SICK_PLS_MESSAGE_HH
#define SICK_PLS_MESSAGE_HH

/* Definition dependencies */
#include <string.h>
#include <netinet/in.h>   
#include "SickMessage.hh"
#include "SickException.hh"

#define CRC16_GEN_POL 0x8005                        ///< Used to compute CRCs

#define MKSHORT(a,b) ((unsigned short) (a) | ((unsigned short)(b) << 8))

#define SICK_PLS_MSG_HEADER_LEN            (4)  ///< Sick LMS message length in bytes
#define SICK_PLS_MSG_PAYLOAD_MAX_LEN     (812)  ///< Sick LMS max payload length in bytes
#define SICK_PLS_MSG_TRAILER_LEN           (2)  ///< Sick LMS message trailer length in bytes 

/* Associate the namespace */
namespace SickToolbox {

  class SickPLSMessage : public SickMessage< SICK_PLS_MSG_HEADER_LEN, SICK_PLS_MSG_PAYLOAD_MAX_LEN, SICK_PLS_MSG_TRAILER_LEN >
  {

  public:
  
    SickPLSMessage( );

    SickPLSMessage( const uint8_t dest_address, const uint8_t * const payload_buffer, const unsigned int payload_length );

    SickPLSMessage( uint8_t * const message_buffer );

    void BuildMessage( uint8_t dest_address, const uint8_t * const payload_buffer,
                       const unsigned int payload_length );
    
    void ParseMessage( const uint8_t * const message_buffer );

    uint8_t GetDestAddress( ) const { return _message_buffer[1]; }

    uint8_t GetCommandCode( ) const { return _message_buffer[MESSAGE_HEADER_LENGTH]; }

    uint8_t GetStatusByte( ) const { return _message_buffer[MESSAGE_HEADER_LENGTH+_payload_length-1]; }
    
    uint16_t GetChecksum( ) const { return _checksum; }
    
    void Clear( );
    
    void Print( ) const;

    ~SickPLSMessage();

  protected:

    uint16_t _checksum;
    
  private:

    uint16_t _computeCRC( uint8_t * data, unsigned int data_length ) const;

  };

} /* namespace SickToolbox */
  
#endif //SICK_PLS_MESSAGE_HH