2014-06-24 16:54:17 -07:00
|
|
|
#include "DriveAndShootAutonomous.h"
|
|
|
|
|
|
|
|
|
|
#include "Robot.h"
|
|
|
|
|
#include "Commands/WaitForPressure.h"
|
|
|
|
|
#include "Commands/CloseClaw.h"
|
|
|
|
|
#include "Commands/SetPivotSetpoint.h"
|
|
|
|
|
#include "Commands/DriveForward.h"
|
|
|
|
|
#include "Commands/Shoot.h"
|
2014-08-12 14:52:22 -04:00
|
|
|
#include "Commands/CheckForHotGoal.h"
|
2014-06-24 16:54:17 -07:00
|
|
|
|
|
|
|
|
DriveAndShootAutonomous::DriveAndShootAutonomous() {
|
2014-06-26 19:35:25 -07:00
|
|
|
AddSequential(new CloseClaw());
|
2014-06-24 16:54:17 -07:00
|
|
|
AddSequential(new WaitForPressure(), 2);
|
|
|
|
|
#ifdef REAL
|
|
|
|
|
// NOTE: Simulation doesn't currently have the concept of hot.
|
|
|
|
|
AddSequential(new CheckForHotGoal(2));
|
|
|
|
|
#endif
|
|
|
|
|
AddSequential(new SetPivotSetpoint(45));
|
2014-06-26 19:35:25 -07:00
|
|
|
AddSequential(new DriveForward(8, 0.3));
|
2014-06-24 16:54:17 -07:00
|
|
|
AddSequential(new Shoot());
|
|
|
|
|
}
|