#include "franky/robot_pose.hpp"
#include <optional>
#include <Eigen/Core>
#include <utility>
#include <franka/control_types.h>
#include "franky/types.hpp"