#include "WPILib.h"
#include "Commands/Command.h"
#include "CommandBase.h"
#include "Logger.h"
class CommandBasedRobot : public IterativeRobot {
private:
// Command *autonomousCommand;
Logger *logger;
virtual void RobotInit() {
Logger::GetInstance();
CommandBase::init();
// autonomousCommand = new DriveWithJoystick();
}
virtual void AutonomousInit() {
// autonomousCommand->Start();
}
virtual void AutonomousPeriodic() {
// Scheduler::GetInstance()->Run();
}
virtual void TeleopInit() {
// This makes sure that the autonomous stops running when
// teleop starts running. If you want the autonomous to
// continue until interrupted by another command, remove
// this line or comment it out.
// autonomousCommand->Cancel();
}
virtual void TeleopPeriodic() {
logger->Log(Logger::kINFO, "In TeleopPeriodic()");
Scheduler::GetInstance()->Run();
logger->Log(Logger::kINFO, "Starting Sweeper");
CommandBase::sweeper->run();
logger->Log(Logger::kINFO, "Starting Conveyor");
CommandBase::conveyor->run();
CommandBase::drive->driveWithJoystick(CommandBase:
i->getLeftJoystick());
}
};
START_ROBOT_CLASS(CommandBasedRobot);