Changed drive code to accomodate only 2 motors