ArduPilot / MissionPlanner

Mission Planner Ground Control Station for ArduPilot (c# .net)
http://ardupilot.org/planner/
GNU General Public License v3.0
1.75k stars 2.38k forks source link

Radar view for OBSTACLE_DISTANCE message #2444

Open rmackay9 opened 4 years ago

rmackay9 commented 4 years ago

With the ongoing work to improve obstacle avoidance using the Intel 435i, AP is receiving OBSTACLE_DISTANCE messages. It would be great if we could display the output of these messages on the radar view. This would make both development and use of these sensors easier because the user could more easily see what output is coming from the sensor. For example it's helpful in determining if the sensor is aligned forward properly.

thien94 commented 4 years ago

Here is an example script that I created to test the OBSTACLE_DISTANCE (OD) message: https://github.com/thien94/vision_to_mavros/blob/t265_and_d435/scripts/AP_test_obstacle_distances.py

How to use:

  1. Change the connection parameters to the FCU: string and baudrate
  2. The script will then send the OD message at a pre-defined frequency.
  3. Modify the configurations for the OD message here.

Below are some results with different simulated FOV (this param):

The desirable results would be [angle_start = -39.5, angle_end = 39.5] and 3 arcs.

meee1 commented 4 years ago

ive added code to the new beta already, have not tested it yet though

meee1 commented 4 years ago

image

tested. and slight change to background