class GVFFollower : PathFollower
State-of-the-art path follower based on the GuidingVectorField.
constraints
- robot motion constraints
admissibleError
- admissible/satisfactory pose error at the end of each move
kN
- normal vector weight (see GuidingVectorField)
kOmega
- proportional heading gain
errorMapFunc
- error map function (see GuidingVectorField)
GVFFollower(constraints: SimpleMotionConstraints, admissibleError: Pose2d, kN: Double, kOmega: Double, errorMapFunc: (Double) -> Double = { it }, clock: NanoClock = NanoClock.system())
State-of-the-art path follower based on the GuidingVectorField. |
var lastError: Pose2d
Robot pose error computed in the last update call. |
val clock: NanoClock
clock |
|
lateinit var path: Path
Path being followed if isFollowing is true. |
fun followPath(path: Path): Unit
Follow the given path. |
|
fun internalUpdate(currentPose: Pose2d): DriveSignal |
fun isFollowing(): Boolean
Returns true if the current path has finished executing. |
|
fun update(currentPose: Pose2d): DriveSignal
Run a single iteration of the path follower. |