An implementation of hybrid curvature (HC) steer with arbitrary curvature at the start and goal configuration. More...
#include <hc_reeds_shepp_state_space.hpp>
Public Member Functions | |
std::vector< Control > | get_controls (const State &state1, const State &state2) const |
Returns controls of the shortest path from state1 to state2. More... | |
double | get_distance (const State &state1, const State &state2) const |
Returns shortest path length from state1 to state2. More... | |
HC_Reeds_Shepp_State_Space (double kappa, double sigma, double discretization=0.1) | |
Constructor. More... | |
std::vector< std::pair< State, Control > > | predict_state (const State &state) const |
Predicts a state forwards and backwards to zero and max. curvature. More... | |
![]() | |
std::vector< State > | get_path (const State &state1, const State &state2) const |
Returns path from state1 to state2. More... | |
std::vector< State_With_Covariance > | get_path_with_covariance (const State_With_Covariance &state1, const State &state2) const |
Returns path including covariances from state1 to state2. More... | |
HC_CC_State_Space (double kappa, double sigma, double discretization) | |
Constructor. More... | |
std::vector< State > | integrate (const State &state, const std::vector< Control > &controls) const |
Returns integrated states given a start state and controls. More... | |
State | integrate_ODE (const State &state, const Control &control, double integration_step) const |
Returns integrated state given a start state, a control, and an integration step. More... | |
std::vector< State_With_Covariance > | integrate_with_covariance (const State_With_Covariance &state, const std::vector< Control > &controls) const |
Returns integrated states including covariance given a start state and controls. More... | |
State | interpolate (const State &state, const std::vector< Control > &controls, double t) const |
Returns interpolated state at distance t in [0,1] (percentage of total path length) More... | |
void | set_filter_parameters (const Motion_Noise &motion_noise, const Measurement_Noise &measurement_noise, const Controller &controller) |
Sets the parameters required by the filter. More... | |
Additional Inherited Members | |
![]() | |
double | discretization_ |
Discretization of path. More... | |
EKF | ekf_ |
Extended Kalman Filter for uncertainty propagation. More... | |
HC_CC_Circle_Param | hc_cc_circle_param_ |
Parameters of a hc-/cc-circle. More... | |
double | kappa_ |
Curvature, sharpness of clothoid. More... | |
double | sigma_ |
An implementation of hybrid curvature (HC) steer with arbitrary curvature at the start and goal configuration.
Definition at line 53 of file hc_reeds_shepp_state_space.hpp.
steering::HC_Reeds_Shepp_State_Space::HC_Reeds_Shepp_State_Space | ( | double | kappa, |
double | sigma, | ||
double | discretization = 0.1 |
||
) |
Constructor.
Definition at line 30 of file hc_reeds_shepp_state_space.cpp.
|
virtual |
Returns controls of the shortest path from state1 to state2.
Implements steering::HC_CC_State_Space.
Definition at line 144 of file hc_reeds_shepp_state_space.cpp.
double steering::HC_Reeds_Shepp_State_Space::get_distance | ( | const State & | state1, |
const State & | state2 | ||
) | const |
Returns shortest path length from state1 to state2.
Definition at line 92 of file hc_reeds_shepp_state_space.cpp.
vector< pair< State, Control > > steering::HC_Reeds_Shepp_State_Space::predict_state | ( | const State & | state | ) | const |
Predicts a state forwards and backwards to zero and max. curvature.
Definition at line 39 of file hc_reeds_shepp_state_space.cpp.
|
private |
Required state spaces.
Definition at line 85 of file hc_reeds_shepp_state_space.hpp.
|
private |
Definition at line 86 of file hc_reeds_shepp_state_space.hpp.
|
private |
Definition at line 87 of file hc_reeds_shepp_state_space.hpp.
|
private |
Definition at line 88 of file hc_reeds_shepp_state_space.hpp.