made autonomous walk possible, moved alot of stuff into librarys