it now freezes when starting to find paths
finished path planning