#include <math.h>
#include "trgen.h"
#include "balet.h"
Functions | |
double | balet (const Pos &rp, const Pos &mp, const struct balet_params &k, Pos &speed) |
Controller for reference trajectory tracking. |
double balet | ( | const Pos & | rp, | |
const Pos & | mp, | |||
const struct balet_params & | k, | |||
Pos & | speed | |||
) |
Controller for reference trajectory tracking.
rp | Requested position (and speeds) | |
mp | Measured position (without speed) | |
k | Controller constants | |
speed | Output of the controller (forward and angular speed) |