void TPose3D::asString(std::string& s) const { s = mrpt::format( "[%f %f %f %f %f %f]", x, y, z, RAD2DEG(yaw), RAD2DEG(pitch), RAD2DEG(roll)); }
// ---- void TTwist2D::asString(std::string& s) const { s = mrpt::format("[%f %f %f]", vx, vy, RAD2DEG(omega)); }
// ---- void TTwist3D::asString(std::string& s) const { s = mrpt::format( "[%f %f %f %f %f %f]", vx, vy, vz, RAD2DEG(wx), RAD2DEG(wy), RAD2DEG(wz)); }