Extraction and Filter Algorithm of Roll Angular Rate for High Spinning Projectiles

Abstract

The accurate measurement of roll angular rate for high spinning projectile has long been a challenging problem. Aiming to obtain the accurate roll angular rate of high spinning projectile, a novel extraction and filter algorithm, BSCZT-KF, is proposed in this paper. Firstly, a compound angular motion model of high spinning projectile is established. According to the model, we translate the roll angular rate measurement problem into a frequency estimation problem. Then the improved CZT algorithm, BSCZT, was employed to realize an accurate estimation of the narrowband signal frequency. Combined with the peak detection method, the BSCZT-KF algorithm is presented to further enhance the frequency estimation accuracy and the real-time performance. Finally, two sets of actual flight tests were conducted to verify the effectiveness and accuracy of the algorithm. The test results show that the average error of estimated roll angular rate is about 0.095% of the maximum of roll angular rate. Compared with the existing methods, the BSCZT-KF has the highest frequency estimation accuracy for narrowband signal.