Our team is using pathplanner and we need to obtain the initial pose of the following auto shown below. Since we are using swerve for autonomous, when the robot starts up, field relative will be all messed up starting facing the wall rather than facing the field. How do you obtain the initial pose of the auto shown.
Our code for grabbing the path chosen is shown below.
public Command getAutonomousCommand() {
return autoChooser.getSelected();
}
How would we get the initial pose using the code shown above or through another mechanism within the robot code?
