Для простоты предположим, что наш GPS приёмник оперирует информацией о местоположении относительно данного исходного пункта в форме «XY» (рис. 1.2). Координаты местоположения точки, к которой роботу необходимо двигаться – (Xg, Yg), а текущие координаты робота, снабженного GPS приемником – (Xr, Yr). Вычитание координат показывает, насколько робот должен изменить своё текущее положение (Х, Y), чтобы достичь расположения цели. Таким образом, Х = Xg – Xr, и Y = Yg – Yr.
Рис. 1.2. Это исходное положение робота, использующего информацию, обеспеченную системой позиционирования. За основу для вычисления курса берётся безотносительное (абсолютное) местоположение робота и цели. Электронный компас (увеличенный вид компаса – слева) позволит роботу следовать найденным курсом
Мы используем систему координат, привязанную к географии Земли, как показано на рисунке, с осью X, направленной на север. Чтобы достичь точки расположения цели, мы должны сделать возможным движение робота по курсу под углом относительно оси X. Элементарная тригонометрия сообщает нам, что угол, под которым мы должны двигаться, определяется из арктангенса изменений в положении «X» и «Y», то есть: = tan-1 (Y/X).
Недостаточно знать только абсолютную позицию нашей цели и абсолютную позицию робота; мы должны также знать направление движения робота. Знание о направлении и величине поворота является сущностью самонаведения: требуемый поворот в движении есть разница между курсом, которым робот в настоящее время следует и курсом, по которому мы хотим, чтобы робот следовал.
GPS обеспечивает информацию о местоположении, но непосредственно не дает нам курс робота. Электронный компас поможет заполнить этот пробел. Чтобы направиться к цели, робот поворачивается до тех пор, пока курс, обозначенный компасом, не будет соответствовать требуемому курсу. Робот продолжает раз за разом «консультироваться» с GPS приемником по поводу безотносительного местоположения, вычисляя курс от абсолютных координат местонахождения цели: вычисляет требуемый курс, поворачивается по направлению к цели и продвигается, сокращая расстояние между собой и целью.
Итак, мы справились с проблемой перемещения нашего робота точно к месту и хотим его туда направить? Не совсем. Прежде, чем мы сможем успешно использовать информацию об абсолютном местонахождении, необходимо победить еще одного злодея, который затаился в засаде, готовый наказать новичков. Имя злодея – разрешение. Смотрим рис. 1.3.
Рис. 1.3. Заманчиво воображать, как показано на «а», что система позиционирования установит таблицу координат и, по мере того как наш робот путешествует, система позиционирования будет сообщать ему, которую из ячеек таблицы он занимает. К сожалению, разрешение (также как шум и другие ошибки) ограничивает способность любой системы позиционирования функционировать таким образом. Если разрешение нашей системы позиционирования – R, то при ограничении разрешения будут сомнения в любом измерении координат, сообщенном системой, по крайней мере, на величину ± R. Это означает, что в отличие от координат пикселя на экране компьютера, координаты робота, вычисленные системой позиционирования, можно воспринимать только как предположительные. Пример этого показан в форме чисел на «b». Когда робот занимает определённую ячейку таблицы координат в реальном мире, система позиционирования может сообщить, что робот находится в другой ячейке. То, как ячейки словно блуяздают в разные стороны от их фактических положений, показано на «с» – и они блуяздают непрерывно. Безотносительное позиционирование робота построено на этой сомнительной основе.
Каждая система позиционирования может точно измерить местоположение до некоторого минимума расстояния, но никак не меньше. Например, вы можете использовать линейку длиной в ярд, чтобы измерить расстояние всего в 1/16 дюйма. Но вы не можете использовать эту линейку, чтобы измерить толщину листа бумаги. Такие маленькие расстояния меньше предела разрешения данной линейки. Аналогично, вы не можете использовать одометр вашего автомобиля, чтобы измерить диаметр баскетбольного мяча. И так же за пределами своего разрешения ни одна система позиционирования не выдаст значащую информацию. Таким образом, первый вопрос к любой системе позиционирования – каково её разрешение?
В зависимости от обстоятельств, предел разрешения обычного GPS приемника часто не лучше порядка 10 метров. (Хотя прибор может сообщать о своём местоположении до милиметра, цифры на дисплее есть ложная точность, так как они не последовательны во времени.) Предположим, что мы пытаемся использовать такой приемник (наряду с электронным компасом), чтобы указать роботу путь в соответствии с безотносительным местоположением. Мы используем следующую программу «нацеливания» на требуемое XY-местоположение, выраженное как Dest_vec.
Поведение Home_GPS
Loc_vec = get_GPS_xy // GPS выдаёт текущий вектор местоположения
Disp_vec = Dest_vec – Loc_vec // Вектор смещения (displacement) к месту назначения (destination)