Documentation update and minor changes to autonomous. Untested