package org.usfirst.frc.team3501.robot;
-import org.usfirst.frc.team3501.robot.Constants.DriveTrain;
+import org.usfirst.frc.team3501.robot.commands.driving.SetLowGear;
+import org.usfirst.frc.team3501.robot.commands.intakearm.MoveIntakeArm;
+import org.usfirst.frc.team3501.robot.commands.shooter.ResetCatapult;
+import org.usfirst.frc.team3501.robot.subsystems.DriveTrain;
+import org.usfirst.frc.team3501.robot.subsystems.IntakeArm;
+import org.usfirst.frc.team3501.robot.subsystems.Shooter;
+
import edu.wpi.first.wpilibj.IterativeRobot;
import edu.wpi.first.wpilibj.command.Scheduler;
public class Robot extends IterativeRobot {
public static OI oi;
public static DriveTrain driveTrain;
+ public static Shooter shooter;
+ public static IntakeArm intakeArm;
@Override
public void robotInit() {
driveTrain = new DriveTrain();
oi = new OI();
+
+ shooter = new Shooter();
+ intakeArm = new IntakeArm();
}
@Override
public void autonomousInit() {
+ Scheduler.getInstance().run();
}
@Override
public void autonomousPeriodic() {
Scheduler.getInstance().run();
-
}
@Override
public void teleopInit() {
+ Scheduler.getInstance().add(new SetLowGear()); // Start each match in low
+ // gear
+ Scheduler.getInstance().add(new ResetCatapult()); // Reset catapult at start
+ // of each match.
+
+ Scheduler.getInstance().add(new MoveIntakeArm(Constants.IntakeArm.EXTEND));
+ // Start testing with intake arm extended TODO remove this
}
@Override
public void teleopPeriodic() {
Scheduler.getInstance().run();
-
}
+
}