nucho / rosserial_mbed_lib

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:  

Dependents:   rosserial_mbed robot_S2

geometry_msgs/PoseArray.h@1:ff0ec969dad1, 2011-10-16 (annotated)

Committer:
nucho
Date:
Sun Oct 16 07:19:36 2011 +0000
Revision:
1:ff0ec969dad1
Parent:
0:77afd7560544
Child:
3:1cf99502f396
This program supported the revision of 143 of rosserial.

And the bug fix of receive of array data.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nucho 1:ff0ec969dad1 1 #ifndef ros_geometry_msgs_PoseArray_h
nucho 1:ff0ec969dad1 2 #define ros_geometry_msgs_PoseArray_h
nucho 0:77afd7560544 3
nucho 0:77afd7560544 4 #include <stdint.h>
nucho 0:77afd7560544 5 #include <string.h>
nucho 0:77afd7560544 6 #include <stdlib.h>
nucho 0:77afd7560544 7 #include "../ros/msg.h"
nucho 0:77afd7560544 8 #include "std_msgs/Header.h"
nucho 0:77afd7560544 9 #include "geometry_msgs/Pose.h"
nucho 0:77afd7560544 10
nucho 0:77afd7560544 11 namespace geometry_msgs
nucho 0:77afd7560544 12 {
nucho 0:77afd7560544 13
nucho 0:77afd7560544 14 class PoseArray : public ros::Msg
nucho 0:77afd7560544 15 {
nucho 0:77afd7560544 16 public:
nucho 0:77afd7560544 17 std_msgs::Header header;
nucho 0:77afd7560544 18 unsigned char poses_length;
nucho 0:77afd7560544 19 geometry_msgs::Pose st_poses;
nucho 0:77afd7560544 20 geometry_msgs::Pose * poses;
nucho 0:77afd7560544 21
nucho 0:77afd7560544 22 virtual int serialize(unsigned char *outbuffer)
nucho 0:77afd7560544 23 {
nucho 0:77afd7560544 24 int offset = 0;
nucho 0:77afd7560544 25 offset += this->header.serialize(outbuffer + offset);
nucho 0:77afd7560544 26 *(outbuffer + offset++) = poses_length;
nucho 0:77afd7560544 27 *(outbuffer + offset++) = 0;
nucho 0:77afd7560544 28 *(outbuffer + offset++) = 0;
nucho 0:77afd7560544 29 *(outbuffer + offset++) = 0;
nucho 0:77afd7560544 30 for( unsigned char i = 0; i < poses_length; i++){
nucho 0:77afd7560544 31 offset += this->poses[i].serialize(outbuffer + offset);
nucho 0:77afd7560544 32 }
nucho 0:77afd7560544 33 return offset;
nucho 0:77afd7560544 34 }
nucho 0:77afd7560544 35
nucho 0:77afd7560544 36 virtual int deserialize(unsigned char *inbuffer)
nucho 0:77afd7560544 37 {
nucho 0:77afd7560544 38 int offset = 0;
nucho 0:77afd7560544 39 offset += this->header.deserialize(inbuffer + offset);
nucho 0:77afd7560544 40 unsigned char poses_lengthT = *(inbuffer + offset++);
nucho 0:77afd7560544 41 if(poses_lengthT > poses_length)
nucho 0:77afd7560544 42 this->poses = (geometry_msgs::Pose*)realloc(this->poses, poses_lengthT * sizeof(geometry_msgs::Pose));
nucho 0:77afd7560544 43 offset += 3;
nucho 0:77afd7560544 44 poses_length = poses_lengthT;
nucho 0:77afd7560544 45 for( unsigned char i = 0; i < poses_length; i++){
nucho 0:77afd7560544 46 offset += this->st_poses.deserialize(inbuffer + offset);
nucho 0:77afd7560544 47 memcpy( &(this->poses[i]), &(this->st_poses), sizeof(geometry_msgs::Pose));
nucho 0:77afd7560544 48 }
nucho 0:77afd7560544 49 return offset;
nucho 0:77afd7560544 50 }
nucho 0:77afd7560544 51
nucho 0:77afd7560544 52 virtual const char * getType(){ return "geometry_msgs/PoseArray"; };
nucho 0:77afd7560544 53
nucho 0:77afd7560544 54 };
nucho 0:77afd7560544 55
nucho 0:77afd7560544 56 }
nucho 0:77afd7560544 57 #endif