Форум arduino.ua

Вот пример, того как можно это сделать. Частично на псевдокоде.

int middleX = 0;
int middleY = 0;

int getXAdc() {
    // получить значение АЦП оси X
    return adc;
}

int getYAdc() {
    // получить значение АЦП оси Y
    return adc;
}

void rotateServo1(int angle) {
    //вращение сервопривода
}
void rotateServo2(int angle) {
    //вращение сервопривода
}

int convertAdc2SAngle(int adc) {
    return adc*coef;
}

void init() {
    middleY = getYAdc();
    middleX = getXAdc();
}

void rotateAxises(int adcX, int adcY) {
    int angleS1 = convertAdc2SAngle(adcX);
    int angleS2 = convertAdc2SAngle(adcY);

    // находим наибольшее значимое отклонение X или Y
    if (abs(adcX) > abs(adcY)) {
        rotateServo1(angleS1);
        rotateServo2(-angleS2);
    } else {
        rotateServo1(angleS1);
        rotateServo2(angleS2);
    }
}

void main() {
    init();
    while(1) {
        int currentX = getXAdc() - middleX;
        int currentY = getYAdc() - middleY;
    }
}

Приложи свой вариант, чтоб чтоб оценить где может быть ошибка