public void Run()
{
_talon.SetControlMode(CTRE.TalonSrx.ControlMode.kVoltage);
_talon.SetFeedbackDevice(CTRE.TalonSrx.FeedbackDevice.CtreMagEncoder_Relative);
_talon.SetSensorDirection(false);
_talon.SetVoltageRampRate(0.0f);
_talon.SetP(0, 0.80f);
_talon.SetI(0, 0f);
_talon.SetD(0, 0f);
_talon.SetF(0, 0.09724488664269079041176191004297f);
_talon.SelectProfileSlot(0);
_talon.ConfigNominalOutputVoltage(0f, 0f);
_talon.ConfigPeakOutputVoltage(+12.0f, -12.0f);
_talon.ChangeMotionControlFramePeriod(5);
/* loop forever */
while (true)
{
_talon.GetMotionProfileStatus(out _motionProfileStatus);
Drive();
CTRE.Watchdog.Feed();
Instrument();
Thread.Sleep(5);
}
}