Fixed a few things in autonomous