#include <frenetSerretController.h>
Public Member Functions | |
FrenetSerretController (double k1, double k2, double kd, double gamma) | |
Velocity | getAction (Pose pose, Path *path, double dt, double v=1.0) |
Returns a velocity that will cause the vehicle to follow the path. |
FrenetSerretController::FrenetSerretController | ( | double | k1, | |
double | k2, | |||
double | kd, | |||
double | gamma | |||
) |
k1 | tuning param that rewards moving forward | |
k2 | tuning param that rewards following the path curvature | |
kd | tuning param that rewards staying on the path | |
gamma | tuning param |
Returns a velocity that will cause the vehicle to follow the path.
pose | current vehicle pose | |
path | path the controller should try to follow | |
dt | change in time since the last call to this function | |
v | desired forward velocity |
References navlib::PathPoint::c, navlib::Path::getLength(), navlib::Path::getPathPoint(), navlib::Path::isReverse(), navlib::Pose::localize(), and navlib::Pose::theta.