#include "franky/motion/stop_motion.hpp"
#include <algorithm>
#include <array>
#include "franky/model.hpp"
#include "franky/robot.hpp"