From 71418ac28915a16368f111262c13a765a61496a4 Mon Sep 17 00:00:00 2001
From: siyoyoCode <siyona101215@gmail.com>
Date: Thu, 1 Feb 2024 17:24:11 -0800
Subject: [PATCH] commands

---
 .../pivot/ShooterPivotVerticalCommand.java    | 28 +++++++++++++++++--
 1 file changed, 25 insertions(+), 3 deletions(-)

diff --git a/src/main/java/frc/robot/commands/shooter/pivot/ShooterPivotVerticalCommand.java b/src/main/java/frc/robot/commands/shooter/pivot/ShooterPivotVerticalCommand.java
index 1e419cda..29e711c4 100644
--- a/src/main/java/frc/robot/commands/shooter/pivot/ShooterPivotVerticalCommand.java
+++ b/src/main/java/frc/robot/commands/shooter/pivot/ShooterPivotVerticalCommand.java
@@ -1,5 +1,27 @@
 package frc.robot.commands.shooter.pivot;
+import edu.wpi.first.wpilibj2.command.Command;
+import frc.robot.subsystems.shooter.ShooterPivotSubsystem;
 
-public class ShooterPivotVerticalCommand {
-    
-}
+public class ShooterPivotVerticalCommand extends Command{
+    ShooterPivotSubsystem pivotSubsystem;
+
+    public ShooterPivotVerticalCommand(ShooterPivotSubsystem pivotSubsystem){
+        this.pivotSubsystem = pivotSubsystem;
+        addRequirements(pivotSubsystem);
+    }
+
+    @Override
+    public void initialize() {
+        pivotSubsystem.setAutoAimBoolean(false);
+        pivotSubsystem.setAngle(90.0);
+    }
+
+    @Override
+    public boolean isFinished() {
+        if(Math.abs(pivotSubsystem.getPosition()) - 90 < pivotSubsystem.ERRORTOLERANCE){
+            return true;
+        }
+
+        return false;
+    }
+}
\ No newline at end of file