Path Smoothing#
Purpose#
This package contains code to smooth a path or trajectory.
Features#
Elastic Band#
More details about the elastic band can be found here.
Parameter#
| Name | Type | Description | Default | Range |
|---|---|---|---|---|
| common. |
float | Delta arc length for output trajectory [m]. | 0.5 | N/A |
| common. |
float | Backward length for backward trajectory from base_link [m]. | 5.0 | N/A |
| elastic_ |
boolean | Enable warm start for elastic band optimization. | true | N/A |
| elastic_ |
boolean | Enable optimization validation. | false | N/A |
| elastic_ |
integer | Number of points for optimization. | 100 | N/A |
| elastic_ |
float | Delta arc length for optimization [m]. | 1.0 | N/A |
| elastic_ |
integer | Number of joint points (joint means connecting fixing and smoothing). | 3 | N/A |
| elastic_ |
float | Maximum optimizing range when applying fixing. | 0.0 | N/A |
| elastic_ |
float | Maximum optimizing range when applying jointing. | 0.1 | N/A |
| elastic_ |
float | Maximum optimizing range when applying smoothing. | 0.1 | N/A |
| elastic_ |
float | Weight for smoothing. | 1.0 | N/A |
| elastic_ |
float | Weight for lateral error. | 0.001 | N/A |
| elastic_ |
integer | Maximum iteration when solving QP. | 10000 | N/A |
| elastic_ |
float | Absolute epsilon when solving OSQP. | 1e-07 | N/A |
| elastic_ |
float | Relative epsilon when solving OSQP. | 1e-07 | N/A |
| elastic_ |
float | Maximum error for validation [m]. | 3.0 | N/A |
| ego_ |
float | Distance threshold for nearest ego search [m]. | 3.0 | N/A |
| ego_ |
float | Yaw threshold for nearest ego search [rad]. | 1.046 | N/A |
| replan. |
boolean | If true, only perform smoothing when the input changes significantly. | true | N/A |
| replan. |
float | Threshold of path shape change around ego [m]. | 2.0 | N/A |
| replan. |
float | Forward point to check lateral distance difference [m]. | 100.0 | N/A |
| replan. |
float | Threshold of path shape change around forward point [m]. | 0.2 | N/A |
| replan. |
float | Threshold of ego's moving distance for replan [m]. | 5.0 | N/A |
| replan. |
float | Threshold of goal's moving distance for replan [m]. | 15.0 | N/A |
| replan. |
float | Threshold of delta time for replan [second]. | 0.0 | N/A |