I already told you what you have to do to debug your system. The problem is not that the script does not work but that you did not set up your system correctly. Please follow the steps I gave you:
- If you run rostopic hz on a camera topic: Do you see messages? Is your camera running?
Do rostopic list, you’ll see some topics named camera something. Do rostopic hz or echo on them to see whether they are published correctly. Only if you do that you will know if your camera is running correctly.
- If you set the rosconsole level to DEBUG (in the file /avoidance/local_planner/resource/custom_rosconsole.conf) and then run roslaunch, what output do you get?
I don’t know how to explain that step any better. I think you can figure out that one
- In the launch file: Is the fcu_url set to the correct port for your device?
You need to figure out on what device your pixhawk “talks”. You can list all devices with “ls /dev” and then you need to put the right one in the launch file under “fcu_url”. But this is device specific. If you use mavlink router than the ports in the launch file must match the ports specified in the /etc/mavlink-router/main.conf