Drive To Pose Task
constructor(@NonNull timeout: Measure<Time>, @NonNull driveSubsystem: BunyipsSubsystem, targetPose: Pose2d, forwardController: SystemController, strafeController: SystemController, headingController: SystemController)
Run the Drive To Pose Task on a drive subsystem.
Parameters
timeout
The maximum time the task can run for.
drive Subsystem
The drive subsystem to run the task on.
target Pose
The target pose to drive to.
forward Controller
The system/PID controller for x.
strafe Controller
The system/PID controller for y.
heading Controller
The system/PID controller for heading.