Hi,
I wanna check collision prevention function using TOF sensor.
My m 500 flight was set up with TOF + stereo cam + Tracking cam.
I checked VOA function in debug mode of voxl-vision-px4 as below.
index: 0 dist: none back
index: 1 dist: none
index: 2 dist: none
index: 3 dist: none
index: 4 dist: none
index: 5 dist: none
index: 6 dist: none
index: 7 dist: none
index: 8 dist: none
index: 9 dist: none left
index: 10 dist: none
index: 11 dist: none
index: 12 dist: none
index: 13 dist: 1.82m
index: 14 dist: 2.11m
index: 15 dist: 1.83m
index: 16 dist: 1.66m
index: 17 dist: 1.52m
index: 18 dist: 1.04m forward
index: 19 dist: 1.00m
index: 20 dist: 0.83m
index: 21 dist: 0.86m
index: 22 dist: 0.42m
index: 23 dist: 1.35m
index: 24 dist: none
index: 25 dist: none
index: 26 dist: none
index: 27 dist: none right
index: 28 dist: none
index: 29 dist: none
index: 30 dist: none
index: 31 dist: none
index: 32 dist: none
index: 33 dist: none
index: 34 dist: none
index: 35 dist: none
index: 36 dist: none
Also, I enable collision prevention with 1.5m distance in QGC.
But, when I switch to Position mode, I got a message "avoidance/collision prevention Error" as below
This is my voxl-vision-px4 config file.
"config_file_version": 1,
"qgc_ip": "192.168.219.164",
"en_secondary_qgc": false,
"secondary_qgc_ip": "192.168.1.214",
"qgc_udp_port_number": 14550,
"udp_mtu": 512,
"en_localhost_mavlink_udp": true,
"localhost_udp_port_number": 14551,
"en_vio": true,
"en_voa": true,
"en_send_vio_to_qgc": false,
"en_send_voa_to_qgc": false,
"voa_upper_bound_m": -0.15000000596046448,
"voa_lower_bound_m": 0.15000000596046448,
"en_set_clock_from_gps": true,
"en_force_onboard_mav1_mode": true,
"en_reset_px4_on_error": true,
"qvio_auto_reset_quality": 0.00050000002374872565,
"horizon_cal_tolerance": 0.300000011920929,
"offboard_mode": "trajectory",
"follow_tag_id": 0,
"figure_eight_move_home": true,
"en_tag_fixed_frame": false,
"fixed_frame_filter_len": 5,
"en_transform_mavlink_pos_setpoints_from_fixed_frame": false
Could you please let me know the reason?
One more question, I already check TOF VOA, TOF PC, but, cannot see any mapping result on voxl-portal.
How can I get map result?
Thanks,