More updates for autonomous movement
Started error test

Started programming in the error testing