一种移动节点的轨迹测算方法及装置的制造方法

一种移动节点的轨迹测算方法及装置的制造方法
【技术领域】
[0001] 本发明涉及工程机械领域，特别涉及一种移动节点的轨迹测算方法及装置。
【背景技术】
[0002] 混凝土栗车在施工过程中，臂架系统的末端存大很大的上下左右方向振动，会严 重影响浇注位置的定位，也会造成安全事故。在混凝土栗车出厂之前需要进行臂架末端振 动测试，以保证用户的正常使用。但在振动测试中，单自由度测振装置比较常见，而三维空 间测振还缺乏相应的装置和方法。
[0003] 空间测振最常用的方法是测算移动节点的运动轨迹，根据移动节点的轨迹变化判 定移动节点的振动。目前常用的测试方法包括激光位移传感器测试、加速度传感器测试， GPS定位等。主要存在如下问题:一、激光位移传感器测试：（1)只能测试单方向位移，无法准 确描述空间点的运行轨迹。（2)对反射面要求很高，且发射面布置困难。二、加速度传感器测 试，通过频域二次积分的方法得出位移。（1)数据后期处理环节复杂，累积误差大，影响测试 精度(2)对低频信号的测试精度有待验证;三、GPS定位：（1)周围障碍物对测试结果影响较 大，（2)不适合在室内、测试场地受限等场合下测试。

【发明内容】

[0004] 有鉴于此，本发明提出一种移动节点的轨迹测算方法及装置。以解决测量精度低 和成本高及移动节点在x、y、z三个方向上的位移运动轨迹等问题。
[0005] -方面，本发明提供了一种移动节点的轨迹测算方法，一种移动节点的轨迹测算 方法，其特征在于，在三维空间内布置三个参考节点，在三个参考节点上分别安装第一通信 装置，在移动节点上安装有第二通信装置，三个第一通信装置与第二通信装置通信以测出 移动节点与三个参考节点之间的距离1^丄 2丄3，将测得的移动节点与三个参考节点之间的 距离UU3反馈至处理器，处理器根据三个参考节点的坐标及距离UU3得出移动节点 的位置坐标，进而得出移动节点运动轨迹。
[0006] 进一步地，三个参考节点布置在水平面内，且三个参考节点呈三角形分布。
[0007] 进一步地，三个参考节点呈等腰直角三角形分布，第一参考节点位于坐标系的原 点，第二参考节点位于坐标系的X轴上，第三参考节点位于坐标系的Y轴上，Li代表第一参考 节点至移动节点距离，^代表第二参考节点至移动节点距离，l 3代表第三参考节点至移动节 点距离;根据下述的公式得出移动节点位置坐标：
[0011]上述公式的X、y、z为移动节点位置坐标值，a为等腰直角三角形的直角边长度。
[0012]进一步地，三个第一通信装置和一个第二通信装置之间采用Zigbee无线通信技 术、蓝牙无线通信技术或wi-fi无线通信技术。
[0013]进一步地，第一通信装置为接收装置，第二通信装置为发射装置;或，第一通信装 置为发射装置，第二通信装置为接收装置。
[0014]另外，本发明还提供了一种移动节点的轨迹测算装置，包括处理器、三个第一通信 装置、第二通信装置，三个第一通信装置分别与第二通信装置无线通信，三个第一通信装置 分别用于安装在三维空间的三个参考节点上，第二通信装置用于安装在被测移动节点上， 三个第一通信装置与第二通信装置通信以用于测出移动节点与三个参考节点之间的距离 1^丄 2丄3，第一通信装置或第二通信装置用于将移动节点测得的距离1^、1^丄3反馈至处理 器，处理器用于根据三个参考节点的坐标及距离L^Ls、!^得出移动节点的位置坐标，进而得 出被测移动节点运动轨迹。
[0015] 进一步地，三个参考节点布置在水平面内，且三个参考节点呈三角形分布。
[0016]进一步地，三个参考节点呈等腰直角三角形分布，第一参考节点位于坐标系的原 点，第二参考节点位于坐标系的X轴上，第三参考节点位于坐标系的Y轴上，Li代表第一参考 节点至移动节点距离，1^代表第二参考节点至移动节点距离，L 3代表第三参考节点至移动节 点距离，处理器用于根据下述的公式得出被测移动节点的位置坐标：
[0020]上述公式的X、y、z为移动节点位置坐标值，a为等腰直角三角形的直角边长度。 [0021]进一步地，三个第一通信装置和第二通信装置为Zigbee无线通信装置、蓝牙无线 通信装置或wi-fi无线通信装置。
[0022] 进一步地，第一通信装置为接收装置，第二通信装置为发射装置;或，第一通信装 置为发射装置，第二通信装置为接收装置。
[0023] 本发明提供的一种移动节点的轨迹测算方法及装置，无需繁琐的数据处理，避免 由此引起的测试误差;不受测试场地、测试距离与位移大小等因素的影响。测量精度高，成 本低，能检测移动节点在三维空间X、y、z方向上的运动轨迹。
【附图说明】
[0024] 构成本发明的一部分的附图用来提供对本发明的进一步理解，本发明的示意性实 施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：
[0025] 图1为本发明一种移动节点的轨迹测算装置结构示意图；
[0026] 图2为本发明的一种移动节点的轨迹测算装置布置示意图。
【具体实施方式】
[0027] 需要说明的是，在不冲突的情况下，本发明中的实施例及实施例中的特征可以相 互组合。下面将参考附图并结合实施例来详细说明本发明。
[0028]下面结合图1至图2,对本发明的优选实施例作进一步详细说明，本优选实施例一 种移动节点的轨迹测算装置为例，如图1所示，该装置包括处理器、三个第一通信装置(具体 可以为接收装置或发射装置）、第二通信装置(具体可以为发射装置或接收装置），本实施例 的三个第一通信装置采用接收装置1、2、3,第二通信装置采用发射装置。三个第一通信装置 分别与第二通信装置无线通信，三个第一通信装置分别用于安装在三维空间的三个参考节 点上，第二通信装置用于安装在被测移动节点（如臂架系统末端)上，三个第一通信装置与 第二通信装置通信以用于测出移动节点与三个参考节点之间的距离1^丄 2丄3，第一通信装 置或第二通信装置用于将移动节点测得的距离Ι^α2α 3反馈至处理器(通常是接收装置将 距离反馈至处理器），处理器用于根据三个参考节点的坐标及距离Li、L2、L 3得出移动节点的 位置坐标，根据位置坐标与时间的关系，进而得出被测移动节点运动轨迹。需要说明的是， 处理器可以为任何具有数据处理功能的装置，如计算机、单片机。通过该装置，无需繁琐的 数据处理，避免由此引起的测试误差；不受测试场地、测试距离与位移大小等因素的影响。 测量精度高，成本低，能检测移动节点在三维空间x、y、z方向上的运动轨迹。
[0029]本发明的移动节点的轨迹测算方法如图2所示，在三维空间内布置三个参考节点， 在三个参考节