perf(motion_velocity_planner): resample trajectory and build rtree with packing algorithm #1361
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Description
Cherry-pick of autowarefoundation#7730 autowarefoundation#7732 autowarefoundation#7683 and autowarefoundation#7633
Tests performed
Psim and perception replayer.
Performance of the
out_of_lane
(most heavy module) on a rosbag with many dynamic objects:Without the PR: ~50ms runtime with peaks at 80ms.
![image](https://private-user-images.githubusercontent.com/78338830/344579578-2fb772e2-1398-4cb1-adfe-2b6a5e02ddab.png?jwt=eyJhbGciOiJIUzI1NiIsInR5cCI6IkpXVCJ9.eyJpc3MiOiJnaXRodWIuY29tIiwiYXVkIjoicmF3LmdpdGh1YnVzZXJjb250ZW50LmNvbSIsImtleSI6ImtleTUiLCJleHAiOjE3Mzk0MjU0MjEsIm5iZiI6MTczOTQyNTEyMSwicGF0aCI6Ii83ODMzODgzMC8zNDQ1Nzk1NzgtMmZiNzcyZTItMTM5OC00Y2IxLWFkZmUtMmI2YTVlMDJkZGFiLnBuZz9YLUFtei1BbGdvcml0aG09QVdTNC1ITUFDLVNIQTI1NiZYLUFtei1DcmVkZW50aWFsPUFLSUFWQ09EWUxTQTUzUFFLNFpBJTJGMjAyNTAyMTMlMkZ1cy1lYXN0LTElMkZzMyUyRmF3czRfcmVxdWVzdCZYLUFtei1EYXRlPTIwMjUwMjEzVDA1Mzg0MVomWC1BbXotRXhwaXJlcz0zMDAmWC1BbXotU2lnbmF0dXJlPTdhNDlmYjVjMjhmNjA5OTMwYWQ2ZGJkODJmZWJjOGM4NmU4N2U0YzkyMTJmNTkwOWZjNzU1Zjk5YjNlNmVlYWImWC1BbXotU2lnbmVkSGVhZGVycz1ob3N0In0.866uRt5g-Lu-tT2XZun4NG99kzSS0h2Sxv4x64skfQY)
With the PR: ~15ms runtime with peaks at 25ms
![image](https://private-user-images.githubusercontent.com/78338830/344579606-7b4edcaa-6eee-4b6f-8790-f60072d82a56.png?jwt=eyJhbGciOiJIUzI1NiIsInR5cCI6IkpXVCJ9.eyJpc3MiOiJnaXRodWIuY29tIiwiYXVkIjoicmF3LmdpdGh1YnVzZXJjb250ZW50LmNvbSIsImtleSI6ImtleTUiLCJleHAiOjE3Mzk0MjU0MjEsIm5iZiI6MTczOTQyNTEyMSwicGF0aCI6Ii83ODMzODgzMC8zNDQ1Nzk2MDYtN2I0ZWRjYWEtNmVlZS00YjZmLTg3OTAtZjYwMDcyZDgyYTU2LnBuZz9YLUFtei1BbGdvcml0aG09QVdTNC1ITUFDLVNIQTI1NiZYLUFtei1DcmVkZW50aWFsPUFLSUFWQ09EWUxTQTUzUFFLNFpBJTJGMjAyNTAyMTMlMkZ1cy1lYXN0LTElMkZzMyUyRmF3czRfcmVxdWVzdCZYLUFtei1EYXRlPTIwMjUwMjEzVDA1Mzg0MVomWC1BbXotRXhwaXJlcz0zMDAmWC1BbXotU2lnbmF0dXJlPTE3ZTc1MjExNDZhYWVlOWJiMmNhZjIzMTdkYzhjMzg0NTZiZmIyMjFkNDUzYzlkNGJlYTQ0MTY1MmRkZDcxYWQmWC1BbXotU2lnbmVkSGVhZGVycz1ob3N0In0.vKCLOPcqQVaq9W29QOhr-GmM4ZsWp0IsOdHbJrdDL4Q)
Not applicable.
Effects on system behavior
Not applicable.
Interface changes
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.
After all checkboxes are checked, anyone who has write access can merge the PR.