I missed a problem about the control algorithm. As I see, control loop runs on 8K same as current measurement frequency, since a semaphone is used to trim the control loop thread. However, the freertos’ systick is 1KHz, how can it answer a 8K signal?
Any help would be greatly honored!