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.