Использование Optical Flow
При использовании технологии Optical Flow возможен полет в режиме POSCTL и автономные полеты (режим OFFBOARD) по камере, направленной вниз, за счет измерения сдвигов текстуры поверхности пола.
Включение
СОВЕТ
Для работы Optical Flow необходим подключенный и настроенный лазерный дальномер.
Включите Optical Flow в файле ~/catkin_ws/src/clover/clover/launch/clover.launch
:
<arg name="optical_flow" default="true"/>
Optical Flow публикует данные в топик /mavros/px4flow/raw/send
. Кроме того, в топик /optical_flow/debug
публикуется визуализация, которую можно просмотреть с помощью web_video_server.
СОВЕТ
Для правильной работы модуль камеры должен быть корректно подключен и сконфигурирован.
Настройка полетного контроллера
СОВЕТ
При использовании сборки PX4 для Клевера необходимые параметры PX4 применятся автоматически.
При использовании LPE (параметр SYS_MC_EST_GROUP
= local_position_estimator, attitude_estimator_q
):
LPE_FUSION
– включены флажки fuse optical flow и flow gyro compensation.LPE_FLW_QMIN
– 10.LPE_FLW_SCALE
– 1.0.LPE_FLW_R
– 0.2.LPE_FLW_RR
– 0.0.SENS_FLOW_ROT
– No rotation (отсутствие поворота).SENS_FLOW_MAXHGT
– 4.0 (для дальномера VL53L1X)SENS_FLOW_MINHGT
– 0.0 (для дальномера VL53L1X)- Опционально:
LPE_FUSION
– включен флажок pub agl as lpos down (см. конфигурирование дальномера.
При использовании EKF2 (параметр SYS_MC_EST_GROUP
= ekf2
):
EKF2_AID_MASK
– включен флажок use optical flow.EKF2_OF_DELAY
– 0.EKF2_OF_QMIN
– 10.EKF2_OF_N_MIN
– 0.05.EKF2_OF_N_MAX
- 0.2.SENS_FLOW_ROT
– No rotation (отсутствие поворота).SENS_FLOW_MAXHGT
– 4.0 (для дальномера VL53L1X)SENS_FLOW_MINHGT
– 0.0 (для дальномера VL53L1X)- Опционально:
EKF2_HGT_MODE
– range sensor (см. конфигурирование дальномера).
Для проверки правильности всех настроек можно воспользоваться утилитой selfcheck.py
.
Полет в POSCTL
Настройте POSCTL как один из полетных режимов PX4. Переведите в режим POSCTL.
Автономный полет
Автономный полет возможен с использованием модуля simple_offboard.
Пример взлета на высоту 1.5 м и удержание позиции:
navigate(z=1.5, frame_id='body', auto_arm=True)
Полет вперед на 1 м:
navigate(x=1, frame_id='body')
Полет назад на 1 м (относительно предыдущей целевой точки):
navigate(x=-1, frame_id='navigate_target')
При использовании Optical Flow возможна также навигация по ArUco-маркерам, в том числе используя VPE.
Дополнительные настройки
Если коптер нестабильно удерживает позицию, попробуйте увеличить коэффициенты P PID-регулятора по скорости – параметры MPC_XY_VEL_P
и MPC_Z_VEL_P
.
Если коптер нестабильно удерживает высоту, попробуйте увеличить коэффициент MPC_Z_VEL_P
или лучше подобрать газ висения – MPC_THR_HOVER
.
Если коптер уплывает по рысканью, попробуйте:
- перекалибровать гироскопы;
- перекалибровать магнитометр;
- попробовать разные значения параметра
EKF2_MAG_TYPE
, который определяет, каким образом данные с магнитометра используются в EKF2; - изменять значения параметров
EKF2_MAG_NOISE
,EKF2_GYR_NOISE
,EKF2_GYR_B_NOISE
.
СОВЕТ
Для более хороших результатов выполняйте перекалибровку гироскопов непосредственно перед взлетом, используя соответствующий сниппет.
Если коптер уплывает по высоте, попробуйте:
- повысить значение коэффициента
MPC_Z_VEL_P
; - изменить значение параметра
MPC_THR_HOVER
; - выставить
MPC_ALT_MODE
= 2 (Terrain following).
При использовании Optical Flow максимальная горизонтальная скорость дополнительно ограничивается. За это косвенно отвечает параметр SENS_FLOW_MAXR
(максимальная достоверная "угловая скорость" оптического потока). При нормальном полёте горизонтальная скорость будет регулироваться так, чтобы показания Optical Flow не превышали 50% значения данного параметра.
Неисправности
При появлении в QGC ошибок типа EKF INTERNAL CHECKS
попробуйте перезагрузить EKF2. Для этого наберите в MAVLink-консоли:
ekf2 stop
ekf2 start