Project

General

Profile

Statistics
| Branch: | Revision:

root / quad2 / arduino / src / ros_lib / sensor_msgs / SetCameraInfo.h @ c1426757

History | View | Annotate | Download (2.54 KB)

1
#ifndef _ROS_SERVICE_SetCameraInfo_h
2
#define _ROS_SERVICE_SetCameraInfo_h
3
#include <stdint.h>
4
#include <string.h>
5
#include <stdlib.h>
6
#include "ros/msg.h"
7
#include "sensor_msgs/CameraInfo.h"
8

    
9
namespace sensor_msgs
10
{
11

    
12
static const char SETCAMERAINFO[] = "sensor_msgs/SetCameraInfo";
13

    
14
  class SetCameraInfoRequest : public ros::Msg
15
  {
16
    public:
17
      sensor_msgs::CameraInfo camera_info;
18

    
19
    virtual int serialize(unsigned char *outbuffer) const
20
    {
21
      int offset = 0;
22
      offset += this->camera_info.serialize(outbuffer + offset);
23
      return offset;
24
    }
25

    
26
    virtual int deserialize(unsigned char *inbuffer)
27
    {
28
      int offset = 0;
29
      offset += this->camera_info.deserialize(inbuffer + offset);
30
     return offset;
31
    }
32

    
33
    const char * getType(){ return SETCAMERAINFO; };
34
    const char * getMD5(){ return "ee34be01fdeee563d0d99cd594d5581d"; };
35

    
36
  };
37

    
38
  class SetCameraInfoResponse : public ros::Msg
39
  {
40
    public:
41
      bool success;
42
      char * status_message;
43

    
44
    virtual int serialize(unsigned char *outbuffer) const
45
    {
46
      int offset = 0;
47
      union {
48
        bool real;
49
        uint8_t base;
50
      } u_success;
51
      u_success.real = this->success;
52
      *(outbuffer + offset + 0) = (u_success.base >> (8 * 0)) & 0xFF;
53
      offset += sizeof(this->success);
54
      uint32_t * length_status_message = (uint32_t *)(outbuffer + offset);
55
      *length_status_message = strlen( (const char*) this->status_message);
56
      offset += 4;
57
      memcpy(outbuffer + offset, this->status_message, *length_status_message);
58
      offset += *length_status_message;
59
      return offset;
60
    }
61

    
62
    virtual int deserialize(unsigned char *inbuffer)
63
    {
64
      int offset = 0;
65
      union {
66
        bool real;
67
        uint8_t base;
68
      } u_success;
69
      u_success.base = 0;
70
      u_success.base |= ((uint8_t) (*(inbuffer + offset + 0))) << (8 * 0);
71
      this->success = u_success.real;
72
      offset += sizeof(this->success);
73
      uint32_t length_status_message = *(uint32_t *)(inbuffer + offset);
74
      offset += 4;
75
      for(unsigned int k= offset; k< offset+length_status_message; ++k){
76
          inbuffer[k-1]=inbuffer[k];
77
      }
78
      inbuffer[offset+length_status_message-1]=0;
79
      this->status_message = (char *)(inbuffer + offset-1);
80
      offset += length_status_message;
81
     return offset;
82
    }
83

    
84
    const char * getType(){ return SETCAMERAINFO; };
85
    const char * getMD5(){ return "2ec6f3eff0161f4257b808b12bc830c2"; };
86

    
87
  };
88

    
89
  class SetCameraInfo {
90
    public:
91
    typedef SetCameraInfoRequest Request;
92
    typedef SetCameraInfoResponse Response;
93
  };
94

    
95
}
96
#endif