problems of obstacle avoidance using VFH

[HITXCI]

Thanks for your amazing works firstly! When I test the "obstacle_avoidance_2Dlaser_vfh_px4.launch", I upload the waypoints in QGC. But the terminal didn't print the information about the waypoints. It seems stuck in a while loop.

Do you have any idea about this? Thank you very much!