public void UpdatePolarSpeedCorrectionGains(object sender, PolarSpeedPidData e)
 {
     KpX     = e.Px_a;
     KpTheta = e.Ptheta_a;
     KiX     = e.Ix_a;
     KiTheta = e.Itheta_a;
     KdX     = e.Dx_a;
     KdTheta = e.Dtheta_a;
 }
 public void UpdatePolarSpeedCorrectionLimits(object sender, PolarSpeedPidData e)
 {
     corrLimitPX     = e.Px_a;
     corrLimitPTheta = e.Ptheta_a;
     corrLimitIX     = e.Ix_a;
     corrLimitITheta = e.Itheta_a;
     corrLimitDX     = e.Dx_a;
     corrLimitDTheta = e.Dtheta_a;
 }
 public void UpdatePolarSpeedCorrectionValues(object sender, PolarSpeedPidData e)
 {
     corrPXList.Enqueue(e.Px_a);
     corrPThetaList.Enqueue(e.Ptheta_a);
     corrIXList.Enqueue(e.Ix_a);
     corrIThetaList.Enqueue(e.Itheta_a);
     corrDXList.Enqueue(e.Dx_a);
     corrDThetaList.Enqueue(e.Dtheta_a);
 }