Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Fix NED/ENU angle conversion issues #3

Merged
merged 2 commits into from
Mar 30, 2023

Conversation

KhaledSaad-StreetDrone
Copy link

  • Implemented a method to wrap between -Pi and Pi
  • Changed the euler angle ENU conversion to wrap the yaw to Pi, instead of the original (2 Pi)
  • Refactored the quaternion conversion to convert to euler, apply the correct operation to transform to ENU, then convert back to NED

I had a look at several ways to do the quaternion ENU conversion, but this is the only one I could get to work properly without spending significantly longer on this task.

The use of rosidl_target_interfaces is deprecated (see [Humble release notes](http://docs.ros.org.ros.informatik.uni-freiburg.de/en/humble/Releases/Release-Humble-Hawksbill.html#deprecation-of-rosidl-target-interfaces). Here that actually causes an issue with CMake not setting the right include directory paths, breaking `colcon build` on humble.

This applies the documented update, making the driver build under Humble
@KhaledSaad-StreetDrone KhaledSaad-StreetDrone force-pushed the 2-quaternion-ned-to-enu-incorrect branch from 1c7dc0b to da07b4c Compare March 29, 2023 15:44
@KhaledSaad-StreetDrone KhaledSaad-StreetDrone changed the title Fix Fix NED/ENU angle conversion issues Mar 29, 2023
Copy link

@SanderVanDijk-StreetDrone SanderVanDijk-StreetDrone left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

I think it makes sense. In any case it is consistent with the transformation of the Euler based filter

@KhaledSaad-StreetDrone KhaledSaad-StreetDrone merged commit c3fc1f0 into master Mar 30, 2023
@KhaledSaad-StreetDrone KhaledSaad-StreetDrone deleted the 2-quaternion-ned-to-enu-incorrect branch March 30, 2023 13:55
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

Quaternion NED to ENU conversion seems incorrect
2 participants