Auton commands sorta working.. Encoders need to be fixed