|
| 1 | +// Copyright (c) 2024 Boston Dynamics AI Institute LLC. All rights reserved. |
| 2 | + |
| 3 | +#include "bosdyn_api_msgs/manual_conversions.hpp" |
| 4 | + |
| 5 | +namespace bosdyn_api_msgs::conversions { |
| 6 | + |
| 7 | +void Convert(const geometry_msgs::msg::Vector3& ros_msg, bosdyn::api::Vec3* proto_msg) { |
| 8 | + proto_msg->set_x(ros_msg.x); |
| 9 | + proto_msg->set_y(ros_msg.y); |
| 10 | + proto_msg->set_z(ros_msg.z); |
| 11 | +} |
| 12 | + |
| 13 | +void Convert(const bosdyn::api::Vec3& proto_msg, geometry_msgs::msg::Vector3* ros_msg) { |
| 14 | + ros_msg->x = proto_msg.x(); |
| 15 | + ros_msg->y = proto_msg.y(); |
| 16 | + ros_msg->z = proto_msg.z(); |
| 17 | +} |
| 18 | + |
| 19 | +void Convert(const geometry_msgs::msg::Point& ros_msg, bosdyn::api::Vec3* proto_msg) { |
| 20 | + proto_msg->set_x(ros_msg.x); |
| 21 | + proto_msg->set_y(ros_msg.y); |
| 22 | + proto_msg->set_z(ros_msg.z); |
| 23 | +} |
| 24 | + |
| 25 | +void Convert(const bosdyn::api::Vec3& proto_msg, geometry_msgs::msg::Point* ros_msg) { |
| 26 | + ros_msg->x = proto_msg.x(); |
| 27 | + ros_msg->y = proto_msg.y(); |
| 28 | + ros_msg->z = proto_msg.z(); |
| 29 | +} |
| 30 | + |
| 31 | +void Convert(const geometry_msgs::msg::Quaternion& ros_msg, bosdyn::api::Quaternion* proto_msg) { |
| 32 | + proto_msg->set_x(ros_msg.x); |
| 33 | + proto_msg->set_y(ros_msg.y); |
| 34 | + proto_msg->set_z(ros_msg.z); |
| 35 | + proto_msg->set_w(ros_msg.w); |
| 36 | +} |
| 37 | + |
| 38 | +void Convert(const bosdyn::api::Quaternion& proto_msg, geometry_msgs::msg::Quaternion* ros_msg) { |
| 39 | + ros_msg->x = proto_msg.x(); |
| 40 | + ros_msg->y = proto_msg.y(); |
| 41 | + ros_msg->z = proto_msg.z(); |
| 42 | + ros_msg->w = proto_msg.w(); |
| 43 | +} |
| 44 | + |
| 45 | +void Convert(const geometry_msgs::msg::Pose& ros_msg, bosdyn::api::SE3Pose* proto_msg) { |
| 46 | + Convert(ros_msg.position, proto_msg->mutable_position()); |
| 47 | + Convert(ros_msg.orientation, proto_msg->mutable_rotation()); |
| 48 | +} |
| 49 | + |
| 50 | +void Convert(const bosdyn::api::SE3Pose& proto_msg, geometry_msgs::msg::Pose* ros_msg) { |
| 51 | + Convert(proto_msg.position(), &ros_msg->position); |
| 52 | + Convert(proto_msg.rotation(), &ros_msg->orientation); |
| 53 | +} |
| 54 | + |
| 55 | +void Convert(const geometry_msgs::msg::Twist& ros_msg, bosdyn::api::SE3Velocity* proto_msg) { |
| 56 | + Convert(ros_msg.linear, proto_msg->mutable_linear()); |
| 57 | + Convert(ros_msg.angular, proto_msg->mutable_angular()); |
| 58 | +} |
| 59 | + |
| 60 | +void Convert(const bosdyn::api::SE3Velocity& proto_msg, geometry_msgs::msg::Twist* ros_msg) { |
| 61 | + Convert(proto_msg.linear(), &ros_msg->linear); |
| 62 | + Convert(proto_msg.angular(), &ros_msg->angular); |
| 63 | +} |
| 64 | + |
| 65 | +void Convert(const geometry_msgs::msg::Wrench& ros_msg, bosdyn::api::Wrench* proto_msg) { |
| 66 | + Convert(ros_msg.force, proto_msg->mutable_force()); |
| 67 | + Convert(ros_msg.torque, proto_msg->mutable_torque()); |
| 68 | +} |
| 69 | + |
| 70 | +void Convert(const bosdyn::api::Wrench& proto_msg, geometry_msgs::msg::Wrench* ros_msg) { |
| 71 | + Convert(proto_msg.force(), &ros_msg->force); |
| 72 | + Convert(proto_msg.torque(), &ros_msg->torque); |
| 73 | +} |
| 74 | + |
| 75 | +} // namespace bosdyn_api_msgs::conversions |
0 commit comments