传感器垂直度误差补偿算法