D1mcon писал(а):мобильный робот должен знать:
1) Где он находится
2) Куда нужно двигаться
3) Как туда добраться.
К слову...
Если у робота имеется УЗ-сонар, то применяется следующий алгоритм:
1. Положение робота определяется просто (см. P.S.)
2. Конечное положение определяется координатами на карте.
3. Есть такая штука, как кратчайшее расстояние между двумя точками в лабиринте (использую волновой метод).
Т.о. робот постоянно сканируя стены лабиринта формирует кратчайший путь прохождения до конечной точки.
P.S. Положение робота определяется следующим образом:
1. Сканируется круговоя "картина".
2. Определяются углы мужду наблюдаемыми плоскостями.
3. Исходя из "изученной" карты ищется соответствие обстановки.
4. Геометрически определяется положение.
З.Ы.Ы. Данный алгоритм сейчас в разработке.