[发明专利]一种L形探头的方向及位置确定方法

权利要求书

1.一种L形探头的方向及位置确定方法，其特征在于，包括：

S1.获取探头球心到主轴旋转中心的距离；

S2.设置第一安全点、第二安全点以及校准块；

其中，所述校准块为矩形，校准点与第一安全点之间的距离大于所述探头球心到主轴旋转中心的距离，校准点与第二安全点之间的距离小于所述探头球心到主轴旋转中心的距离，第一安全点与第二安全点的横坐标相等；所述校准点为所述校准块上与所述第二安全点距离最近的点；

S3.将主轴移动至第一安全点；以及控制主轴沿纵坐标方向移动至第二安全点，在主轴从第一安全点接近第二安全点的过程中，如探头与校准块发生碰触则记录探头与校准块发生碰触时主轴的坐标作为第一记录点，通过所述第一记录点与所述校准点的相对位置关系计算第一探头偏转角度；

如探头与校准块并没有发生碰触则控制主轴沿横坐标方向接近校准块；在主轴从第二安全点接近校准块时，如探头与校准块发生碰触则记录探头与校准块发生碰触时主轴的坐标作为第二记录点，并通过所述第二记录点与所述校准点的相对位置关系计算第二探头偏转角度；

探头与校准块发生碰触时主轴的坐标即为第一坐标；

当主轴的横坐标等于校准点的横坐标时，控制主轴原路返回至第一安全点；

S4.当步骤S3中没有得到第一坐标时，控制主轴旋转第一角度，重复步骤S4，直至得到第一坐标为止；

S5.通过所述第一探头偏转角度或所述第二探头偏转角度以及所述第一角度得到探头方向及位置。

2.根据权利要求1所述的一种L形探头的方向及位置确定方法，其特征在于，在所述步骤S3中，通过下述公式计算所述第一探头偏转角度：

其中，α₁为第一探头偏转角度，Y3为校准点的纵坐标，Y4为第一记录点的纵坐标，L为探头球心到主轴旋转中心的距离，R为探头球的半径。

3.根据权利要求1所述的一种L形探头的方向及位置确定方法，其特征在于，在所述步骤S3中，通过下述公式计算所述第二探头偏转角度：

α₂为第二探头偏转角度，X3为校准点的横坐标，X5为第二记录点的横坐标，L为探头球心到主轴旋转中心的距离，R为探头球的半径。

4.根据权利要求1所述的一种L形探头的方向及位置确定方法，其特征在于，所述第一角度为60°至120°。

5.根据权利要求4所述的一种L形探头的方向及位置确定方法，其特征在于，所述第一角度为90°。

6.根据权利要求1至5任意一项所述的一种L形探头的方向及位置确定方法，其特征在于，在得到探头方向及位置后，控制探头触碰校准块上任意一边的两个端点；并根据所述任意一边的两个端点的实际坐标以及探头触碰得到的坐标，对探头的方向及位置进行修正。