package com.frc4739.commands;

import com.frc4739.robot.Robot;
import edu.wpi.first.wpilibj.command.Command;

/**
 * Not actually a dance (that would be dangerous), runs the motors forwards and backwards a very small amount for 0.5s.
 * @author FRC 4739 Thunderbolts Robotics
 */
public class RobotStartupDance extends Command {
	private int lastInit = 0;
	private int lastEnd = 0;

	public RobotStartupDance() {
		requires(Robot.driveBase);
		requires(Robot.shooter);
	}
	protected void initialize() {
		lastInit++;
		//TODO
		lastEnd = lastInit;
	}
	protected void execute() {}
	protected boolean isFinished() {
		return lastEnd == lastInit;
	}
	protected void end() {}
	protected void interrupted() {
		Robot.driveBase.stop();
		Robot.shooter.stopShooter();
	}
}
