-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathgeometry_msgs_Pose.h
110 lines (90 loc) · 3.36 KB
/
geometry_msgs_Pose.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
// This is an automatically generated file.
// Generated from this geometry_msgs_Pose.msg definition:
// geometry_msgs/Point position
// geometry_msgs/Quaternion orientation
// Instances of this class can be read and written with YARP ports,
// using a ROS-compatible format.
#ifndef YARPMSG_TYPE_geometry_msgs_Pose
#define YARPMSG_TYPE_geometry_msgs_Pose
#include <string>
#include <vector>
#include <yarp/os/Wire.h>
#include <yarp/os/idl/WireTypes.h>
#include "FloorPlane.h"
#include "geometry_msgs_Point.h"
#include "geometry_msgs_Quaternion.h"
class geometry_msgs_Pose : public yarp::os::idl::WirePortable {
public:
geometry_msgs_Point position;
geometry_msgs_Quaternion orientation;
geometry_msgs_Pose() {
}
bool readBare(yarp::os::ConnectionReader& connection) {
// *** position ***
if (!position.read(connection)) return false;
// *** orientation ***
if (!orientation.read(connection)) return false;
return !connection.isError();
}
bool readBottle(yarp::os::ConnectionReader& connection) {
connection.convertTextMode();
yarp::os::idl::WireReader reader(connection);
if (!reader.readListHeader(2)) return false;
// *** position ***
if (!position.read(connection)) return false;
// *** orientation ***
if (!orientation.read(connection)) return false;
return !connection.isError();
}
bool read(yarp::os::ConnectionReader& connection) {
if (connection.isBareMode()) return readBare(connection);
return readBottle(connection);
}
bool writeBare(yarp::os::ConnectionWriter& connection) {
// *** position ***
if (!position.write(connection)) return false;
// *** orientation ***
if (!orientation.write(connection)) return false;
return !connection.isError();
}
bool writeBottle(yarp::os::ConnectionWriter& connection) {
connection.appendInt(BOTTLE_TAG_LIST);
connection.appendInt(2);
// *** position ***
if (!position.write(connection)) return false;
// *** orientation ***
if (!orientation.write(connection)) return false;
connection.convertTextMode();
return !connection.isError();
}
bool write(yarp::os::ConnectionWriter& connection) {
if (connection.isBareMode()) return writeBare(connection);
return writeBottle(connection);
}
// This class will serialize ROS style or YARP style depending on protocol.
// If you need to force a serialization style, use one of these classes:
typedef yarp::os::idl::BareStyle<geometry_msgs_Pose> rosStyle;
typedef yarp::os::idl::BottleStyle<geometry_msgs_Pose> bottleStyle;
// Give source text for class, ROS will need this
yarp::os::ConstString getTypeText() {
return "geometry_msgs/Point position\n\
geometry_msgs/Quaternion orientation\n================================================================================\n\
MSG: geometry_msgs/Point\n\
float64 x\n\
float64 y\n\
float64 z\n================================================================================\n\
MSG: geometry_msgs/Quaternion\n\
float64 x\n\
float64 y\n\
float64 z\n\
float64 w";
}
// Name the class, ROS will need this
yarp::os::Type getType() {
yarp::os::Type typ = yarp::os::Type::byName("geometry_msgs/Pose","geometry_msgs/Pose");
typ.addProperty("md5sum",yarp::os::Value("e45d45a5a1ce597b249e23fb30fc871f"));
typ.addProperty("message_definition",yarp::os::Value(getTypeText()));
return typ;
}
};
#endif