18 std::vector<std::pair<Eigen::Vector3d, double>>
mapPoints;
Wheels getGripValues(std::array< Eigen::Vector3d, 4 > in)
std::shared_ptr< Logger > logger
void transformPoints(Eigen::Vector3d trans, Eigen::Vector3d rot)
void loadConfig(std::string path)
std::vector< std::pair< Eigen::Vector3d, double > > mapPoints