I did quite some progress on automatic navigation , but still the system is running a bit to slow