Team 3 RC

#pragma config(Motor,  port1,           leftFront,     tmotorVex393_HBridge, openLoop)
#pragma config(Motor,  port2,           leftBack,      tmotorVex393_MC29, openLoop, reversed)
#pragma config(Motor,  port3,           rightFront,    tmotorVex393_MC29, openLoop, reversed)
#pragma config(Motor,  port4,           rightBack,     tmotorVex393_MC29, openLoop)
#pragma config(Motor,  port5,           barLift1,      tmotorVex393_MC29, openLoop)
#pragma config(Motor,  port6,           barLift2,      tmotorVex393_MC29, openLoop, reversed)
#pragma config(Motor,  port7,           Goliath,       tmotorVex393_MC29, openLoop)
//*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//

task main()
{
	short leftSpeed;
	short rightSpeed;
	short barSpeed;
	short goliathSpeed;

	while(true)
	{
		/*
		DRIVE CONTROL
		*/
		//Controls left drive
		if (vexRT[Ch2] > -35 && vexRT[Ch2] < 35){
			leftSpeed = 0;
		}
		else {
			leftSpeed = vexRT[Ch3];
		}

		//Controls right drive
		if (vexRT[Ch3] > -35 && vexRT[Ch3] < 35){
			rightSpeed = 0;
		}
		else {
			rightSpeed = vexRT[Ch2];
		}

		//Controls Bar lift
		if (vexRT[Btn6U] == 1){
			barSpeed = 80;
		}
		else if (vexRT[Btn6D] == 1){
			barSpeed = -80;
		}
		else {
			barSpeed = 0;
		}

		//Controls Goliath
		if (vexRT[Btn5U] == 1){
			goliathSpeed = 127;
		}
		else if (vexRT[Btn5D] == 1){
			goliathSpeed = -127;
		}
		else {
			motor[Goliath] = 0;
		}

	}

	motor[leftFront] = leftSpeed;
	motor[leftBack] = leftSpeed;
	motor[rightFront] = rightSpeed;
	motor[rightBack] = rightSpeed;
	motor[barLift1] = barSpeed;
	motor[barLift2] = barSpeed;
	motor[Goliath] = goliathSpeed;

}