Disturbance Rejection?

[ndzied1]

Maybe you could use the technique in this post:

Adaptive Amplitude, Offset and Phase Control for Waveforms

Intro Adaptive amplitude control is used for high-frequency repeating waveforms such as a sinusoid. The adaptive amplitude control changes the amplitude of the target signal (such as position of force), so that the actual amplitude reaches the desired amplitude. The is especially useful where the amplitude, offset, and possibly the phase are important, but there may be some change between each run, and it is not feasible to re-tune the system. High frequency waveforms that can be difficult to t…