From e2262c927c40b62d098b0e5a866483bd3b5cda3a Mon Sep 17 00:00:00 2001
From: Heggiehog <nizcat5@gmail.com>
Date: Fri, 20 Sep 2024 11:48:37 -0700
Subject: [PATCH] Added manual pivot commands and placeholer trap

---
 src/main/java/frc/robot/RobotContainer.java | 21 +++++++++++++++++++++
 1 file changed, 21 insertions(+)

diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java
index ef2c097..87cdeca 100644
--- a/src/main/java/frc/robot/RobotContainer.java
+++ b/src/main/java/frc/robot/RobotContainer.java
@@ -443,6 +443,27 @@ private void configureButtonBindings() {
                 .alongWith(
                     new AmpPreparationCommand(
                         pivotSubsystem, elevatorSubsystem, shooterSubsystem, intakeSubsystem)));
+    
+    //PIVOT SETPOINTS
+    anthony
+        .povUp().onTrue(
+            new PivotAngleCommand(pivotSubsystem, 30));
+
+    anthony
+        .povLeft().onTrue(
+            new PivotAngleCommand(pivotSubsystem, 60));
+
+    anthony
+        .povRight().onTrue(
+            new PivotAngleCommand(pivotSubsystem, 75));
+
+    anthony
+        .povDown().onTrue(
+            new PivotAngleCommand(pivotSubsystem, 55));
+    
+    //TRAP CLIMB STUFF
+    // jacob.
+    //     povCenter().onTrue();
 
     DoubleSupplier rotation =
         exponential(