@@ -700,8 +700,9 @@ public boolean applyConfig(SmartMotorControllerConfig config)
700700 " because an external encoder is used!" , false );
701701 }
702702 // Set the gear ratio for external encoders.
703- m_talonConfig .ExternalFeedback .RotorToSensorRatio = config .getGearing ().getRotorToMechanismRatio () * config .getExternalEncoderGearing ()
704- .getMechanismToRotorRatio ();
703+ m_talonConfig .ExternalFeedback .RotorToSensorRatio = config .getGearing ().getRotorToMechanismRatio () *
704+ config .getExternalEncoderGearing ()
705+ .getMechanismToRotorRatio ();
705706 // config.getExternalEncoderGearing().getMechanismToRotorRatio() *
706707 m_talonConfig .ExternalFeedback .SensorToMechanismRatio = config .getExternalEncoderGearing ()
707708 .getMechanismToRotorRatio ();
@@ -717,13 +718,7 @@ public boolean applyConfig(SmartMotorControllerConfig config)
717718 : SensorDirectionValue .CounterClockwise_Positive );
718719
719720 // Configure feedback source for CANCoder
720- //if (encoder.getIsProLicensed().getValue())
721- //{
722- // m_talonConfig.ExternalFeedback.ExternalFeedbackSensorSource = ExternalFeedbackSensorSourceValue.SyncCANcoder;
723- //} else
724- //{
725- m_talonConfig .ExternalFeedback .ExternalFeedbackSensorSource = ExternalFeedbackSensorSourceValue .FusedCANcoder ;
726- //}
721+ m_talonConfig .ExternalFeedback .ExternalFeedbackSensorSource = ExternalFeedbackSensorSourceValue .FusedCANcoder ;
727722 // Zero offset
728723 if (config .getZeroOffset ().isPresent ())
729724 {
@@ -746,26 +741,13 @@ public boolean applyConfig(SmartMotorControllerConfig config)
746741 configurator .refresh (cfg );
747742 m_talonConfig .ExternalFeedback .FeedbackRemoteSensorID = encoder .getDeviceID ();
748743 // Ensure pro uses best option.
749- if (encoder . getIsProLicensed (). getValue ())
744+ if (useCANdiPWM2 ())
750745 {
751- if (useCANdiPWM2 ())
752- {
753- m_talonConfig .ExternalFeedback .ExternalFeedbackSensorSource = ExternalFeedbackSensorSourceValue .SyncCANdiPWM2 ;
754- }
755- if (useCANdiPWM1 ())
756- {
757- m_talonConfig .ExternalFeedback .ExternalFeedbackSensorSource = ExternalFeedbackSensorSourceValue .SyncCANdiPWM1 ;
758- }
759- } else
746+ m_talonConfig .ExternalFeedback .ExternalFeedbackSensorSource = ExternalFeedbackSensorSourceValue .FusedCANdiPWM2 ;
747+ }
748+ if (useCANdiPWM1 ())
760749 {
761- if (useCANdiPWM2 ())
762- {
763- m_talonConfig .ExternalFeedback .ExternalFeedbackSensorSource = ExternalFeedbackSensorSourceValue .RemoteCANdiPWM2 ;
764- }
765- if (useCANdiPWM1 ())
766- {
767- m_talonConfig .ExternalFeedback .ExternalFeedbackSensorSource = ExternalFeedbackSensorSourceValue .RemoteCANdiPWM1 ;
768- }
750+ m_talonConfig .ExternalFeedback .ExternalFeedbackSensorSource = ExternalFeedbackSensorSourceValue .FusedCANdiPWM1 ;
769751 }
770752 if (useCANdiPWM1 ())
771753 {
0 commit comments