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

feat: add motion_velocity_smoother package #48

Merged
Show file tree
Hide file tree
Changes from 1 commit
Commits
Show all changes
29 commits
Select commit Hold shift + click to select a range
844686e
Feature/porting motion velocity smoother (#1653)
wep21 Oct 21, 2021
28c9d66
Feature/add trajectory_visualizer and closest_velocity_checker to mot…
td12321 Oct 21, 2021
12b2b1e
Feature/port analytical smoother (#1896)
mkuri Oct 21, 2021
8beed74
fix for createQuaternionFromRPY/Yaw (#2154)
takayuki5168 Oct 1, 2021
a9efa71
fix stop dist calc bug (#2152)
satoshi-ota Oct 1, 2021
03b4516
use interpolation::slerp (#2161)
takayuki5168 Oct 4, 2021
09b5a28
Add post resampling explanations (#2155)
purewater0901 Oct 7, 2021
73d6c20
Feature/use external jerk/acc constraints (#2130)
satoshi-ota Oct 8, 2021
3a736b2
Feature/add external velocity limit selector (#2217)
satoshi-ota Oct 15, 2021
b582246
Fix/smoother params (#2239)
satoshi-ota Oct 18, 2021
46056f9
Update velocity debug script (add vehicle engage check) (#2267)
TakaHoribe Oct 21, 2021
247effa
[motion_velocity_smoother] fix trajectory size guard condition (#2297)
TakaHoribe Oct 28, 2021
ba51bc3
Change formatter to clang-format and black (#2332)
kenji-miyake Nov 2, 2021
cd57a84
Add COLCON_IGNORE (#500)
kenji-miyake Nov 4, 2021
4d971da
port motion velocity smoother (#495)
rej55 Nov 8, 2021
3dd9c98
rename to README.md (#550)
takayuki5168 Nov 9, 2021
5c53481
update iv_msgs -> auto_msgs in planning readme (#576)
takayuki5168 Nov 10, 2021
0097de1
Back port .auto control packages (#571)
TakaHoribe Nov 11, 2021
0d2a9bd
[planning module]fix bug (#643)
tkimura4 Nov 15, 2021
453da3e
FIx vehicle status topic name/type (#658)
tkimura4 Nov 16, 2021
026ce5e
port closest velocity checker (#672)
TakaHoribe Nov 17, 2021
c4bfe32
port trajectory visualizer (#682)
TakaHoribe Nov 17, 2021
8a690d5
add header for debug trajectories (#681)
TakaHoribe Nov 17, 2021
49cc275
Sync .auto branch with the latest branch in internal repository (#691)
wep21 Nov 18, 2021
c4c370f
fix osqp link (#700)
k0suke-murakami Nov 19, 2021
30b4c11
Update twist topic name (#736)
wep21 Nov 26, 2021
1d4d555
rename readme.ja
tkimura4 Nov 30, 2021
cba15f5
add default parameter file
tkimura4 Nov 30, 2021
17b0e07
Merge branch 'tier4/proposal' into 1-add-motion-velocity-smoother
tkimura4 Dec 6, 2021
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
Prev Previous commit
Next Next commit
Add post resampling explanations (#2155)
* Update motion_velocity_smoother-design.ja.md

* Update motion_velocity_smoother-design.md
  • Loading branch information
purewater0901 authored and tkimura4 committed Nov 30, 2021
commit 09b5a2851649a6eeaf325aef0ae4620fb8c2f0db
Original file line number Diff line number Diff line change
Expand Up @@ -71,9 +71,11 @@
- 停止点より先の速度を 0 に設定
- 速度がパラメータで与えられる`max_velocity`以下となるように設定
- 自車位置より手前の点における速度を設定
- Trajectory の仕様に合わせてリサンプリング
- Trajectory の仕様に合わせてリサンプリング(`post resampling`)
- デバッグデータの出力

最適化の計算が終わったあと、次のノードに経路を渡す前に`post resampling`と呼ばれるリサンプリングを行う。ここで再度リサンプリングを行っている理由としては、最適化前で必要な経路間隔と後段のモジュールに渡す経路間隔が必ずしも一致していないからであり、その差を埋めるために再度サンプリングを行っている。そのため、`post resampling`では後段モジュールの経路仕様を確認してパラメータを決める必要がある。なお、最適化アルゴリズムの計算負荷が高く、最初のリサンプリングで経路間隔が後段モジュールの経路仕様より疎になっている場合、`post resampling`で経路を蜜にリサンプリングする。逆に最適化アルゴリズムの計算負荷が小さく、最初のリサンプリングで経路間隔が後段の経路仕様より蜜になっている場合は、`post resampling`で経路をその仕様に合わせて疎にリサンプリングする。

## Inputs / Outputs

### Input
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -77,9 +77,11 @@ It performs the post-process of the planned velocity.
- Set zero velocity ahead of the stopping point
- Set maximum velocity given in the config named `max_velocity`
- Set velocity behind the current pose
- Resample trajectory
- Resample trajectory (`post resampling`)
- Output debug data

After the optimization, a resampling called `post resampling` is performed before passing the optimized trajectory to the next node. Since the required path interval from optimization may be different from the one for the next module, `post resampling` helps to fill this gap. Therefore, in `post resampling`, it is necessary to check the path specification of the following module to determine the parameters. Note that if the computational load of the optimization algorithm is high and the path interval is sparser than the path specification of the following module in the first resampling, `post resampling` would resample the trajectory densely. On the other hand, if the computational load of the optimization algorithm is small and the path interval is denser than the path specification of the following module in the first resampling, the path is sparsely resampled according to the specification of the following module.

## Inputs / Outputs

### Input
Expand Down