nucho / Mbed 2 deprecated rosserial_mbed

Dependencies:   rosserial_mbed_lib mbed Servo

Committer:
nucho
Date:
Sat Nov 12 23:53:04 2011 +0000
Revision:
3:dff241b66f84
Parent:
1:098e75fd5ad2
This program supported the revision of 167 of rosserial.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nucho 3:dff241b66f84 1 #ifndef _ROS_std_msgs_MultiArrayLayout_h
nucho 3:dff241b66f84 2 #define _ROS_std_msgs_MultiArrayLayout_h
nucho 3:dff241b66f84 3
nucho 3:dff241b66f84 4 #include <stdint.h>
nucho 3:dff241b66f84 5 #include <string.h>
nucho 3:dff241b66f84 6 #include <stdlib.h>
nucho 3:dff241b66f84 7 #include "ros/msg.h"
nucho 3:dff241b66f84 8 #include "std_msgs/MultiArrayDimension.h"
nucho 3:dff241b66f84 9
nucho 3:dff241b66f84 10 namespace std_msgs
nucho 3:dff241b66f84 11 {
nucho 3:dff241b66f84 12
nucho 3:dff241b66f84 13 class MultiArrayLayout : public ros::Msg
nucho 3:dff241b66f84 14 {
nucho 3:dff241b66f84 15 public:
nucho 3:dff241b66f84 16 uint8_t dim_length;
nucho 3:dff241b66f84 17 std_msgs::MultiArrayDimension st_dim;
nucho 3:dff241b66f84 18 std_msgs::MultiArrayDimension * dim;
nucho 3:dff241b66f84 19 uint32_t data_offset;
nucho 3:dff241b66f84 20
nucho 3:dff241b66f84 21 virtual int serialize(unsigned char *outbuffer) const
nucho 3:dff241b66f84 22 {
nucho 3:dff241b66f84 23 int offset = 0;
nucho 3:dff241b66f84 24 *(outbuffer + offset++) = dim_length;
nucho 3:dff241b66f84 25 *(outbuffer + offset++) = 0;
nucho 3:dff241b66f84 26 *(outbuffer + offset++) = 0;
nucho 3:dff241b66f84 27 *(outbuffer + offset++) = 0;
nucho 3:dff241b66f84 28 for( uint8_t i = 0; i < dim_length; i++){
nucho 3:dff241b66f84 29 offset += this->dim[i].serialize(outbuffer + offset);
nucho 3:dff241b66f84 30 }
nucho 3:dff241b66f84 31 *(outbuffer + offset + 0) = (this->data_offset >> (8 * 0)) & 0xFF;
nucho 3:dff241b66f84 32 *(outbuffer + offset + 1) = (this->data_offset >> (8 * 1)) & 0xFF;
nucho 3:dff241b66f84 33 *(outbuffer + offset + 2) = (this->data_offset >> (8 * 2)) & 0xFF;
nucho 3:dff241b66f84 34 *(outbuffer + offset + 3) = (this->data_offset >> (8 * 3)) & 0xFF;
nucho 3:dff241b66f84 35 offset += sizeof(this->data_offset);
nucho 3:dff241b66f84 36 return offset;
nucho 3:dff241b66f84 37 }
nucho 3:dff241b66f84 38
nucho 3:dff241b66f84 39 virtual int deserialize(unsigned char *inbuffer)
nucho 3:dff241b66f84 40 {
nucho 3:dff241b66f84 41 int offset = 0;
nucho 3:dff241b66f84 42 uint8_t dim_lengthT = *(inbuffer + offset++);
nucho 3:dff241b66f84 43 if(dim_lengthT > dim_length)
nucho 3:dff241b66f84 44 this->dim = (std_msgs::MultiArrayDimension*)realloc(this->dim, dim_lengthT * sizeof(std_msgs::MultiArrayDimension));
nucho 3:dff241b66f84 45 offset += 3;
nucho 3:dff241b66f84 46 dim_length = dim_lengthT;
nucho 3:dff241b66f84 47 for( uint8_t i = 0; i < dim_length; i++){
nucho 3:dff241b66f84 48 offset += this->st_dim.deserialize(inbuffer + offset);
nucho 3:dff241b66f84 49 memcpy( &(this->dim[i]), &(this->st_dim), sizeof(std_msgs::MultiArrayDimension));
nucho 3:dff241b66f84 50 }
nucho 3:dff241b66f84 51 this->data_offset |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0);
nucho 3:dff241b66f84 52 this->data_offset |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1);
nucho 3:dff241b66f84 53 this->data_offset |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2);
nucho 3:dff241b66f84 54 this->data_offset |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3);
nucho 3:dff241b66f84 55 offset += sizeof(this->data_offset);
nucho 3:dff241b66f84 56 return offset;
nucho 3:dff241b66f84 57 }
nucho 3:dff241b66f84 58
nucho 3:dff241b66f84 59 virtual const char * getType(){ return "std_msgs/MultiArrayLayout"; };
nucho 3:dff241b66f84 60 virtual const char * getMD5(){ return "0fed2a11c13e11c5571b4e2a995a91a3"; };
nucho 3:dff241b66f84 61
nucho 3:dff241b66f84 62 };
nucho 3:dff241b66f84 63
nucho 3:dff241b66f84 64 }
nucho 0:06fc856e99ca 65 #endif