[发明专利]一种激光测距传感器安装位置误差标定方法

说明书

技术领域

本发明涉及机器人技术，更具体地说，本发明涉及一种基于莱文贝格－马夸特方法的激光测距传感器安装位置误差标定方法。

背景技术

激光测距传感器是一种非接触式的测量方式，具有测量精度高等优点，其已经广泛的应用在了各种领域中，例如：钻铆机器人法线测量中长采用激光测距传感器。由于装配过程中导致的装配误差，以及安装传感器的零件加工误差，导致激光测距传感器的安装精度无法满足需求，因此需要对激光测距传感器的安装位置误差进行标定，以提高测量精度。对安装位置的标定是其中一种方法，该方法未充分利用传感器安装的理论位置。莱文贝格－马夸特方法是一种较普通最小二乘法具有诸多的优点，收敛速度快，对初始值的依赖小，不容易造成局部收敛。

发明内容

针对现有技术，本发明的目的在于提供了一种基于莱文贝格－马夸特方法的激光测距传感器安装位置误差标定方法，该方法对激光测距传感器的测量距离的数学模型进行建模，基于该模型求出误差模型，然后采用莱文贝格－马夸特方法对激光测距传感器的安装位置误差进行参数辨识，进而可以提高传感器的测量精度。

本发明所使用的装置由工业机器人、平面试验板、激光测距传感器、传感器安装架、激光跟踪仪组成。平面试验板安装在工业机器人末端，激光测距传感器安装在传感器安装架上，传感器安装架保持固定不动。平面试验板上有三个基准孔，分别为基准孔I、基准孔J、基准孔K。传感器安装架上有三个基准孔，分别为基准孔M、基准孔O、基准孔N，且基准孔O和基准孔M的连线垂直于基准孔O和基准孔N的连线。

本发明通过以下技术方案实现。

该方法包括如下步骤：

步骤1：将激光跟踪仪架设在地面上，平面试验板和传感器安装架在激光跟踪仪的测量范围内；

步骤2：用激光跟踪仪测量传感器安装架上的三个基准孔，然后基于三个基准孔建立工具坐标系；

步骤3：移动工业机器人使得激光测距传感器打出的激光束可打到平面试验板上，且距离不超出激光测距传感器的量程。用激光跟踪仪测量平面试验板三个基准孔在工具坐标系下的空间位置，然后拟合出平面试验板在工具坐标系下的空间方程；

步骤4：求出激光测距传感器打出的激光束的直线方程；

步骤5：求出激光测距传感器打出的激光束所在直线与平面试验板交点坐标；

步骤6：求出激光测距传感器发射点与交点的长度，并建立误差模型；

步骤7：读取激光测距传感器的读数,计算出测量长度误差；

步骤8：采用莱文贝格－马夸特方法求得，选取合适的阻尼因子，计算出安装位置误差；

步骤9：将求得的安装位置误差加入新的参数；

步骤10：重复步骤3至步骤9，进行反复的迭代，直到误差足够小，就可以获得安装位置误差。

与已有技术相比，本发明的有益效果在于：本发明所述的基于莱文贝格－马夸特方法的激光测距传感器位置误差标定方法，该方法可以很好的标定出安装位置误差，避免了普通最小二乘法局部收敛的问题。

附图说明

图1为本发明中安装误差标定原理示意图。

图中：1.工业机器人；2.平面试验板；3.激光测距传感器；4.传感器安装架；5.激光跟踪仪；

具体实施方式：

下面通过结合附图对本发明作进一步说明。

本发明的实施方式：

参见图1，本发明所使用的装置由工业机器人1、平面试验板2、激光测距传感器3、传感器安装架4、激光跟踪仪5组成。平面试验板2安装在工业机器人1末端，激光测距传感器3安装在传感器安装架4上，传感器安装架4保持固定不动。平面试验板2上有三个基准孔，分别为基准孔I、基准孔J、基准孔K。传感器安装架4上有三个基准孔，分别为基准孔M、基准孔O、基准孔N，且基准孔O和基准孔M的连线垂直于基准孔O和基准孔N的连线。

下面为本发明方法的步骤做详细的说明。

本发明方法的具体实施步骤如下：

步骤1：将激光跟踪仪5架设在地面上，平面试验板2和传感器安装架4在激光跟踪仪5的测量范围内；

步骤2：用激光跟踪仪5测量传感器安装架4上的基准孔M、基准孔O、基准孔N，然后基于三个基准孔建立工具坐标系OXYZ，其中原点为基准孔O，X轴为基准孔O指向基准孔M的向量，Y轴为基准孔O指向基准孔N的向量，采用右手法则确定Z轴的方向；