[发明专利]并联机器人自标定方法

说明书

 

技术领域

本发明涉及一种机器人，特别是并联机器人自标定的方法。

背景技术

并联机器人为多环闭链机构且各运动链和关节运动副为空间布置，结构参数较多且检测困难，故并联机器人的标定比传统的串联机器人要复杂的多。并联机器人标定的难点在于其动平台位姿信息及各分支初始杆长的获得。无论采用何种标定方法，均需对并联机器人的运动信息进行全部或部分测量。目前对并联机器人基本是采用外部标定的方法，该外部标定需借助精密的外部测量设备进行测试，标定时在某一指定的设备所处位置应当尽可能检测到所有的测量点，否则就需要转站或增加测量设备，而这将提高测量成本、降低测量精度及工作效率。对于待标定设备，特别是高空作业设备，因其测试距离远，测量设备的布站将十分困难，并且这些仪器安装条件较为苛刻，在应用时需要进行精细调整，耗时长，对操作要求高，应用不便。

发明内容

本发明的目的在于在保证机械结构基本不变的前提下，有机结合并联机器人运动学特点，提供一种几乎不对机构设计增添约束的成本低廉、操作简便、效率高、不受距离限制、测量精度高的并联机器人自标定方法。

本发明主要是：

在并联机器人6个驱动分支移动副上安装位移传感器，如光栅尺或磁致伸缩位移传感器；在并联机器人定平台和动平台之间增设N个测量分支（l₁, l₂, …, l_N），其两端分别与定、动平台固结，每个分支上安装有一拉绳传感器；

对应任一特定位姿，由并联机构学理论，可建立6个驱动分支和N个测量分支的反解方程，即可建立（6+N）个独立的显式方程，而方程中未知数包括动平台6个位姿参数以及（6+N）个分支杆长，共计（12+N）个未知参数；

在不考虑其它机构学参数误差（如各铰点位置误差）的情况下，以任一位姿为初始状态，驱动机器人变换位姿，则对应新位姿，又可建立（6+N）个方程，此次驱动分支变化量可由安装于其上的位移传感器获得，测量分支变化量可由拉绳传感器获得，即仅新增6个位姿参数，则此时方程总数为2×（6+N），而未知量数目为（18+N）；

驱动机器人再次变换一新位姿，同理，又可建立（6+N）个方程，新增6个位姿参数；

以此类推，假设变换新位姿n次，则共可建立方程（6+N）×（n+1）个，而未知参数为（12+N+6n）个，因此，当方程数大于等于未知参数数目时，即当（6+N）×（n+1）≥（12+N+6n）时，方程可解，则可以求得任意状态动平台位姿及机构学参数误差，即能实现机器人自标定。

进一步，若需考虑更多的机构学参数误差，则通过增加动平台位姿变化次数，可以建立足够的方程来求解未知参数。与此同时，方程数目的增加可能导致数值求解的难度加大，但对于同等数目的待辨识机构学参数，增加拉绳传感器的数目，将减少所需的动平台位姿变化次数，所建立的方程总数也会减少，数值求解的难度自然随之降低。

本发明与现有技术相比具有如下优点：

1、在并联机器人驱动分支安装位移传感器，在定、动平台间增设安装一定数量的拉绳传感器，仅通过简单的、有限次动平台位姿的变换，无需已知初始杆长，由传感器位移相对变化量即可求解出任意状态下动平台位姿信息及各分支杆长。拉绳传感器安装尺寸小、结构紧凑、测量行程大、测量精度高，并且安装简单，安装精度易于保证。

2、本发明的测量方法不需要复杂、昂贵的外部空间位姿测量装置，对标定环境要求较低，且基本不对机构设计增添约束，成本低廉，操作便捷可靠，不受距离限制，适用于高空、远距离作业等多种场合。

3、所述方法对于少自由度并联机器人同样适用。

附图说明

图1为本发明并联机器人自标定方法示意简图。

具体实施方式

结合附图，以其为例具体描述本发明所述的并联机器人自标定方法。