High goal autonomous & drive straight
Added 2 motors for production DT