addSequential(
new DriveDistance(DISTANCE_FROM_BOILER_WALL / Math.sqrt(3) + 50.2168,
MOTOR_VALUE_FORWARD)); // drive straight into extended line of peg
- addSequential(new TurnForAngle(60, Direction.LEFT, MOTOR_VALUE_TURN));// position
- // robot
- // for
- // optimal
- // gear
- // placement
+ addSequential(new TurnForAngle(60, Direction.LEFT, 5));// position
+ // robot
+ // for
+ // optimal
+ // gear
+ // placement
addSequential(new DriveDistance(PEG_EXTENDED
- 2 * DISTANCE_FROM_BOILER_WALL / Math.sqrt(3) - LENGTH_OF_PEG,
MOTOR_VALUE_FORWARD));// put gear on peg
--- /dev/null
+package org.usfirst.frc.team3501.robot.commandgroups;
+
+public class AutonGearThenBaselinePegCloseToBoilerTest
+ extends TestCommandGroup {
+
+ public AutonGearThenBaselinePegCloseToBoilerTest() {
+ super();
+ }
+
+ @Override
+ protected void runCommandGroup() {
+ addSequential(new AutonGearThenBaselinePegCloseToBoiler());
+ }
+
+ @Override
+ protected void setup() {
+ // TODO Auto-generated method stub
+
+ }
+
+ @Override
+ protected void teardown() {
+ // TODO Auto-generated method stub
+
+ }
+
+ @Override
+ protected void verify() {
+ // TODO Auto-generated method stub
+
+ }
+
+}