We have developed the novel dynamic inversion based navigation algorithms and implemented it in C++ on STM32. We are currently testing the straight-line navigation and pivot-turn navigation algorithms with our rover. Please watch the following videos to see our test results.

This novel algorithm is proved to be superior than the commonly-used pure-pursuit navigation algorithm. Please read our IEEE conference paper to know more details. The IEEE journal paper is coming soon.