 
 }
 
+void debugJoy(int iJoy)
+{
+    Serial.print("joy x: [");
+    Serial.print(joy[iJoy].iXVal);
+    Serial.print("], joy y: [");
+    Serial.print(joy[iJoy].iYVal);
+    Serial.print("] \n");
+}
+
 void loop()
 {
     PollJoysticks();
+    //debugJoy(0);
 
     int i= 0;
     int iMotor = 1;

            break;

        default:
            digitalWrite(motors[0].iSignalAddress[0], 0);
            digitalWrite(motors[0].iSignalAddress[1], 0);
            digitalWrite(motors[0].iSignalAddress[2], 0);
            digitalWrite(motors[0].iSignalAddress[3], 0);
            break;
    }
}

    else if (joy[i].iYVal < 432) { motors[iMotor].iDirection = -1; }
    else                         { motors[iMotor].iDirection =  0; }


    i = 1; iMotor = 2;
    if      (joy[i].iYVal > 900) { motors[iMotor].iDirection =  1; }
    else if (joy[i].iYVal < 432) { motors[iMotor].iDirection = -1; }
    else                         { motors[iMotor].iDirection =  0; }

    iMotor = 3;
    if      (joy[i].iXVal > 900) { motors[iMotor].iDirection = -1; }
    else if (joy[i].iXVal < 432) { motors[iMotor].iDirection =  1; }
    else                         { motors[iMotor].iDirection =  0; }

    for (int i=0; i<4; i++)
    {
        if (motors[i].iDirection !=0)
        {

           if      (motors[i].iDirection > 0) { if (++(motors[i].iStep) >=8){ motors[i].iStep = 0; } }
           else if (motors[i].iDirection < 0) { if (--(motors[i].iStep) < 0){ motors[i].iStep = 7; } }

            debugFoo(i, motors[i].iStep, motors[i].iDirection);

            SetMotor(i, motors[i].iStep);

        }

    }
    //delay(6 );
    //delayMicroseconds(1);




/*
    if (joy[0].iXVal > 900)
