From 0d13b05dda261589ca443611f18d5299be949ba0 Mon Sep 17 00:00:00 2001
From: Aarav Shah <91212@psdschools.org>
Date: Wed, 19 Feb 2020 19:16:26 -0700
Subject: [PATCH] Testing System Time, made Simpler Trajectory

---
 src/main/java/frc4388/robot/RobotContainer.java   | 4 ++--
 src/main/java/frc4388/robot/subsystems/Drive.java | 2 +-
 2 files changed, 3 insertions(+), 3 deletions(-)

diff --git a/src/main/java/frc4388/robot/RobotContainer.java b/src/main/java/frc4388/robot/RobotContainer.java
index 65199c5..608ec18 100644
--- a/src/main/java/frc4388/robot/RobotContainer.java
+++ b/src/main/java/frc4388/robot/RobotContainer.java
@@ -194,8 +194,8 @@ public class RobotContainer {
             new Pose2d(0, 0, new Rotation2d(0)),
             // Pass through these two interior waypoints, making an 's' curve path
             List.of(
-                new Translation2d(1, 1),
-                new Translation2d(2, -1)
+                new Translation2d(3, 0)
+                //new Translation2d(2, -1)
             ),
             // End 3 meters straight ahead of where we started, facing forward
             new Pose2d(3, 0, new Rotation2d(0)),
diff --git a/src/main/java/frc4388/robot/subsystems/Drive.java b/src/main/java/frc4388/robot/subsystems/Drive.java
index 32ea707..970aa6c 100644
--- a/src/main/java/frc4388/robot/subsystems/Drive.java
+++ b/src/main/java/frc4388/robot/subsystems/Drive.java
@@ -273,7 +273,7 @@ public class Drive extends SubsystemBase {
   @Override
   public void periodic() {
     m_currentTimeSec = (int)(System.currentTimeMillis() / 1000);
-    SmartDashboard.putNumber("Time Seconds", m_currentTimeSec);
+    SmartDashboard.putNumber("Time Seconds", System.currentTimeMillis());
 
     if (m_currentTimeSec % 10 == 0) {
       coolFalcon(true);