Fixed problem with NULL z on some route points