fix: caluculation for the gravity by slope in ego entity simulation

[HansRobo]

Description

Abstract

fix caluculation for the gravity by slope in ego entity simulation

Background

This bug was introduced in #1447

Details

• use pitch-filled map pose for ego pitch calculation
• fix sign in caluculation of accelerlation_by_slope
• fix pitch caluculation in tests

The accelerlation_by_slope caluculation is was done as shown in the figure below and reflected in the code.

References

Regression Test: OK

Destructive Changes

Known Limitations

[github-actions]

Checklist for reviewers ☑️

All references to "You" in the following text refer to the code reviewer.

• Is this pull request written in a way that is easy to read from a third-party perspective?
• Is there sufficient information (background, purpose, specification, algorithm description, list of disruptive changes, and migration guide) in the description of this pull request?
• If this pull request contains a destructive change, does this pull request contain the migration guide?
• Labels of this pull request are valid?
• All unit tests/integration tests are included in this pull request? If you think adding test cases is unnecessary, please describe why and cross out this line.
• The documentation for this pull request is enough? If you think adding documents for this pull request is unnecessary, please describe why and cross out this line.

[sonarqubecloud]

Quality Gate passed

Issues
0 New issues
0 Accepted issues

Measures
0 Security Hotspots
100.0% Coverage on New Code
0.0% Duplication on New Code

See analysis details on SonarQube Cloud