#include "arm/arm.hpp"
#include <chrono>
#include <thread>
#include <Eigen/Geometry>
#include "lookup.hpp"
#include "util/grav_comp.hpp"