Tweaked a few more things.
Completed the move function in chassis to make it successfully move forward in auto.