From 6a44632d2a7743d6081fd4a86b121a23f4634db3 Mon Sep 17 00:00:00 2001
From: 66945 <66945@psdschools.org>
Date: Sat, 22 Jan 2022 14:17:15 -0700
Subject: [PATCH] Added printlines

---
 .../java/frc4388/robot/subsystems/Climber.java  | 17 +++++++++++++++--
 1 file changed, 15 insertions(+), 2 deletions(-)

diff --git a/src/main/java/frc4388/robot/subsystems/Climber.java b/src/main/java/frc4388/robot/subsystems/Climber.java
index 419e8d2..3e9eaba 100644
--- a/src/main/java/frc4388/robot/subsystems/Climber.java
+++ b/src/main/java/frc4388/robot/subsystems/Climber.java
@@ -167,9 +167,22 @@ public class Climber extends SubsystemBase {
 
     double tiltAngle = m_groundRelative ? getRobotTilt() : 0.d;
 
-    System.out.println(getJointAngles(0, 0, 0));
+    double[] testAngles = getJointAngles(0, 0, 0);
+    System.out.println("origin: " + testAngles[0] + ", " + testAngles[1]);
+    
+    double[] testAngles2 = getJointAngles(5000, 5000, 0);
+    System.out.println("extended: " + testAngles2[0] + ", " + testAngles2[1]);
+    
+    double[] testAngles3 = getJointAngles(0, 75, 0);
+    System.out.println("just y: " + testAngles3[0] + ", " + testAngles3[1]);
+    
+    double[] testAngles4 = getJointAngles(75, 0, 0);
+    System.out.println("just x: " + testAngles4[0] + ", " + testAngles4[1]);
+    
+    double[] testAngles5 = getJointAngles(-75, 0, 0);
+    System.out.println("just x: " + testAngles5[0] + ", " + testAngles5[1]);
 
     double[] jointAngles = getJointAngles(m_position[0], m_position[1], tiltAngle);
-    setJointAngles(jointAngles);
+    //setJointAngles(jointAngles);
   }
 }