#pragma config(Hubs,  S1, HTMotor,  HTServo,  none,     none)
#pragma config(Motor,  motorD,          ,        tmotorNormal, PIDControl, )
#pragma config(Motor,  motorE,          ,       tmotorNormal, PIDControl, )
#pragma config(Servo,  servo1,          ,               tServoNormal)
//*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//

#include "JoystickDriver.c"

task main()
{
  while (true)
  {
    getJoystickSettings(joystick);

    //nxtDisplayBigStringAt(20,15, (string)joystick.joy1_y1);
    //nxtDisplayBigStringAt(35,30, (string)joystick.joy1_y2);

    //motor[MotorD] = joystick.joy1_y1;
    //motor{MotorE] = joystick.joy1_y2;

    //if (joy1Btn(1))
      //motor[MotorD] = 20;
    //else
      //motor[MotorD] = 0;

      //if (joy1Btn(2))
       //motor[MotorE] = 30;
      //else
        //motor[MotorE] = 0;
   
    servoTarget[servo1] = joystick.joy1_y1;

   }
}