Create a constant for lidar object to use
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / Constants.java
1 package org.usfirst.frc.team3501.robot;
2
3 import edu.wpi.first.wpilibj.DoubleSolenoid;
4 import edu.wpi.first.wpilibj.DoubleSolenoid.Value;
5 import edu.wpi.first.wpilibj.I2C;
6 import edu.wpi.first.wpilibj.I2C.Port;
7
8 /**
9 * The Constants stores constant values for all subsystems. This includes the
10 * port values for motors and sensors, as well as important operational
11 * constants for subsystems such as max and min values.
12 */
13
14 public class Constants {
15 public static class OI {
16 // Computer Ports
17 public final static int LEFT_STICK_PORT = 0;
18 public final static int RIGHT_STICK_PORT = 1;
19
20 public final static int PASS_PORTCULLIS_PORT = 0;
21 public final static int PASS_CHEVAL_DE_FRISE_PORT = 0;
22 public final static int PASS_DRAWBRIDGE_PORT = 0;
23 public final static int PASS_SALLYPORT_PORT = 0;
24
25 public final static int ARCADE_INTAKEARM_LEVEL_ONE_PORT = 0;
26 public final static int ARCADE_INTAKEARM_LEVEL_TWO_PORT = 0;
27 public final static int ARCADE_INTAKEARM_LEVEL_THREE_PORT = 0;
28 public final static int ARCADE_INTAKEARM_LEVEL_FOUR_PORT = 0;
29
30 public final static int LEFT_JOYSTICK_TRIGGER_PORT = 0;
31 public final static int SPIN1_PORT = 4;
32 public final static int SPIN2_PORT = 5;
33 public final static int LEFT_JOYSTICK_TOP_CENTER_PORT = 3;
34 public final static int LEFT_JOYSTICK_TOP_LOW_PORT = 2;
35
36 public final static int RIGHT_JOYSTICK_TRIGGER_PORT = 0;
37 public final static int RIGHT_JOYSTICK_THUMB_PORT = 2;
38
39 public final static int TOGGLE_SCALING_PORT = 0;
40
41 }
42
43 public static class DriveTrain {
44 // Drivetrain Motor Related Ports
45 public static final int FRONT_LEFT = 1;
46 public static final int FRONT_RIGHT = 4;
47 public static final int REAR_LEFT = 2;
48 public static final int REAR_RIGHT = 3;
49
50 // Encoder related ports
51 public final static int ENCODER_LEFT_A = 0;
52 public final static int ENCODER_LEFT_B = 1;
53 public final static int ENCODER_RIGHT_A = 9;
54 public final static int ENCODER_RIGHT_B = 8;
55
56 public final static int FORWARD_CHANNEL = 0;
57 public final static int REVERSE_CHANNEL = 0;
58
59 private final static double WHEEL_DIAMETER = 6.0; // in inches
60 private final static double PULSES_PER_ROTATION = 256; // in pulses
61 private final static double OUTPUT_SPROCKET_DIAMETER = 2.0; // in inches
62 private final static double WHEEL_SPROCKET_DIAMETER = 3.5; // in inches
63 public static final double INCHES_PER_PULSE = ((3.66 / 5.14) * 6 * Math.PI)
64 / 256;
65
66 public static final int MANUAL_MODE = 1, ENCODER_MODE = 2, GYRO_MODE = 3;
67 public static final int LEFT_FORWARD = 0, LEFT_REVERSE = 1,
68 RIGHT_FORWARD = 2, RIGHT_REVERSE = 3;
69 public static double time = 0;
70
71 // Gearing constants
72 public static final Value HIGH_GEAR = DoubleSolenoid.Value.kForward;
73 public static final Value LOW_GEAR = DoubleSolenoid.Value.kReverse;
74
75 public static boolean inverted = false;
76
77 }
78
79 public static class Scaler {
80 // Piston channels
81 public final static int FORWARD_CHANNEL = 0;
82 public final static int REVERSE_CHANNEL = 1;
83
84 // Winch port
85 public final static int WINCH_MOTOR = 0;
86
87 // Winch speeds
88 public final static double WINCH_STOP_SPEED = 0.0;
89 public final static double WINCH_IN_SPEED = 0;
90 public final static double SECONDS_TO_CLAMP = 2.0;
91
92 public static boolean SCALING = false;
93
94 }
95
96 public static class Shooter {
97 public static final int PORT = 0;
98 public static final int PUNCH_FORWARD = 0;
99 public static final int PUNCH_REVERSE = 1;
100 public static final int ANGLE_ADJUSTER_PORT = 0;
101
102 public static final DoubleSolenoid.Value punch = DoubleSolenoid.Value.kForward;
103 public static final DoubleSolenoid.Value retract = DoubleSolenoid.Value.kReverse;
104
105 // Encoder port
106 public static final int ENCODER_PORT_A = 0;
107 public static final int ENCODER_PORT_B = 0;
108 public static final int HOOD_FORWARD = 2;
109 public static final int HOOD_REVERSE = 3;
110
111 public static final Value open = Value.kForward;
112 public static final Value closed = Value.kReverse;
113
114 public static final Port LIDAR_I2C_PORT = I2C.Port.kMXP;
115
116 public static enum State {
117 RUNNING, STOPPED;
118 }
119 }
120
121 public static class DeadReckoning {
122 public static final double DEFAULT_SPEED = 0.5;
123 }
124
125 public static class IntakeArm {
126 public static final int ROLLER_PORT = 0;
127 public static final int ARM_PORT = 1;
128 public static final int POT_CHANNEL = 0;
129 public static final double INTAKE_SPEED = 0.5;
130 public static final double OUTPUT_SPEED = -0.5;
131 public final static double FULL_RANGE = 270.0; // in degrees
132 public final static double OFFSET = -135.0; // in degrees
133 public static final double ZERO_ANGLE = 0;
134 }
135
136 public static class DefenseArm {
137 // Potentiometer related ports
138 public static final int ARM_CHANNEL = 0;
139 public static final int ARM_PORT = 0;
140 public static final int HAND_PORT = 1;
141 public static final int HAND_CHANNEL = 1;
142 public final static double FULL_RANGE = 270.0; // in degrees
143 public final static double OFFSET = -135.0; // in degrees
144 public final static double[] armPotValue = { 0.0, 45.0, 90.0 }; // 3
145 // level
146 public final static double ARM_LENGTH = 0; // TODO: find actual length
147 public final static double HAND_LENGTH = 0; // TODO: find actual length
148 public final static double ARM_MOUNTED_HEIGHT = 0; // TODO: find actual
149 // height
150 }
151
152 public enum Direction {
153 UP, DOWN, RIGHT, LEFT, FORWARD, BACKWARD;
154 }
155
156 public enum Defense {
157 PORTCULLIS, SALLY_PORT, ROUGH_TERRAIN, LOW_BAR, CHEVAL_DE_FRISE, DRAWBRIDGE, MOAT, ROCK_WALL, RAMPART;
158 }
159 }