Final version of advanced autonomous functionalities for ground robots and crawlers

Summary
Final algorithms developed for dexterous manipulation, advanced perception and intelligent navigation for ground robots and crawlers.