mirror of
https://github.com/team2059/Dent
synced 2024-12-18 20:52:29 -05:00
54 lines
1.5 KiB
C++
54 lines
1.5 KiB
C++
#include "DentRobot.h"
|
|
#include "OI.h"
|
|
#include "Commands/Autonomous/Autonomous.h"
|
|
OI* DentRobot::oi=NULL;
|
|
Collector* DentRobot::collector=NULL;
|
|
Drivetrain* DentRobot::drivetrain=NULL;
|
|
Elevator* DentRobot::elevator=NULL;
|
|
BinElevator* DentRobot::binElevator=NULL;
|
|
CommandGroup* DentRobot::aut=NULL;
|
|
DentRobot::DentRobot(){
|
|
oi=new OI();
|
|
collector=new Collector();
|
|
drivetrain=new Drivetrain();
|
|
elevator=new Elevator();
|
|
binElevator=new BinElevator();
|
|
aut=new Autonomous(0);
|
|
CameraServer::GetInstance()->SetQuality(25);
|
|
CameraServer::GetInstance()->StartAutomaticCapture("cam0");
|
|
//SmartDashboard::PutNumber("Auto Wait Time", 1.0);
|
|
//SmartDashboard::PutNumber("Auto Sequence", 0);
|
|
printf("Initialized");
|
|
}
|
|
void DentRobot::RobotInit(){
|
|
//SmartDashboard::PutNumber("CodeVersion",0.001);
|
|
}
|
|
void DentRobot::DisabledPeriodic(){
|
|
Scheduler::GetInstance()->Run();
|
|
}
|
|
void DentRobot::AutonomousInit(){
|
|
if(aut != NULL){
|
|
aut->Start();
|
|
}
|
|
}
|
|
void DentRobot::AutonomousPeriodic(){
|
|
Scheduler::GetInstance()->Run();
|
|
}
|
|
void DentRobot::TeleopInit(){
|
|
if (aut != NULL){
|
|
aut->Cancel();
|
|
}
|
|
}
|
|
void DentRobot::TeleopPeriodic(){
|
|
Scheduler::GetInstance()->Run();
|
|
// TODO: Calibrate 1.0 to the height we want the elevator to automatically raise
|
|
if(elevator->GetUseEncoder()&&elevator->GetHeight()<=-1.0){
|
|
// Raise the elevator if it dips below elevatorTop
|
|
oi->raise->Start();
|
|
}
|
|
}
|
|
void DentRobot::TestPeriodic(){
|
|
}
|
|
START_ROBOT_CLASS(DentRobot);
|
|
// vim: ts=2:sw=2:et
|