mirror of
https://github.com/BroncBotz3481/YAGSL
synced 2026-06-19 06:21:40 +00:00
Added support for Falcons, and the ability to disable the CANCoders
This commit is contained in:
@@ -86,10 +86,13 @@ public class SwerveModule
|
||||
|
||||
// Config angle encoders
|
||||
absoluteEncoder = moduleConfiguration.absoluteEncoder;
|
||||
absoluteEncoder.factoryDefault();
|
||||
absoluteEncoder.configure(moduleConfiguration.absoluteEncoderInverted);
|
||||
angleMotor.configureIntegratedEncoder(moduleConfiguration.getPositionEncoderConversion(false));
|
||||
angleMotor.setPosition(absoluteEncoder.getAbsolutePosition() - angleOffset);
|
||||
if (absoluteEncoder != null)
|
||||
{
|
||||
absoluteEncoder.factoryDefault();
|
||||
absoluteEncoder.configure(moduleConfiguration.absoluteEncoderInverted);
|
||||
angleMotor.configureIntegratedEncoder(moduleConfiguration.getPositionEncoderConversion(false));
|
||||
angleMotor.setPosition(absoluteEncoder.getAbsolutePosition() - angleOffset);
|
||||
}
|
||||
|
||||
// Config angle motor/controller
|
||||
angleMotor.configurePIDF(moduleConfiguration.anglePIDF);
|
||||
@@ -119,7 +122,10 @@ public class SwerveModule
|
||||
*/
|
||||
public void synchronizeEncoders()
|
||||
{
|
||||
angleMotor.setPosition(absoluteEncoder.getAbsolutePosition() - angleOffset);
|
||||
if (absoluteEncoder != null)
|
||||
{
|
||||
angleMotor.setPosition(absoluteEncoder.getAbsolutePosition() - angleOffset);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
|
||||
Reference in New Issue
Block a user