diff --git a/Commands/Test/CheckDrive.cpp b/Commands/Test/CheckDrive.cpp deleted file mode 100644 index 8a114b7..0000000 --- a/Commands/Test/CheckDrive.cpp +++ /dev/null @@ -1,38 +0,0 @@ -#include "CheckDrive.h" -#include -#include "Commands/CommandGroup.h" -#include "../../DentRobot.h" -#include "../../RobotMap.h" -CheckDrive::CheckDrive(int motorID): CommandGroup("CheckDrive"){ - Requires(DentRobot::drivetrain); - motor = motorID; -} -void CheckDrive::Initialize(){ - SetTimeout(1.0); -} -void CheckDrive::Execute(){ - switch(motor){ - case DRIVE_FRONT_LEFT_CAN: - DentRobot::drivetrain->TestMotor(DentRobot::drivetrain->FRONTLEFT, 1); - break; - case DRIVE_FRONT_RIGHT_CAN: - DentRobot::drivetrain->TestMotor(DentRobot::drivetrain->FRONTRIGHT, 1); - break; - case DRIVE_BACK_LEFT_CAN: - DentRobot::drivetrain->TestMotor(DentRobot::drivetrain->BACKLEFT, 1); - break; - case DRIVE_BACK_RIGHT_CAN: - DentRobot::drivetrain->TestMotor(DentRobot::drivetrain->BACKRIGHT, 1); - break; - default: - break; - } -} -bool CheckDrive::IsFinished(){ - return false; -} -void CheckDrive::End(){ -} -void CheckDrive::Interrupted(){ - End(); -} diff --git a/Commands/Test/CheckDrive.h b/Commands/Test/CheckDrive.h deleted file mode 100644 index f398fb6..0000000 --- a/Commands/Test/CheckDrive.h +++ /dev/null @@ -1,45 +0,0 @@ -#ifndef CHECKDRIVE_H -#define CHECKDRIVE_H - -#include "Commands/Command.h" -#include "../../DentRobot.h" -#include "../../DentRobot.h" -#include "WPILib.h" - -/** - * @brief TODO - */ -class CheckDrive: public CommandGroup{ - private: - int motor; //CancelWhenPressed(raise); right12->CancelWhenPressed(lower); - // Basic motor test - CheckRobot* checkRobot=new CheckRobot(); - JoystickButton *left7=new JoystickButton(leftStick, 7); - left7->WhenPressed(checkRobot); } Joystick* OI::GetRightStick(){ return rightStick;