Skip to content

Приложение 1. Используемые системы координат ​

Скоростная система координат ​

Используется для управления движением дрона путем задания линейных и угловых скоростей. Оси координат задаются следующим образом: ось Х вперед, ось Y вправо, ось Yaw по часовой стрелке. Если задать скорость X положительной, дрон полетит прямо, если отрицательной – полетит назад. Аналогично по оси Y и углу поворота Yaw.

image129

Направление осей скоростной системы координат

Используется для методов:

Blockly:

  • «Задать скорость XY»

  • «Задать скорость XY и рыскание»

Python API:

  • setVelXY(vel_x, vel_y)

  • setVelXYYaw(vel_x, vel_y, vel_yaw)

Одометрическая система координат ​

Ось X направлена вперед, ось Y направлена влево.

image130

Направление осей одометрической системы координат

Используется для методов:

Blockly:

  • «Лететь в XY дрон»

  • «Лететь в XY одометрию»

Python API:

  • gotoXYdrone(drone_x, drone_y)

  • gotoXYodom(odom_x, odom_y)

Необходимо учитывать, что в случае вызова «Лететь в XY дрон»/ gotoXYdrone() данная система координат используется независимо от текущего угла поворота дрона, так как привязана к дрону. Если вызывать метод «Лететь в XY одометрию»/gotoXYodom() без предварительного обнуления одометрии, то нулем (началом) координат будет являться точка включения дрона.

Системы координат ArUco-маркеров ​

Система координат (СК) ArUco-маркеров подразумевает наличие двух способов получения информации о видимых маркерах:

  1. Получение позиции ArUco-маркеров относительно дрона

image146

Направление осей системы координат при определении положения ArUco-маркера относительно дрона

Если камера направлена:

  • вперед, то для стабилизации дрона относительно ArUco-маркера по оси roll необходимо использовать координату Х, для оси pitch – координату Z, а для высоты – координату Y.

  • вниз, то система координат поворачивается на 90 градусов относительно оси X по часовой стрелке. Тогда ось Х направлена вправо, ось Y – назад, ось Z – вниз. В таком случае для стабилизации дрона относительно ArUco-маркера по оси roll используем координату Х, по оси pitch – координату Y, а по высоте – координату Z.

Используется для методов:

Blockly: «Для каждого из ArUco-маркеров»

Python API: getArucos()

Если маркер был обнаружен, то возвращаются координаты ArUco-маркеров относительно системы координат камеры в формате:

[{'id': aruco_id, 'pose': {'position': {'x': aruco_pos_x, 'y': aruco_pos_y, 'z': aruco_pos_z}, 'orientation': {'x': aruco_orient_x, 'y': aruco_orient_y, 'z': aruco_orient_z}}}].

Если маркеры не обнаружены, то возвращается ответ «no markers».

  1. Получение позиции дрона относительно ArUco-маркеров

image148

Направление осей системы координат при определении положения дрона относительно ArUco-маркера

Если камера направлена:

  • вперед, то для выравнивания относительно маркера используются ось Z для pitch, ось X для roll, ось Y для высоты.

  • вниз, то система поворачивается на 90 градусов вокруг оси X по часовой стрелке. Тогда для выравнивания относительно маркера используются ось Y для pitch, ось X для roll, ось Z для высоты.

Используется для методов:

Blockly: «Для каждой позиции относительно ArUco-маркера»

Python API: getCameraPoseAruco()

Данные методы возвращают позицию камеры относительно задетектированных маркеров. Координаты камеры измеряются относительно системы координат, центр которой находится в центре за детектированного маркера.

Если маркер был обнаружен, то возвращаются координаты камеры относительно систем координат ArUco-маркеров в формате:

[{'id': aruco_id, 'pose': {'position': {'x': camera_pos_x, 'y': camera_pos_y, 'z': camera_pos_z}, 'orientation': {'x': camera_orient_x, 'y': camera_orient_y, 'z': camera_orient_z}}}]

Если маркеры не обнаружены, то выдается ответ «no markers».

Система координат цветовых блобов ​

Блобы детектируются относительно пиксельного центра координат камеры. Начало системы координат камеры расположено в левом верхнем углу. В соответствии с этим ось Х направлена вправо, а ось Y направлена вниз.

image162

Оси X и Y в системе координат цветовых блобов

Используется для методов:

Blockly: «Для каждого блоба из массива блобов»

Python API: getBlobs()

Возвращают список в формате:

[{"id": "0", "center": {"x": center_x0, "y": center_y0}, "size": {"x": size_x0, "y": size_y0}}, {"id": "1", "center": {"x": center_x1, "y": center_y1}, "size": {"x": size_x1, "y": size_y1}}, {"id": "2", "center": {"x": center_x2, "y": center_y2}, "size": {"x": size_x2, "y": size_y2}}, {"id": "3", "center": {"x": center_x3, "y": center_y3}, "size": {"x": size_x3, "y": size_y3}}]

Координаты объектов возвращаются не в метрическом, а в пиксельном формате (максимум 320 пикселей по Х и 240 пикселей по Y). Таким образом, чтобы найти координаты объекта относительно оптического центра, необходимо вычесть из координат по оси X 160 (320/2) и из координат по оси Y 120 (240/2).