Dear Eitan, Do you have any suggestions or hints what I could try to overcome this weird behaviour like driving backwards? To get a robust and meaningful path planning is critical to my whole project and the main reason why I give ROS a try in my projects. Regards Christian