#pragma config(Hubs,  S1, HTMotor,  HTMotor,  HTServo,  none)
#pragma config(Motor,  mtr_S1_C1_1,          motorD,        tmotorNormal, openLoop, )
#pragma config(Motor,  mtr_S1_C1_2,          motorE,        tmotorNormal, openLoop, )
#pragma config(Motor,  mtr_S1_C2_1,     motorF,        tmotorNormal, openLoop, )
#pragma config(Servo,  srvo_S1_C3_1,    serv1,                tServoNormal)
#pragma config(Servo,  srvo_S1_C3_2,    serv2,                tServoNormal)
#pragma config(Servo,  srvo_S1_C3_3,    serv3,                tServoNormal)
#pragma config(Servo,  srvo_S1_C3_4,    serv4,                tServoNormal)
#pragma config(Servo,  srvo_S1_C3_5,    serv5,                tServoNormal)
//*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//

#include "JoystickDriver.c" //Include file to "handle" the BT messages.
task main()
{
while (true) //Loop forever
{
getJoystickSettings(joystick); //You had two of those
motor[motorD] = joystick.joy1_y2;
motor[motorE] = joystick.joy1_y1;
if(joy1Btn(1))
{
servoTarget[serv1] = 250;
}
else
{
servoTarget[serv1] = 0;
}
if(joy1Btn(5))// before it was !=0 but it isn't needed
{
servoTarget[serv2] = 0;
servoTarget[serv3] = 150;
}
else
{
servoTarget[serv2] = 200;
servoTarget[serv3] = 0;
}
if(joy1Btn(1))
{
servoTarget[serv4] = 0;
}
else
{
servoTarget[serv4] = 250;
}
}
}