std::string toEulerString( const CoordinateFrame &c ) { stringstream ss; ss<<"pos: " << toString(c.pos()) <<", r="<<c.roll()*180.0/M_PI<<"deg" <<", p="<<c.pitch()*180.0/M_PI<<"deg" <<", y="<<c.yaw()*180.0/M_PI<<"deg"; return ss.str(); }
std::string toString( const CoordinateFrame &c ) { stringstream ss; ss << endl; ss<<"fwd: " << toString(c.fwd()) << endl; ss<<"left: " << toString(c.left()) << endl; ss<<"up: " << toString(c.up()) << endl; ss<<"pos: " << toString(c.pos()); return ss.str(); }