Exemplo n.º 1
0
 private Vector3 GetPosition(NavigationOdometry message)
 {
     return(new Vector3(
                message.pose.pose.position.x,
                message.pose.pose.position.y,
                message.pose.pose.position.z));
 }
Exemplo n.º 2
0
 private Quaternion GetRotation(NavigationOdometry message)
 {
     return(new Quaternion(
                message.pose.pose.orientation.x,
                message.pose.pose.orientation.y,
                message.pose.pose.orientation.z,
                message.pose.pose.orientation.w));
 }