Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
Original file line number Diff line number Diff line change
Expand Up @@ -80,6 +80,11 @@ public void initSensors(HardwareMap hardwareMap) {
*/
public void initFollower(HardwareMap hardwareMap, boolean loadPose) {
follower = org.firstinspires.ftc.teamcode.pedroPathing.Constants.createFollower(hardwareMap);
// try {
// follower.getPoseTracker().resetIMU();
// } catch (InterruptedException e) {
// throw new RuntimeException(e);
// }
if(loadPose) {
Pose startingPose = PoseStorage.loadPose();
follower.setStartingPose(startingPose);
Expand All @@ -101,13 +106,18 @@ public void initFollower(HardwareMap hardwareMap, boolean loadPose) {
*/
public void initFollower(HardwareMap hardwareMap, Pose startingPose) {
follower = org.firstinspires.ftc.teamcode.pedroPathing.Constants.createFollower(hardwareMap);
// try {
// follower.getPoseTracker().resetIMU();
// } catch (InterruptedException e) {
// throw new RuntimeException(e);
// }
follower.setStartingPose(startingPose);
}


public void initHardware(HardwareMap hardwareMap) {
if(follower != null)
initFollower(hardwareMap);
// if(follower != null)
// initFollower(hardwareMap);
initMotors(hardwareMap);
initServos(hardwareMap);
initSensors(hardwareMap);
Expand Down
Loading