垂直度控制的数学模型及算法