16using namespace std::placeholders;
37 if(m_node ==
nullptr) {
41 m_subscriptionFtTimed = m_node->create_subscription<tf2_msgs::msg::TFMessage>(
m_ROS2_ft_topic, 10,
46 qos =
qos.transient_local();
69 std::lock_guard<std::mutex> lock(m_trf_mutex);
85 std::lock_guard<std::mutex> lock(m_trf_mutex);
92 std::lock_guard<std::mutex> lock(m_trf_mutex);
99 output.
translation.tX = input.transform.translation.x;
100 output.
translation.tY = input.transform.translation.y;
101 output.
translation.tZ = input.transform.translation.z;
103 output.
rotation.
w() = input.transform.rotation.w;
104 output.
rotation.
x() = input.transform.rotation.x;
105 output.
rotation.
y() = input.transform.rotation.y;
106 output.
rotation.
z() = input.transform.rotation.z;
116 for (
auto&
it : transforms)
double yarpTimeFromRos2(builtin_interfaces::msg::Time ros2Time)
static rclcpp::Node::SharedPtr createNode(std::string name)
@ return_value_error_generic
Method was successfully executed.
A mini-server for performing network communication in the background.
static bool checkNetwork()
Check if the YARP Network is up and running.
A base class for nested structures that can be searched.
bool start()
Start the new thread running.
#define yCInfo(component,...)
#define yCError(component,...)
#define yCTrace(component,...)
#define YARP_LOG_COMPONENT(name,...)
For streams capable of holding different kinds of content, check what they actually have.
An interface to the operating system, including Port based communication.