Working on alternative runhil setup.
Finally waypoints working well.