diff --git a/RELENTLESS/include/autons.hpp b/RELENTLESS/include/autons.hpp index 223dd0d..abd163b 100644 --- a/RELENTLESS/include/autons.hpp +++ b/RELENTLESS/include/autons.hpp @@ -5,6 +5,7 @@ void near_side(); void far_side(); void skills(); +void test_seq(); void odom_test(); void default_constants(); diff --git a/RELENTLESS/src/autons.cpp b/RELENTLESS/src/autons.cpp index c35868f..9609b51 100644 --- a/RELENTLESS/src/autons.cpp +++ b/RELENTLESS/src/autons.cpp @@ -60,9 +60,9 @@ void far_side() { turnSync(-160); driveSync(125, true); pros::delay(1000); - toggleRemovalMech(true); + //toggleRemovalMech(true); driveSync(-35, true); - toggleRemovalMech(false); + //toggleRemovalMech(false); turnSync(55); driveSync(70, true); @@ -73,6 +73,12 @@ void skills() { } +void test_seq() { + driveSync(10); + turnSync(90); + turnSync(90); +} + void odom_test() { chassis_odom.moveTo(10, 10, 1000); chassis_odom.turnTo(15, 15, 1000);