Small changes and a debugging change that disables the autonomous switch so it wont cause failures during early testing.