add some of the constants for AlignToScore

[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / Constants.java

diff --git a/src/org/usfirst/frc/team3501/robot/Constants.java b/src/org/usfirst/frc/team3501/robot/Constants.java
index 8176e5df0cc3d123717a021a70a22a0dfbaff04b..fc2c712491b9fc3a3e27f5092ff2b901c07351ea 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/Constants.java
+++ b/src/org/usfirst/frc/team3501/robot/Constants.java
@@ -2,6 +2,8 @@ package org.usfirst.frc.team3501.robot;
 
 import edu.wpi.first.wpilibj.DoubleSolenoid;
 import edu.wpi.first.wpilibj.DoubleSolenoid.Value;
+import edu.wpi.first.wpilibj.I2C;
+import edu.wpi.first.wpilibj.I2C.Port;
 
 /**
  * The Constants stores constant values for all subsystems. This includes the
@@ -84,9 +86,12 @@ public class Constants {
 
     // Winch speeds
     public final static double WINCH_STOP_SPEED = 0.0;
-    public final static double WINCH_IN_SPEED = 0;
+    public final static double SCALE_SPEED = 0;
     public final static double SECONDS_TO_CLAMP = 2.0;
 
+    // Winch timeout
+    public final static int SECONDS_TO_SCALE = 0;
+
     public static boolean SCALING = false;
 
   }
@@ -109,6 +114,8 @@ public class Constants {
     public static final Value open = Value.kForward;
     public static final Value closed = Value.kReverse;
 
+    public static final Port LIDAR_I2C_PORT = I2C.Port.kMXP;
+
     public static enum State {
       RUNNING, STOPPED;
     }
@@ -137,6 +144,7 @@ public class Constants {
     public static final int HAND_CHANNEL = 1;
     public final static double FULL_RANGE = 270.0; // in degrees
     public final static double OFFSET = -135.0; // in degrees
+
     public final static double[] armPotValue = { 0.0, 45.0, 90.0 }; // 3
     // level
     public final static double ARM_LENGTH = 0; // TODO: find actual length