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(pose2twist): compute angular velocity through quaternion #7322

Conversation

KYabuuchi
Copy link
Contributor

@KYabuuchi KYabuuchi commented Jun 6, 2024

Description

I have modified the method for obtaining angular velocity from pose.
In the previous approach, incorrect values could be obtained when pitch or yaw were not zero.

Additionally, I have added tests to verify the correctness of my implementation.

Tests performed

logging_simualtor.launch.xml & pose2twist.launch.xml

I have confirmed that twist is being output by launching logging_simulator and pose_twist.launch.

Furthermore, I have verified that the estimated angular velocity does not differ from the previous method.
(Since roll and pitch are sufficiently small in the sample rosbag, the previous method also estimate the correct angular velocity.)

image

Execute gtest

gtest has been passed.

colcon test --event-handlers console_cohesion+ summary+ --packages-select pose2twist

Effects on system behavior

Not applicable.

Interface changes

Interface does not change.

Pre-review checklist for the PR author

The PR author must check the checkboxes below when creating the PR.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

Post-review checklist for the PR author

The PR author must check the checkboxes below before merging.

  • There are no open discussions or they are tracked via tickets.

After all checkboxes are checked, anyone who has write access can merge the PR.

@github-actions github-actions bot added the component:localization Vehicle's position determination in its environment. (auto-assigned) label Jun 6, 2024
KYabuuchi added 4 commits June 7, 2024 11:01
Signed-off-by: Kento Yabuuchi <[email protected]>
Signed-off-by: Kento Yabuuchi <[email protected]>
Signed-off-by: Kento Yabuuchi <[email protected]>
@KYabuuchi KYabuuchi force-pushed the fix/angular_velocity_through_quaternion branch from 1d1bdb7 to af089e0 Compare June 7, 2024 02:05
@github-actions github-actions bot added the type:documentation Creating or refining documentation. (auto-assigned) label Jun 7, 2024
Signed-off-by: Kento Yabuuchi <[email protected]>
@KYabuuchi KYabuuchi added the tag:run-build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Jun 7, 2024
@KYabuuchi KYabuuchi marked this pull request as ready for review June 7, 2024 02:34
Signed-off-by: Kento Yabuuchi <[email protected]>
Copy link
Contributor

@SakodaShintaro SakodaShintaro left a comment

Choose a reason for hiding this comment

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

Thanks a lot!
Looks Good To Me

@KYabuuchi KYabuuchi merged commit c85b83d into autowarefoundation:main Jun 7, 2024
24 checks passed
@KYabuuchi KYabuuchi deleted the fix/angular_velocity_through_quaternion branch June 7, 2024 05:44
KhalilSelyan pushed a commit that referenced this pull request Jul 22, 2024
* compute angular velocity from two quaternions

Signed-off-by: Kento Yabuuchi <[email protected]>

* add test

Signed-off-by: Kento Yabuuchi <[email protected]>

* add some comments

Signed-off-by: Kento Yabuuchi <[email protected]>

* remove rpy description

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix typo

Signed-off-by: Kento Yabuuchi <[email protected]>

* fix clang-tidy's warning

Signed-off-by: Kento Yabuuchi <[email protected]>

---------

Signed-off-by: Kento Yabuuchi <[email protected]>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:localization Vehicle's position determination in its environment. (auto-assigned) tag:run-build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) type:documentation Creating or refining documentation. (auto-assigned)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants