roboforum.ru

Собрал платформу робота на базе гученечного танка.

CPU: платформа ПЛИС Altera Cyclone2, NIOS2, 8Мб ОЗУ.
Интерфейсы: Bluetooth UART, Ethernet 10T, PPM 40 Mhz.
Сенсоры: Ультразвуковой поворотный сканер 120град, фото/видеокамера 2МПикс, сенсорный ЖК дисплей 240*320.
Силовая установка: 2 коллекторных стандартных привода, ШИМ по 8 бит на направление, энкодер на каждой стороне 16 имп на оборот ведущего вала.
Все это все обрабатывается аппаратно, а результаты приходят на центральный процессор.

Вообщем по отдельности все замечательно работает, в ручном режиме управляется, препятствия видит, объезжает.
Но задача у меня собственно была такая, сделать програмируемого робота, наподобие старого детского лунохода.
А проблема собтвенно вот в чем, никак не могу придумать как уровнять скорости вращения ведущих двигателей при прямом движении и как расчитать требуемую разность в шагах между двигателями. Энкодеры выдают, грубо говоря, пройденное расстояние каждой гусеницы.
Вообщем я задаю направление и расстояние, на которое необходимо переместиться, или угол поворота.

PS: пробовал застабилизировать обороты ПИД регулятором, но из-за малого числа импульсов на оборот и сильно разной нагрузке стабилизировать тяжело. Можно корректировать позицию ведомого привода относительно ведущего, но как тогда быть при поворотах.

Вообщем хелп, а то у меня творческий кризис.

Программу приведите, а лучше внешний вид выложите вашего робота. на слух плохо воспринимается

_________________
if(!Operate) Read(pDatasheet);

Внешний вид - ничего особенного. Датчики снаружи невидно. А программа - это целый проект, написаный как на verilog так и на Си. С кучей файлов. Нужна собственно рабочая идея. Неужели ни у кого такой проблемы нет, как движение гусенечной техники с отклонением от прямой ?

тахогенераторы...они бывают разными (например обычный DC-мотор, может выполнять такую функцию...
энкодеры...
увеличьте их разрешение...
ну тогда тахогенератор и преобразователь U/F (напряжение/частота)...
Может как то графически вначале порешать задачку...типа нарисовать траекторию при развороте, оценить точки контакта гусениц с поверхностью, представить зависимости усилий на этих точках в разных режимах...И эмпирически составить табличку, в которой будут уставки скорости в зависимости от состояния системы...Эту табличку можно корректировать, приближаясь к идеалу...

_________________
Роботы, уже среди нас...
Прошу прощения за аватар, никак схему динамической индикации не могу настроить :)

Сам искал что-то подобное, вот наверное наиболее подходящий вариант, но диски энкодеров придется крепить к валу двигателя, а не на колеса привода гусениц. Как реализовать, может подскажет статья: http://www.roboclub.ru/master/2005/07/25/sensor_90.html
Посмотрите текст программы по ссылке forum58/topic4392-15.html (текст программы взят оттуда):

'Платформа применения- МИНИБОТ-1.
'Язык - Basic
'Среда - BASCOM-AVR MCS Electronics v1.11.7.7
'Назначение программы - пример для некоммерческого использования.
'Действие программы - уравнивание угловых скоростей колес одноосевой схемы
' с двумя независимыми двигателями.
'Результат работы программы - езда прямо в одном направлении.
'Пояснения - в программе использован ШИМ для управления двигателями
' и прерывание от таймера0 для обработки информации от датчиков
' оборотов двигателей.
'Дата: 10.03.2008
'Автор: Чернышев А.А.

Есть видео: P1130699_toDivX.avi