#include "JoystickDriver.c"

task main()
{
    while(1 == 1)
    {
        getJoystickSettings(joystick);

        motor[motorWright] = joystick.joy1_y1;         // Motor D is assigned a power level equal to the right analog stick's Y-axis reading.
        motor[motorWleft] = joystick.joy1_y2;         // Motor E is assigned a power level equal to the left analog stick's Y-axis reading.

        if(joy1Btn(4) == 1)
        {
            nxtDisplayTextLine(1, "Btn4");
            motor(motorAright) = -100;
            motor(motorAleft) = -100;
        }
        else if (joy1Btn(7) == 1)
        {
            nxtDisplayTextLine(1, "Btn7");
            motor(motorAright)= 100;
            motor(motorAleft) = 100;
        }
        else
        {
            nxtDisplayTextLine(1, "");
            motor(motorAright)= 0;
            motor(motorAleft) = 0;
        }

        if(joy1Btn(1) == 1)
        {
            nxtDisplayTextLine(2, "Btn1");
            servo(servo1) = 256;
        }
        else if (joy1Btn(2) == 1)
        {
            nxtDisplayTextLine(2, "Btn2");
            servo(servo1)= 0;
        }
        else
        {
            nxtDisplayTextLine(2, "");
            servo(servo1)= 127;
        }

        wait1Msec(100);
    }
}