void Gps_pos::convert_rotation_angles_rad_to_grad() { Point rot = (*this).get_rotation(); rot = rot.DivS(PI).MultS(180.0); rot.set_dXYZ( rot.get_dXYZ().DivS(PI).MultS(180.0) ); (*this).set_rotation(rot); }
void Gps_pos::convert_rotation_angles_grad_to_rad() { //## convert angle [roll pitch heading] from degree to radiant ## Point rot = (*this).get_rotation(); rot = rot.DivS(180.0).MultS(PI); rot.set_dXYZ( rot.get_dXYZ().DivS(180.0).MultS(PI) ); (*this).set_rotation(rot); //## end convert angle from degree to radiant ## }