dent/Commands/CollectTote.cpp

#include "CollectTote.h"
CollectTote::CollectTote() : Command("CollectTote"){
    Requires(DentRobot::collector);
}
void CollectTote::Initialize(){
}
void CollectTote::Execute(){
    //TODO check this value to move the motors in the right direction
    DentRobot::collector->MoveRollers(-1);
}
bool CollectTote::IsFinished(){
    return DentRobot::collector->BoxCollected();
}
void CollectTote::End(){
}
void CollectTote::Interrupted(){
  End();
}