[发明专利]一种三轴动态测量机器人运动的方法

说明书

本发明公开的一种三轴动态测量机器人运动的方法，包括以下步骤：a、在被测机器人末端设置四维万向节；b、在等边三角形支架顶角处设置距离传感器，并记录距离传感器之间安装距离；c、等边三角形支架相对机器人固定设置；d、通过距离传感器采集装置对四维万向节的位置进行采集，并传输给数据处理装置进行数据处理。本发明公开的一种三轴动态测量机器人运动的方法，通过计算设置于机器人末端的四维万向节与位置传感器之间距离，通过采集装置传输给数据处理装置进行处理，得到机器人的运动轨迹，在大大简化测量方法的基础上，大大降低测量成本，加快测量效率。

技术领域

本发明涉及机器人运动测量领域，特别是指一种三轴动态测量机器人运动的方法。

背景技术

现有技术中对机器人的运动普遍采用激光跟踪仪的方法，通过激光测量得到机器人末端运动在激光跟踪仪坐标系下的轨迹，具体的是通过空间测量模拟出机器人运动是依靠测量设备得到标定参数值，因此对硬件设备可靠性，测量环境都非常严格，而激光跟踪仪不但对环境、温度、湿度均有较高要求，测量过程相对复杂，设备安装要求严格，且设备成本高。

亟待出现一种即可简化测量手段又可大大降低测量成本的机器人运动测量方法。

发明内容

本发明公开的一种三轴动态测量机器人运动的方法，解决了现有技术中激光测距仪测量复杂且成本高的技术问题。

本发明的技术方案是这样实现的：一种三轴动态测量机器人运动的方法，包括以下步骤：

a、在被测机器人末端设置四维万向节；

b、在等边三角形支架顶角处设置距离传感器，并记录距离传感器之间安装距离；

c、等边三角形支架相对机器人固定设置；

d、通过距离传感器采集装置对四维万向节的位置进行采集，并传输给数据处理装置进行数据处理。

优化地，所述步骤d中数据采集装置采集的频率不小于400HZ。

进一步地，所述步骤d中数据处理装置通过正运动学算法计算四维万向节位置坐标，并通过得到机器人的运动轨迹。其中，t表示时间，参数l₁、l₂、l₃、t1、t2的含义分别为：

l₁:相对A点的拉绳长度；l₂:相对B点的拉绳长度；l₃:相对C点的拉绳长度；t1,t2,分别表示积分函数的起始时间和结束时间。

优化地，所述距离传感器为拉绳编码器，所述等边三角形支架通过拉绳固定连接于四维万向节。

优化地，所述拉绳编码器为2500线的相对编码器或17位的绝对编码器。

优化地，所述拉绳编码器连接采集卡和工业PC。

本发明公开的一种三轴动态测量机器人运动的方法，通过计算设置于机器人末端的四维万向节与位置传感器之间距离，通过采集装置传输给数据处理装置进行处理，得到机器人的运动轨迹，在大大简化测量方法的基础上，大大降低测量成本，加快测量效率；本发明可实时测量机器人的运动精度、定位精度、重复定位精度、升降速曲线、加速度曲线、实际运动位移等数据；本发明可以作为单关节运动或多轴联动的运动性能参数调节辅助检测装置，能够全方位测量出机械设备本体和控制系统参数是否匹配。

附图说明

为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。

图1：本发明实施例2的结构示意图；