Skip to content

Latest commit

 

History

History
70 lines (41 loc) · 4.3 KB

optical_flow.md

File metadata and controls

70 lines (41 loc) · 4.3 KB

光流

Optical Flow uses a downward facing camera and a downward facing distance sensor for velocity estimation. Optical Flow based navigation is enabled by the estimators: EKF2 and LPE (deprecated).

设置

An Optical Flow setup requires a downward facing camera and a distance sensor (preferably a LiDAR). These can be connected via MAVLink, I2C or any other bus that supports the peripheral.

:::note If connected to PX4 via MAVLink the Optical Flow device must publish to the OPTICAL_FLOW_RAD topic, and the distance sensor must publish to the DISANCE_SENSOR topic. :::

The output of the flow when moving in different directions must be as follows:

Vehicle movement Integrated flow
Forwards + Y
Backwards - Y
Right - X
Left + X

For pure rotations the integrated_xgyro and integrated_x (respectively integrated_ygyro and integrated_y) have to be the same.

An popular setup is the PX4Flow and Lidar-Lite, as shown below.

Optical flow lidar attached

Sensor data from the optical flow device is fused with other velocity data sources. The approach used for fusing sensor data and any offsets from the center of the vehicle must be configured in the estimator.

Flow Sensors/Cameras

PX4Flow

PX4Flow is an optical flow camera that works indoors and in low outdoor light conditions without the need for an illumination LED. It is one of the easiest and most established ways to calculate the optical flow.

PMW3901-Based Sensors

PMW3901 is an optical flow tracking sensor similar to what you would find in a computer mouse, but adapted to work between 80 mm and infinity. It is used in a number of products, including some from: Bitcraze, Tindie, Hex, Thone and Alientek.

Other Cameras/Sensors

It is also possible to use a board/quad that has an integrated camera (e.g. Snapdragon Flight). For this the Optical Flow repo can be used (see also snap_cam).

Range Finders

You can use any supported distance sensor. However we recommend using LIDAR rather than sonar sensors, because of their robustness and accuracy.

估计器

Estimators fuse data from the optical flow sensor and other sources. The settings for how fusing is done, and relative offsets to vehicle center must be specified for the estimator used.

The offsets are calculated relative to the vehicle orientation and center as shown below:

Optical Flow offsets

Extended Kalman Filter (EKF2)

For optical flow fusion using EKF2, set the use optical flow flag in the EKF2_AID_MASK parameter, as shown using QGroundControl below:

QGroundControl - Calibrate Sensors

If your optical flow sensor is offset from the vehicle centre, you can set this using the following parameters.

参数 描述
EKF2_OF_POS_X X position of optical flow focal point in body frame (default is 0.0m).
EKF2_OF_POS_Y Y position of optical flow focal point in body frame (default is 0.0m).
EKF2_OF_POS_Z Z position of optical flow focal point in body frame (default is 0.0m).