本发明专利技术公开一种基于直线位移传感器的工业机器人运动学参数的标定方法，属于机器人技术领域。该方法将传感器固定于机器人工作空间内若干位置，根据示教程序指令让机器人运动到不同的指定位置停止，并通过传感器获取机器人末端TCP与传感器基准位置的距离数据，记录关节角度值；然后进行粗标定，利用机器人TCP获得传感器的基准位置的初始值，根据测量数据和标定方程，获得传感器基准位置的较准确值，只考虑关节角度零位偏差得到标定方程，完成粗标定；接着进行精标定，考虑机器人所有DH参数、末端连杆参数、传感器零位偏差，建立标定方程，多次迭代后完成标定。本发明专利技术具有结构简单、容易实现、标定精度高及收敛速度快等特点。
【技术实现步骤摘要】
：本专利技术属于机器人
，具体涉及一种基于直线位移传感器的工业机器人运动学参数的标定算法。
技术介绍
：随着工业机器人在工业生产中应用范围及其任务复杂程度的不断扩大，对工业机器人的位置和姿态精度要求也越来越高。目前工业机器人具有很高的重复定位精度，在0.1mm以内，而绝对定位精度却很低，在1mm以上，甚至达到1cm，这严重限制了工业机器人的应用范围。众多原因导致工业机器人定位精度低，其中最重要的是运动学模型中几何结构的参数偏差。标定技术是补偿这些参数偏差的有效方法，因此成为研究热点。标定就是应用先进的测量手段和基于模型的参数识别方法辨识出机器人模型的准确参数，从而提高机器人绝对定位精度。三十余年来，机器人标定领域已经取得了一些令人瞩目的成果。测量方法主要有两类方法，其中一类方法需要高精度的测量设备来精确测量机器人末端的位置向量，比如三坐标测量机和激光跟踪仪等。这些设备昂贵，限制了其应用场合。另一类方法是在机器人末端施加一些约束形成运动学闭链，主要是平面约束和球约束。这方法需要复杂精确的手工操作和效率不高。随着高精度直线位移传感器的发展，如拉线传感器，利用拉线传感器进行机器人标定具有便于携带，低成本，操作方便的特点。但是由于直线位移传感器本身特点，如精度相对于激光跟踪仪来说很低，测量数据是一维的(只能测量两点之间的距离)等，限制了其在机器人标定领域的应用，因此开发基于直线位移传感器的机器人运动学参数标定算法成为迫切需求。
技术实现思路
本专利技术的目的在于提供一种基于直线位移传感器的工业机器人标定算法，该算法标定精度高，收敛速度快，并且易于编程实现，能够标定工业机器人的所有连杆参数，主要包括关节角度的零位偏差、连杆长度、连杆扭角、连杆偏置，本算法能标定拉线传感器的零位偏差。直线位移传感器以拉线传感器为首选，拉线传感器具有成本低，精度高，量程大，体积小等优点，十分适合机器人现场标定。由于机器人标定对传感器的要求是精度高，量程大，但拉线传感器量程越大精度越低，为了保证标定精度，选用小量程高精度的拉线传感器。为了提高标定效果，标定点需尽可能遍布机器人全工作空间，这与拉线传感器小量程形成矛盾。为了解决这一矛盾，本专利技术标定过程中，拉线传感器可固定在若干位置进行测量。每一位置采集机器人工作空间的部分区域，这样可采用小量程拉线传感器；多个位置采集，就可覆盖机器人全工作空间。本专利技术所提供的一种基于直线位移传感器的工业机器人标定算法包括以下步骤：第一步：直线位移传感器固定在若干位置获取测量数据：(1.1)直线位移传感器固定在某任意位置，对工业机器人进行示教；(1.2)根据示教程序指令让所述工业机器人运动到指定位置停止，并记录所述工业机器人在不同位置时所述直线位移传感器的数据及所述工业机器人的关节角度值；(1.3)改变所述直线位移传感器的位置并固定，对所述工业机器人进行示教，重复步骤(1.2)；(1.4)重复步骤(1.3)若干次，一般情况下直线位移传感器位置数为1到3；第二步：直线位移传感器固定在每个位置时的粗标定：(2.1)首先让所述工业机器人末端TCP尽可能靠近所述直线位移传感器，获取TCP位置，并把此位置作为所述直线位移传感器的基准位置初值；(2.2)根据所述直线位移传感器的基准位置初值、测量数据和所述机器人名义参数，标定所述直线位移传感器的基准位置；(2.3)根据标定出的所述直线位移传感器基准位置与建立的标定模型对所述工业机器人的关节零位偏差和所述直线位移传感器基准位置偏差进行粗标定；第三步：综合所述直线位移传感器所有位置粗标定结果的精标定：(3.1)建立标定模型，对所述工业机器人所有DH参数、末端连杆参数和所述直线位移传感器的零位偏差进行标定；(3.2)迭代标定，多次重复步骤(3.1)，一般重复步骤(3.1)四次后标定结果变化足够小，标定结束。本专利技术提供的机器人标定算法，算法结构简单，容易实现，并且标定精度高，收敛速度快。采用本专利技术的标定算法和市场上高精度拉线传感器，能对机器人的结构参数进行校准，以提高机器人的绝对定位精度。同时可在中小企业得到广泛运用，补偿机器人结构因长期工作而造成的损耗，为机器人长时间高可靠性工作提供质量保障。涉及用于工业机器人在各个行业的运用，如飞机装配孔、弧焊、点焊、喷漆等。附图说明：图1是基于直线位移传感器的工业机器人标定算法流程图；图2是本专利技术所涉及的机器人标定系统。图中：1：机器人控制器1；2：待标定的工业机器人；3：连接杆；4：拉线传感器，5：数据采集卡；6：计算机。具体实施方式：下面结合附图和具体实施例进一步说明本专利技术的技术方案。如图2所示。直线位移传感器采用拉线传感器，当然也可采用其他传感器，如激光跟踪仪。标定系统由机器人控制器1，待标定的工业机器人2，连接杆3，拉线传感器4，数据采集卡5和计算机6组成。基本过程是：待标定的工业机器人2安装在某一固定位置上，工业机器人的末端法兰安装有与拉线传感器匹配的连接杆3，拉线传感器4尽量固定放置在工业机器人工作空间内，在这一原则下，拉线传感器的位置可以任意，待标定的工业机器人2在机器人控制器1的驱动下运动到空间各个不同的位置，装有标定软件的计算机6通过数据采集卡5获得测量数据。多次改变拉线传感器4的位置并固定，拉线传感器4尽量固定放置在工业机器人工作空间内，在这一原则下，拉线传感器的位置可以任意，进行测量。根据所有测量数据最终标定出机器人运动学参数。对工业机器人标定前，首先对工业机器人进行示教，示教的目的是使示教点尽量分散在机器人工作范围内，确保工业机器人的结构误差对机器人绝对定位精度影响最大。需要工业机器人按照指令运动规定位置并停止，通过拉线传感器对每个示教点位置进行测量。本专利技术中拉线传感器固定在多个位置，在每个位置的示教点尽量分散；多个位置的全部示教点尽量分散在机器人整个工作范围内。每个位置的示教点一般在100左右。该算法的关键就是将拉线传感器当作工业机器人误差传递的一部分，并且粗精标定分开。首先进行粗标定，目的是获得拉线传感器每个位置的精确坐标。为了公式简洁，粗标定时拉线传感器在每个位置时，不加下标区别，采用的测量数据仅限于该位置时的测量数据。拉线传感器坐标在工业机器人的基座坐标系中定义，记为基准点P0(x0,y0,z0)。在具体的标定过程中，需要工业机器人按照示教好的程序运动到示教位置，记工业机器人运动到每个位置的TCP实际坐标为Pai(xai,yai,zai)，名义坐标为Pni(xni,yni,zni)，名义坐标是根据机器人前向运动学，采用机器人名义参数(设计参数)计算出的。通过拉线传感器对每个示教点位置进行测量，那么通过拉线传感器测量获得的就是基准点P0到示教点Pai的长度li，该长度由下式定义：(x0-xai)2+(y0-yai)2+(z0-zai)2＝li2 (1)本专利技术提出根据测量数据计算出基准点P0的预估值。下面进行粗标定，首先让工业机器人TCP尽可能靠近拉线传感器，获取此时TCP名义坐标，并把此坐标作为拉线传感器的基准位置初值P0'(x'0,y'0,z'0)，则拉线传感器基准位置偏差ΔP0：ΔP0(Δx,Δy,Δz)＝ΔP0(x0-x'0,y0-y'0,z0-z'0) (2)由于工业机器人还未标定，不能本文档来自技高网...
【技术保护点】
一种基于直线位移传感器的工业机器人运动学参数的标定算法，其特征在于该标定算法包括以下步骤：第一步：直线位移传感器固定在若干位置获取测量数据：(1.1)直线位移传感器固定在某任意位置，对工业机器人进行示教；(1.2)根据示教程序指令让所述工业机器人运动到指定位置停止，并记录所述工业机器人在不同位置时所述直线位移传感器的数据及所述工业机器人的关节角度值；(1.3)改变所述直线位移传感器的位置并固定，对所述工业机器人进行示教，重复步骤(1.2)；(1.4)重复步骤(1.3)若干次，一般情况下直线位移传感器位置数为1到3；第二步：直线位移传感器固定在每个位置时的粗标定：(2.1)首先让所述工业机器人末端TCP尽可能靠近所述直线位移传感器，获取TCP位置，并把此位置作为所述直线位移传感器的基准位置初值；(2.2)根据所述直线位移传感器的基准位置初值、测量数据和所述机器人名义参数，标定所述直线位移传感器的基准位置；(2.3)根据标定出的所述直线位移传感器基准位置与建立的标定模型对所述工业机器人的关节零位偏差和所述直线位移传感器基准位置偏差进行粗标定；第三步：综合所述直线位移传感器所有位置粗标定结果的精标定：(3.1)建立标定模型，对所述工业机器人所有DH参数、末端连杆参数和所述直线位移传感器的零位偏差进行标定；(3.2)迭代标定，多次重复步骤(3.1)，一般重复步骤(3.1)四次后标定结果变化足够小，标定结束。...
【技术特征摘要】
1.一种基于直线位移传感器的工业机器人运动学参数的标定算法，其特征在于该标定算法包括以下步骤：第一步：直线位移传感器固定在若干位置获取测量数据：(1.1)直线位移传感器固定在某任意位置，对工业机器人进行示教；(1.2)根据示教程序指令让所述工业机器人运动到指定位置停止，并记录所述工业机器人在不同位置时所述直线位移传感器的数据及所述工业机器人的关节角度值；(1.3)改变所述直线位移传感器的位置并固定，对所述工业机器人进行示教，重复步骤(1.2)；(1.4)重复步骤(1.3)若干次，一般情况下直线位移传感器位置数为1到3；第二步：直线位移传感器固定在每个位置时的粗标定：(2.1)首先让所述工业机器人末端TCP尽可能靠近所述直线位移传感器，获取TC...
【专利技术属性】
技术研发人员：单建华，佘慧莉，
申请(专利权)人：安徽工业大学，
类型：发明
国别省市：安徽;34
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。