Цитата(_lukash_ @ Nov 25 2007, 00:41)

Ваша задача типовая для устройств с числовым программным управлением.
Как я решал эти задачи.
Как делается многокоординатная система.
Каждая координата имеет обратную связь по положению.
Вы имеете линейную интерполяцию, если нужно из точки А приехать в точку Б.
Подготовка.
1.Вы считываете длину пути, как корень квадратный из квадратов перемещений по координатам.
2.Высчитываете косинусы для каждой координаты.
По таймеру выполняется:
1. Расчет показаний датчиков.
2. Замыкание следящих систем.
3. Алгоритм разгона-замедления.
4. Диспетчер интерполяций.
4.1. Расчеты приращений по координатам и новые координаты.
Все.