void Autonomous(void)
{
SmartDashboard *Dash = SmartDashboard::GetInstance();
AutonomousContol->Parse("Auto_Test1.txt");
Dash->PutInt("Parsed",1);
AutonomousContol->Execute();
Dash->PutInt("InAuto", 1);
GetWatchdog().SetEnabled(false);
}
void DriveTrainClass::SendData()
{
SmartDashboard *Dash = SmartDashboard::GetInstance();
Dash->PutInt("Left Drive Encocder",LeftDriveEnc->Get());
#if PRACTICE_BOT
Dash->PutInt("Right Drive Encocder",(int)(2.5*RightDriveEnc->Get()));
#else
Dash->PutInt("Right Drive Encocder",(int)(RightDriveEnc->Get()));
#endif
Dash->PutDouble("Left Drive Command",(double)LeftDrive_a->Get());
Dash->PutDouble("Right Drive Command",(double)RightDrive_a->Get());
// Dash->PutString("Gear",gear);
}
RobotDemo(void)
{
rightStick = new Joystick(2); // create the joysticks
leftStick = new Joystick(1);
turretStick = new Joystick(3);
ds = DriverStation::GetInstance();
SmartDashboard *Dash = SmartDashboard::GetInstance();
AutonomousContol = new AutonomousControllerClass(ds);
compressor = new Compressor(14,1); //Pressure Switch, Compressor Relay
compressor->Start();
Dash->PutInt("Initialized", 1);
}
void UpdateDash()
{
SmartDashboard *Dash = SmartDashboard::GetInstance();
Dash->PutInt("dashworks",207);
AutonomousContol->SendData();
}