#include “robot-config.h”
vex::competition Competition;
/---------------------------------------------------------------------------/
/* /
/ Description: Competition template for VCS VEX V5 /
/ /
/---------------------------------------------------------------------------*/
/---------------------------------------------------------------------------/
/* Pre-Autonomous Functions /
/ /
/ You may want to perform some actions before the competition starts. /
/ Do them in the following function. You must return from this function /
/ or the autonomous and usercontrol tasks will not be started. This /
/ function is only called once after the cortex has been powered on and /
/ not every time that the robot is disabled. /
/---------------------------------------------------------------------------*/
void pre_auton( void ) {
}
/---------------------------------------------------------------------------/
/* /
/ Autonomous Task /
/ /
/ This task is used to control your robot during the autonomous phase of /
/ a VEX Competition. /
/ /
/ You must modify the code to add your own robot specific commands here. /
/---------------------------------------------------------------------------*/
void autonomous( void ) {
Backrightmotor.spin(vex::directionType::rev, 200, vex::velocityUnits::pct);
Frontrightmotor.spin(vex::directionType::fwd, 200, vex::velocityUnits::pct);
Backrightmotor.spin(vex::directionType::rev, 200, vex::velocityUnits::pct);
Backleftmotor.spin(vex::directionType::rev, 200, vex::velocityUnits::pct);
Frontleftmotor.spin(vex::directionType::rev, 200, vex::velocityUnits::pct);
Frontrightmotor.spin(vex::directionType::rev, 200, vex::velocityUnits::pct);
Arm1.spin (vex::directionType::fwd, 200, vex::velocityUnits::pct);
}
/----------------------------------------------------------------------------/
/* /
/ User Control Task /
/ /
/ This task is used to control your robot during the user control phase of /
/ a VEX Competition. /
/ /
/ You must modify the code to add your own robot specific commands here. /
/----------------------------------------------------------------------------*/
void usercontrol( void ) {
while(1)
{
Backleftmotor.spin(vex::directionType::fwd, Controller1.Axis3.value(), vex::velocityUnits::pct); //(Axis3+Axis4)/2
Backrightmotor.spin(vex::directionType::fwd, Controller1.Axis2.value(), vex::velocityUnits::pct);//(Axis3+Axis4)/2
Frontleftmotor.spin(vex::directionType::fwd, Controller1.Axis3.value(), vex::velocityUnits::pct); //(Axis2+Axis1)/2
Frontrightmotor.spin(vex::directionType::fwd, Controller1.Axis2.value(), vex::velocityUnits::pct); //(Axis1+Axis2)/2
if (Controller1.ButtonDown.pressing())
{
Arm1.spin(vex::directionType::fwd,200, vex::velocityUnits::pct);
}
else if (Controller1.ButtonUp.pressing())
{
Arm1.spin(vex::directionType::rev, 200, vex::velocityUnits::pct);
}
else if (!Controller1.ButtonDown.pressing())
{
Arm1.stop();
}
else if (!Controller1.ButtonUp.pressing())
{
Arm1.stop();
}
}
vex::task::sleep(20);
}
//
// Main will set up the competition functions and callbacks.
//
int main()
{
pre_auton();
//Set up callbacks for autonomous and driver control periods.
Competition.autonomous( autonomous );
Competition.drivercontrol( usercontrol );
//Prevent main from exiting with an infinite loop.
while(1)
{
while(true)
vex::task::sleep(100);//Sleep the task for a short amount of time to prevent wasted resources.
}
}