From 9861eda2df9342bd0564b6fb32a1869a8c325c50 Mon Sep 17 00:00:00 2001 From: Alex Date: Fri, 10 Dec 2021 19:02:52 -0700 Subject: [PATCH] Working, may add on later --- src/main.cpp | 17 ++++++++++++++--- 1 file changed, 14 insertions(+), 3 deletions(-) diff --git a/src/main.cpp b/src/main.cpp index b820f52e..80ba0caf 100644 --- a/src/main.cpp +++ b/src/main.cpp @@ -142,7 +142,7 @@ int rightAwpRight() { while (!purePursuit.isDone(0.5)) { pros::Task::delay(50); } - + // Collect front goal frontGrabberButton.setButtonStatus(ButtonStatus::POSITIVE); pros::Task::delay(200); @@ -156,6 +156,17 @@ int rightAwpRight() { while (!purePursuit.isDone(0.5)) { pros::Task::delay(50); } + + return 0; +} + +int leftAwpLeft() { + // Collect front goal + frontGrabberButton.setButtonStatus(ButtonStatus::POSITIVE); + pros::Task::delay(1000); + frontGrabberButton.setButtonStatus(ButtonStatus::NEUTRAL); + + return 0; } /** @@ -180,7 +191,7 @@ int testAuton() { int postAuton() { purePursuit.setFollowing(false); purePursuit.setEnabled(false); - frontGrabberButton.setAutonomous(false); + frontGrabberButton.setAutonomous(false); backGrabberButton.setAutonomous(false); leftLiftButton.setAutonomous(false); rightLiftButton.setAutonomous(false); @@ -454,7 +465,7 @@ void autonomous() { // autonRoutines.hpp and the implementation is autonRoutines.cp // autonomousSelector.run(); preAutonRun(); - rightStealRight(); + leftAwpLeft(); postAuton(); }