Fix mecanum drive and add autonomous.