Simple GVFController
class SimpleGVFController( val path: Path, val drive: KMecanumOdoDrive, kN: Double, kOmega: Double, kF: Double, kS: Double, epsilon: Double, thetaEpsilon: Double, errorMap: (Double) -> Double = { it }) : GVFController
Content copied to clipboard
Guided Vector Field follower
Parameters
path
path
k N
normal path attraction
k Omega
heading weight
k F
end param weight
k S
raw scalar on translational power
epsilon
allowed absolute and projected error
error Map
error map to transform normal displacement error