Added small flywheel fix and talonfx reorg. (#112)

Signed-off-by: thenetworkgrinch <thenetworkgrinch@users.noreply.github.com>
Co-authored-by: thenetworkgrinch <thenetworkgrinch@users.noreply.github.com>

Author: thenetworkgrinch

yams/java/yams/mechanisms/velocity/FlyWheel.java

@@ -241,7 +241,7 @@ public <T> Command run(Supplier<T> velocity)
     {
       m_config.getCircumference(); // Circumference check
       return Commands.startRun(m_smc::startClosedLoopController,
-                               () -> m_config.getAngularVelocity((LinearVelocity) velocity.get()),
+                               () -> m_smc.setVelocity(m_config.getAngularVelocity((LinearVelocity) velocity.get())),
                                m_subsystem)
                      .withName(cmdName);
     }

yams/java/yams/motorcontrollers/remote/TalonFXWrapper.java

@@ -1368,8 +1368,8 @@ public void setMechanismUpperLimit(Angle upperLimit)
     m_config.getMechanismLowerLimit().ifPresent(lowerLimit -> {
       m_config.withSoftLimit(lowerLimit, upperLimit);
     });
-    m_talonConfig.SoftwareLimitSwitch.withForwardSoftLimitThreshold(upperLimit)
-                                     .withForwardSoftLimitEnable(true);
+    m_talonConfig.SoftwareLimitSwitch.withForwardSoftLimitEnable(true)
+                                     .withForwardSoftLimitThreshold(upperLimit);
     forceConfigApply();
   }
 
@@ -1379,8 +1379,8 @@ public void setMechanismLowerLimit(Angle lowerLimit)
     m_config.getMechanismUpperLimit().ifPresent(upperLimit -> {
       m_config.withSoftLimit(lowerLimit, upperLimit);
     });
-    m_talonConfig.SoftwareLimitSwitch.withReverseSoftLimitThreshold(lowerLimit)
-                                     .withReverseSoftLimitEnable(true);
+    m_talonConfig.SoftwareLimitSwitch.withReverseSoftLimitEnable(true)
+                                     .withReverseSoftLimitThreshold(lowerLimit);
     forceConfigApply();
   }