The present application belongs to the technical field of vehicle-mounted communication antenna
servo control, and particularly relates to a tilt angle sensor drift
elimination method based on a bias tracking
algorithm, comprising the following steps: synchronously collecting original tilt angle readings and
chip temperature readings of the tilt angle sensor at a fixed
collection period; calculating a short-
time standard deviation of the original tilt angle readings in a sliding window, determining as stationary when the short-
time standard deviation is lower than a stationary threshold, determining as disturbance when the short-
time standard deviation is not lower than the stationary threshold, obtaining a
stationary state flag, and taking the square of the short-time standard deviation as an observation
noise variance; calculating a temperature
rise rate according to the
chip temperature readings, and outputting a high value as a bias process variance when the
stationary state flag is stationary and the temperature
rise rate is higher than a
thermal equilibrium threshold. The present application solves the problem of transient bias drift of the tilt angle sensor caused by
chip temperature rise, so that the output error of the corrected tilt angle value continuously meets the leveling accuracy requirement in the task period.