VOA not working with ToF

Jetson Nano

I am trying to do voa in a starling drone which has a ToF, I have enabled voa and also set it to use ToF, but still collision prevention is not working for me, And also I am not getting the obstacle distance messages in QGC

Jetson Nano

@tom @Chad-Sweet @Eric-Katzfey Waiting for a response from your side!

Alex Kushleyev

@Jetson-Nano , can you please provide some additional information:

are you using VOXL1 or VOXL2?
which VOXL SDK are you using?
have you verified that TOF sensor is functional (you can do it using voxl-portal (cameras or point clouds tab)
how are you enabling / configuring VOA?
have you verified that VOA is running and not producing any error messages?

Thank you

Jetson Nano

@Alex-Kushleyev

we are using voxl 2
SDK version: 1.1.1
TOF is functional [working in portal and mapper]
Followed the steps in https://docs.modalai.com/voxl-vision-px4-collision-prevention-0_9/ with the following parameters
CP_DIST: 1.5
CP_DELAY: 0.0
CP_GUIDE_ANG: 0.0
CP_GO_NO_DATA: 1
and en_send_voa_to_qgc in voxl-vision-hub.conf is enabled.
Yes we can see the VOA point cloud on the portal and running voxl-vision-hub -s shows the distances in line on the terminal.
We verified the distance values and they are accurate but the drone doesn't stop on its own even when we go really slowly at a fixed obstacle under 1.5m

Moderator

@Jetson-Nano Looks like MPC_POS_MODE is needed as well per the documentation https://docs.px4.io/main/en/computer_vision/collision_prevention.html