rosserial library for mbed Inspired by nucho's rosserial library This library is still under development

Dependencies:   MODSERIAL mbed

Dependents:   mbed_roshydro_test

Library still under development!

Revision:
0:30537dec6e0b
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/moveit_msgs/RobotState.h	Sun Feb 15 10:53:43 2015 +0000
@@ -0,0 +1,86 @@
+#ifndef _ROS_moveit_msgs_RobotState_h
+#define _ROS_moveit_msgs_RobotState_h
+
+#include <stdint.h>
+#include <string.h>
+#include <stdlib.h>
+#include "ros/msg.h"
+#include "sensor_msgs/JointState.h"
+#include "sensor_msgs/MultiDOFJointState.h"
+#include "moveit_msgs/AttachedCollisionObject.h"
+
+namespace moveit_msgs
+{
+
+  class RobotState : public ros::Msg
+  {
+    public:
+      sensor_msgs::JointState joint_state;
+      sensor_msgs::MultiDOFJointState multi_dof_joint_state;
+      uint8_t attached_collision_objects_length;
+      moveit_msgs::AttachedCollisionObject st_attached_collision_objects;
+      moveit_msgs::AttachedCollisionObject * attached_collision_objects;
+      bool is_diff;
+
+    RobotState():
+      joint_state(),
+      multi_dof_joint_state(),
+      attached_collision_objects_length(0), attached_collision_objects(NULL),
+      is_diff(0)
+    {
+    }
+
+    virtual int serialize(unsigned char *outbuffer) const
+    {
+      int offset = 0;
+      offset += this->joint_state.serialize(outbuffer + offset);
+      offset += this->multi_dof_joint_state.serialize(outbuffer + offset);
+      *(outbuffer + offset++) = attached_collision_objects_length;
+      *(outbuffer + offset++) = 0;
+      *(outbuffer + offset++) = 0;
+      *(outbuffer + offset++) = 0;
+      for( uint8_t i = 0; i < attached_collision_objects_length; i++){
+      offset += this->attached_collision_objects[i].serialize(outbuffer + offset);
+      }
+      union {
+        bool real;
+        uint8_t base;
+      } u_is_diff;
+      u_is_diff.real = this->is_diff;
+      *(outbuffer + offset + 0) = (u_is_diff.base >> (8 * 0)) & 0xFF;
+      offset += sizeof(this->is_diff);
+      return offset;
+    }
+
+    virtual int deserialize(unsigned char *inbuffer)
+    {
+      int offset = 0;
+      offset += this->joint_state.deserialize(inbuffer + offset);
+      offset += this->multi_dof_joint_state.deserialize(inbuffer + offset);
+      uint8_t attached_collision_objects_lengthT = *(inbuffer + offset++);
+      if(attached_collision_objects_lengthT > attached_collision_objects_length)
+        this->attached_collision_objects = (moveit_msgs::AttachedCollisionObject*)realloc(this->attached_collision_objects, attached_collision_objects_lengthT * sizeof(moveit_msgs::AttachedCollisionObject));
+      offset += 3;
+      attached_collision_objects_length = attached_collision_objects_lengthT;
+      for( uint8_t i = 0; i < attached_collision_objects_length; i++){
+      offset += this->st_attached_collision_objects.deserialize(inbuffer + offset);
+        memcpy( &(this->attached_collision_objects[i]), &(this->st_attached_collision_objects), sizeof(moveit_msgs::AttachedCollisionObject));
+      }
+      union {
+        bool real;
+        uint8_t base;
+      } u_is_diff;
+      u_is_diff.base = 0;
+      u_is_diff.base |= ((uint8_t) (*(inbuffer + offset + 0))) << (8 * 0);
+      this->is_diff = u_is_diff.real;
+      offset += sizeof(this->is_diff);
+     return offset;
+    }
+
+    const char * getType(){ return "moveit_msgs/RobotState"; };
+    const char * getMD5(){ return "217a2e8e5547f4162b13a37db9cb4da4"; };
+
+  };
+
+}
+#endif