Edge defining the cost function for satisfying the non-holonomic kinematics of a carlike mobile robot. More...
#include <edge_kinematics.h>

Public Member Functions | |
| void | computeError () |
| Actual cost function. | |
| EdgeKinematicsCarlike () | |
| Construct edge. | |
Edge defining the cost function for satisfying the non-holonomic kinematics of a carlike mobile robot.
The edge depends on two vertices
and minimizes a geometric interpretation of the non-holonomic constraint:
The definition is identically to the one of the differential drive robot. Additionally, this edge incorporates a minimum turning radius that is required by carlike robots. The turning radius is defined by
.
The weight can be set using setInformation(): Matrix element 1,1: (Choose a very high value: ~1000).
The second equation enforces a minimum turning radius. The weight can be set using setInformation(): Matrix element 2,2.
The dimension of the error / cost vector is 3: the first component represents the nonholonomic constraint cost, the second one backward-drive cost and the third one the minimum turning radius
Definition at line 182 of file edge_kinematics.h.
Construct edge.
Definition at line 189 of file edge_kinematics.h.
| void teb_local_planner::EdgeKinematicsCarlike::computeError | ( | ) | [inline] |
Actual cost function.
Definition at line 197 of file edge_kinematics.h.