31 #ifndef TF2_BULLET__TF2_BULLET_H_
32 #define TF2_BULLET__TF2_BULLET_H_
35 #include <LinearMath/btScalar.h>
36 #include <LinearMath/btTransform.h>
37 #include <geometry_msgs/msg/point_stamped.hpp>
42 #if (BT_BULLET_VERSION <= 282)
47 return btInfinityMask;
62 static_cast < float > (t.transform.rotation.x),
63 static_cast < float > (t.transform.rotation.y),
64 static_cast < float > (t.transform.rotation.z),
65 static_cast < float > (t.transform.rotation.w)),
67 static_cast < float > (t.transform.translation.x),
68 static_cast < float > (t.transform.translation.y),
69 static_cast < float > (t.transform.translation.z)));
83 const geometry_msgs::msg::TransformStamped & transform)
99 geometry_msgs::msg::PointStamped msg;
118 out[0] =
static_cast < float > (msg.point.x);
119 out[1] =
static_cast < float > (msg.point.y);
120 out[2] =
static_cast < float > (msg.point.z);
134 const geometry_msgs::msg::TransformStamped & transform)
145 #endif // TF2_BULLET__TF2_BULLET_H_