#include <thread>
#include <rclcpp/clock.hpp>
#include <rclcpp/rclcpp.hpp>
#include <BipedalLocomotion/System/RosClock.h>