dent/Commands/Collector/RollVar.cpp

#include "RollVar.h"
RollVar::RollVar(double speedVal): Command("RollVar") {
  speed = speedVal;
}
void RollVar::Initialize() {
  printf("Initialized RollVar\n");
  SetTimeout(2.0);
  Requires(DentRobot::drivetrain);
}
void RollVar::Execute() {
  DentRobot::collector->MoveLeftRoller(1-(speed*(DentRobot::oi->GetLeftStick()->GetRawAxis(2)+1)/2));
  DentRobot::collector->MoveRightRoller(-(speed*(DentRobot::oi->GetLeftStick()->GetRawAxis(2)+1)/2));
  DentRobot::collector->MoveBottomRollers(speed*1.0);
}
bool RollVar::IsFinished() {
  return IsTimedOut();
}
void RollVar::End() {
  DentRobot::collector->MoveRollers(0.0);
}
void RollVar::Interrupted() {
  End();
}
// vim: ts=2:sw=2:et