update
Run a single iteration of the trajectory follower.
Parameters
currentPose
current field frame pose
currentRobotVel
current robot frame velocity
Run a single iteration of the trajectory follower.
current field frame pose
current robot frame velocity