Gary Servin / rosserial_mbed_lib

Personal fork

Dependencies:   MODSERIAL

Dependents:   rosserial_mbed

Fork of rosserial_mbed_lib by nucho

dianostic_msgs/DiagnosticStatus.h@3:1cf99502f396, 2011-11-12 (annotated)

Committer:
nucho
Date:
Sat Nov 12 23:54:45 2011 +0000
Revision:
3:1cf99502f396
Parent:
1:ff0ec969dad1
Child:
4:684f39d0c346
This program supported the revision of 167 of rosserial.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nucho 3:1cf99502f396 1 #ifndef _ROS_diagnostic_msgs_DiagnosticStatus_h
nucho 3:1cf99502f396 2 #define _ROS_diagnostic_msgs_DiagnosticStatus_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 3:1cf99502f396 7 #include "ros/msg.h"
nucho 3:1cf99502f396 8 #include "diagnostic_msgs/byte.h"
nucho 0:77afd7560544 9 #include "diagnostic_msgs/KeyValue.h"
nucho 0:77afd7560544 10
nucho 3:1cf99502f396 11 namespace diagnostic_msgs
nucho 3:1cf99502f396 12 {
nucho 0:77afd7560544 13
nucho 3:1cf99502f396 14 class DiagnosticStatus : public ros::Msg
nucho 3:1cf99502f396 15 {
nucho 3:1cf99502f396 16 public:
nucho 3:1cf99502f396 17 diagnostic_msgs::byte level;
nucho 3:1cf99502f396 18 char * name;
nucho 3:1cf99502f396 19 char * message;
nucho 3:1cf99502f396 20 char * hardware_id;
nucho 3:1cf99502f396 21 uint8_t values_length;
nucho 3:1cf99502f396 22 diagnostic_msgs::KeyValue st_values;
nucho 3:1cf99502f396 23 diagnostic_msgs::KeyValue * values;
nucho 3:1cf99502f396 24 enum { OK = 0 };
nucho 3:1cf99502f396 25 enum { WARN = 1 };
nucho 3:1cf99502f396 26 enum { ERROR = 2 };
nucho 0:77afd7560544 27
nucho 3:1cf99502f396 28 virtual int serialize(unsigned char *outbuffer) const
nucho 3:1cf99502f396 29 {
nucho 3:1cf99502f396 30 int offset = 0;
nucho 3:1cf99502f396 31 offset += this->level.serialize(outbuffer + offset);
nucho 3:1cf99502f396 32 uint32_t * length_name = (uint32_t *)(outbuffer + offset);
nucho 3:1cf99502f396 33 *length_name = strlen( (const char*) this->name);
nucho 3:1cf99502f396 34 offset += 4;
nucho 3:1cf99502f396 35 memcpy(outbuffer + offset, this->name, *length_name);
nucho 3:1cf99502f396 36 offset += *length_name;
nucho 3:1cf99502f396 37 uint32_t * length_message = (uint32_t *)(outbuffer + offset);
nucho 3:1cf99502f396 38 *length_message = strlen( (const char*) this->message);
nucho 3:1cf99502f396 39 offset += 4;
nucho 3:1cf99502f396 40 memcpy(outbuffer + offset, this->message, *length_message);
nucho 3:1cf99502f396 41 offset += *length_message;
nucho 3:1cf99502f396 42 uint32_t * length_hardware_id = (uint32_t *)(outbuffer + offset);
nucho 3:1cf99502f396 43 *length_hardware_id = strlen( (const char*) this->hardware_id);
nucho 3:1cf99502f396 44 offset += 4;
nucho 3:1cf99502f396 45 memcpy(outbuffer + offset, this->hardware_id, *length_hardware_id);
nucho 3:1cf99502f396 46 offset += *length_hardware_id;
nucho 3:1cf99502f396 47 *(outbuffer + offset++) = values_length;
nucho 3:1cf99502f396 48 *(outbuffer + offset++) = 0;
nucho 3:1cf99502f396 49 *(outbuffer + offset++) = 0;
nucho 3:1cf99502f396 50 *(outbuffer + offset++) = 0;
nucho 3:1cf99502f396 51 for( uint8_t i = 0; i < values_length; i++){
nucho 3:1cf99502f396 52 offset += this->values[i].serialize(outbuffer + offset);
nucho 3:1cf99502f396 53 }
nucho 3:1cf99502f396 54 return offset;
nucho 0:77afd7560544 55 }
nucho 0:77afd7560544 56
nucho 3:1cf99502f396 57 virtual int deserialize(unsigned char *inbuffer)
nucho 3:1cf99502f396 58 {
nucho 3:1cf99502f396 59 int offset = 0;
nucho 3:1cf99502f396 60 offset += this->level.deserialize(inbuffer + offset);
nucho 3:1cf99502f396 61 uint32_t length_name = *(uint32_t *)(inbuffer + offset);
nucho 3:1cf99502f396 62 offset += 4;
nucho 3:1cf99502f396 63 for(unsigned int k= offset; k< offset+length_name; ++k){
nucho 3:1cf99502f396 64 inbuffer[k-1]=inbuffer[k];
nucho 3:1cf99502f396 65 }
nucho 3:1cf99502f396 66 inbuffer[offset+length_name-1]=0;
nucho 3:1cf99502f396 67 this->name = (char *)(inbuffer + offset-1);
nucho 3:1cf99502f396 68 offset += length_name;
nucho 3:1cf99502f396 69 uint32_t length_message = *(uint32_t *)(inbuffer + offset);
nucho 3:1cf99502f396 70 offset += 4;
nucho 3:1cf99502f396 71 for(unsigned int k= offset; k< offset+length_message; ++k){
nucho 3:1cf99502f396 72 inbuffer[k-1]=inbuffer[k];
nucho 3:1cf99502f396 73 }
nucho 3:1cf99502f396 74 inbuffer[offset+length_message-1]=0;
nucho 3:1cf99502f396 75 this->message = (char *)(inbuffer + offset-1);
nucho 3:1cf99502f396 76 offset += length_message;
nucho 3:1cf99502f396 77 uint32_t length_hardware_id = *(uint32_t *)(inbuffer + offset);
nucho 3:1cf99502f396 78 offset += 4;
nucho 3:1cf99502f396 79 for(unsigned int k= offset; k< offset+length_hardware_id; ++k){
nucho 3:1cf99502f396 80 inbuffer[k-1]=inbuffer[k];
nucho 3:1cf99502f396 81 }
nucho 3:1cf99502f396 82 inbuffer[offset+length_hardware_id-1]=0;
nucho 3:1cf99502f396 83 this->hardware_id = (char *)(inbuffer + offset-1);
nucho 3:1cf99502f396 84 offset += length_hardware_id;
nucho 3:1cf99502f396 85 uint8_t values_lengthT = *(inbuffer + offset++);
nucho 3:1cf99502f396 86 if(values_lengthT > values_length)
nucho 3:1cf99502f396 87 this->values = (diagnostic_msgs::KeyValue*)realloc(this->values, values_lengthT * sizeof(diagnostic_msgs::KeyValue));
nucho 3:1cf99502f396 88 offset += 3;
nucho 3:1cf99502f396 89 values_length = values_lengthT;
nucho 3:1cf99502f396 90 for( uint8_t i = 0; i < values_length; i++){
nucho 3:1cf99502f396 91 offset += this->st_values.deserialize(inbuffer + offset);
nucho 3:1cf99502f396 92 memcpy( &(this->values[i]), &(this->st_values), sizeof(diagnostic_msgs::KeyValue));
nucho 3:1cf99502f396 93 }
nucho 3:1cf99502f396 94 return offset;
nucho 0:77afd7560544 95 }
nucho 0:77afd7560544 96
nucho 3:1cf99502f396 97 virtual const char * getType(){ return "diagnostic_msgs/DiagnosticStatus"; };
nucho 3:1cf99502f396 98 virtual const char * getMD5(){ return "67d15a62edb26e9d52b0f0efa3ef9da7"; };
nucho 0:77afd7560544 99
nucho 3:1cf99502f396 100 };
nucho 0:77afd7560544 101
nucho 0:77afd7560544 102 }
nucho 0:77afd7560544 103 #endif