added drive (#35)

Author: BrodyKarr

src/main/java/frc/robot/commands/DriveManual.java

@@ -14,7 +14,6 @@
 import edu.wpi.first.wpilibj2.command.Command;
 import frc.robot.Constants.constDrivetrain;
 import frc.robot.Constants.constField;
-import frc.robot.subsystems.Drivetrain;
 import frc.robot.subsystems.StateMachine.DriverState;
 
 public class DriveManual extends Command {
@@ -52,6 +51,9 @@ public void execute() {
         * redAllianceMultiplier;
     double rVelocity = -rotationAxis.getAsDouble() * constDrivetrain.TURN_SPEED.in(Units.RadiansPerSecond);
 
+    subDrivetrain.drive(
+        new Translation2d(xVelocity, yVelocity), rVelocity, isOpenLoop);
+
     subStateMachine.setDriverState(StateMachine.DriverState.MANUAL);
 
   }