Move the set() methods next to each other

Author: kcooney

lib/src/main/java/com/team2813/lib2813/subsystems/MotorSubsystem.java

@@ -80,13 +80,24 @@ public final boolean atPosition() {
   /**
    * {@inheritDoc}
    *
-   * <p>Additionally, this method disables PID control of the subsystem
+   * <p>Additionally, this method disables PID control of the subsystem. It <em>does not</em> clamp
+   * the provided value.
+   */
+  @Override
+  public final void set(ControlMode mode, double demand) {
+    isEnabled = false;
+    motor.set(mode, demand);
+  }
+
+  /**
+   * {@inheritDoc}
+   *
+   * <p>Additionally, this method disables PID control of the subsystem. It <em>does not</em> clamp
+   * the provided value.
    */
   @Override
   public final void set(ControlMode mode, double demand, double feedForward) {
-    if (isEnabled()) {
-      disable();
-    }
+    isEnabled = false;
     motor.set(mode, demand, feedForward);
   }
 
@@ -125,18 +136,6 @@ public final boolean isEnabled() {
     return isEnabled;
   }
 
-  /**
-   * {@inheritDoc}
-   *
-   * <p>Additionally, this method disables PID control of the subsystem. It <em>does not</em> clamp
-   * the provided value.
-   */
-  @Override
-  public final void set(ControlMode mode, double demand) {
-    isEnabled = false;
-    motor.set(mode, demand);
-  }
-
   /**
    * Clamps the given output value and provides it to the motor.
    *