Edge defining the cost function for satisfying the non-holonomic kinematics of a differential drive mobile robot. More...
#include <edge_kinematics.h>
Public Member Functions | |
void | computeError () |
Actual cost function. | |
EdgeKinematicsDiffDrive () | |
Construct edge. |
Edge defining the cost function for satisfying the non-holonomic kinematics of a differential drive mobile robot.
The edge depends on two vertices and minimizes a geometric interpretation of the non-holonomic constraint:
The weight can be set using setInformation(): Matrix element 1,1: (Choose a very high value: ~1000).
A second equation is implemented to penalize backward motions (second element of the error /cost vector).
The weight can be set using setInformation(): Matrix element 2,2: (A value ~1 allows backward driving, but penalizes it slighly).
The dimension of the error / cost vector is 2: the first component represents the nonholonomic constraint cost, the second one backward-drive cost.
Definition at line 73 of file edge_kinematics.h.
Construct edge.
Definition at line 80 of file edge_kinematics.h.
void teb_local_planner::EdgeKinematicsDiffDrive::computeError | ( | ) | [inline] |
Actual cost function.
Definition at line 88 of file edge_kinematics.h.