ros melodic library with custom message

Dependents:   Robot_team1_QEI_Douglas Robot_team1

Committer:
florine_van
Date:
Tue Dec 03 09:39:29 2019 +0000
Revision:
3:b964e3f71102
Parent:
0:020db18a476d
Clean code and remove unused lines

Who changed what in which revision?

UserRevisionLine numberNew contents of line
scarter1 0:020db18a476d 1 #ifndef _ROS_rosserial_msgs_Log_h
scarter1 0:020db18a476d 2 #define _ROS_rosserial_msgs_Log_h
scarter1 0:020db18a476d 3
scarter1 0:020db18a476d 4 #include <stdint.h>
scarter1 0:020db18a476d 5 #include <string.h>
scarter1 0:020db18a476d 6 #include <stdlib.h>
scarter1 0:020db18a476d 7 #include "ros/msg.h"
scarter1 0:020db18a476d 8
scarter1 0:020db18a476d 9 namespace rosserial_msgs
scarter1 0:020db18a476d 10 {
scarter1 0:020db18a476d 11
scarter1 0:020db18a476d 12 class Log : public ros::Msg
scarter1 0:020db18a476d 13 {
scarter1 0:020db18a476d 14 public:
scarter1 0:020db18a476d 15 typedef uint8_t _level_type;
scarter1 0:020db18a476d 16 _level_type level;
scarter1 0:020db18a476d 17 typedef const char* _msg_type;
scarter1 0:020db18a476d 18 _msg_type msg;
scarter1 0:020db18a476d 19 enum { ROSDEBUG = 0 };
scarter1 0:020db18a476d 20 enum { INFO = 1 };
scarter1 0:020db18a476d 21 enum { WARN = 2 };
scarter1 0:020db18a476d 22 enum { ERROR = 3 };
scarter1 0:020db18a476d 23 enum { FATAL = 4 };
scarter1 0:020db18a476d 24
scarter1 0:020db18a476d 25 Log():
scarter1 0:020db18a476d 26 level(0),
scarter1 0:020db18a476d 27 msg("")
scarter1 0:020db18a476d 28 {
scarter1 0:020db18a476d 29 }
scarter1 0:020db18a476d 30
scarter1 0:020db18a476d 31 virtual int serialize(unsigned char *outbuffer) const
scarter1 0:020db18a476d 32 {
scarter1 0:020db18a476d 33 int offset = 0;
scarter1 0:020db18a476d 34 *(outbuffer + offset + 0) = (this->level >> (8 * 0)) & 0xFF;
scarter1 0:020db18a476d 35 offset += sizeof(this->level);
scarter1 0:020db18a476d 36 uint32_t length_msg = strlen(this->msg);
scarter1 0:020db18a476d 37 varToArr(outbuffer + offset, length_msg);
scarter1 0:020db18a476d 38 offset += 4;
scarter1 0:020db18a476d 39 memcpy(outbuffer + offset, this->msg, length_msg);
scarter1 0:020db18a476d 40 offset += length_msg;
scarter1 0:020db18a476d 41 return offset;
scarter1 0:020db18a476d 42 }
scarter1 0:020db18a476d 43
scarter1 0:020db18a476d 44 virtual int deserialize(unsigned char *inbuffer)
scarter1 0:020db18a476d 45 {
scarter1 0:020db18a476d 46 int offset = 0;
scarter1 0:020db18a476d 47 this->level = ((uint8_t) (*(inbuffer + offset)));
scarter1 0:020db18a476d 48 offset += sizeof(this->level);
scarter1 0:020db18a476d 49 uint32_t length_msg;
scarter1 0:020db18a476d 50 arrToVar(length_msg, (inbuffer + offset));
scarter1 0:020db18a476d 51 offset += 4;
scarter1 0:020db18a476d 52 for(unsigned int k= offset; k< offset+length_msg; ++k){
scarter1 0:020db18a476d 53 inbuffer[k-1]=inbuffer[k];
scarter1 0:020db18a476d 54 }
scarter1 0:020db18a476d 55 inbuffer[offset+length_msg-1]=0;
scarter1 0:020db18a476d 56 this->msg = (char *)(inbuffer + offset-1);
scarter1 0:020db18a476d 57 offset += length_msg;
scarter1 0:020db18a476d 58 return offset;
scarter1 0:020db18a476d 59 }
scarter1 0:020db18a476d 60
scarter1 0:020db18a476d 61 const char * getType(){ return "rosserial_msgs/Log"; };
scarter1 0:020db18a476d 62 const char * getMD5(){ return "11abd731c25933261cd6183bd12d6295"; };
scarter1 0:020db18a476d 63
scarter1 0:020db18a476d 64 };
scarter1 0:020db18a476d 65
scarter1 0:020db18a476d 66 }
scarter1 0:020db18a476d 67 #endif