00001 #ifndef _ROS_moveit_msgs_DisplayRobotState_h 00002 #define _ROS_moveit_msgs_DisplayRobotState_h 00003 00004 #include <stdint.h> 00005 #include <string.h> 00006 #include <stdlib.h> 00007 #include "ros/msg.h" 00008 #include "moveit_msgs/RobotState.h" 00009 #include "moveit_msgs/ObjectColor.h" 00010 00011 namespace moveit_msgs 00012 { 00013 00014 class DisplayRobotState : public ros::Msg 00015 { 00016 public: 00017 moveit_msgs::RobotState state; 00018 uint8_t highlight_links_length; 00019 moveit_msgs::ObjectColor st_highlight_links; 00020 moveit_msgs::ObjectColor * highlight_links; 00021 00022 virtual int serialize(unsigned char *outbuffer) const 00023 { 00024 int offset = 0; 00025 offset += this->state.serialize(outbuffer + offset); 00026 *(outbuffer + offset++) = highlight_links_length; 00027 *(outbuffer + offset++) = 0; 00028 *(outbuffer + offset++) = 0; 00029 *(outbuffer + offset++) = 0; 00030 for( uint8_t i = 0; i < highlight_links_length; i++){ 00031 offset += this->highlight_links[i].serialize(outbuffer + offset); 00032 } 00033 return offset; 00034 } 00035 00036 virtual int deserialize(unsigned char *inbuffer) 00037 { 00038 int offset = 0; 00039 offset += this->state.deserialize(inbuffer + offset); 00040 uint8_t highlight_links_lengthT = *(inbuffer + offset++); 00041 if(highlight_links_lengthT > highlight_links_length) 00042 this->highlight_links = (moveit_msgs::ObjectColor*)realloc(this->highlight_links, highlight_links_lengthT * sizeof(moveit_msgs::ObjectColor)); 00043 offset += 3; 00044 highlight_links_length = highlight_links_lengthT; 00045 for( uint8_t i = 0; i < highlight_links_length; i++){ 00046 offset += this->st_highlight_links.deserialize(inbuffer + offset); 00047 memcpy( &(this->highlight_links[i]), &(this->st_highlight_links), sizeof(moveit_msgs::ObjectColor)); 00048 } 00049 return offset; 00050 } 00051 00052 const char * getType(){ return "moveit_msgs/DisplayRobotState"; }; 00053 const char * getMD5(){ return "6a3bab3a33a8c47aee24481a455a21aa"; }; 00054 00055 }; 00056 00057 } 00058 #endif