《泵车间臂架姿态防碰撞检测方法及系统.pdf》由会员分享，可在线阅读，更多相关《泵车间臂架姿态防碰撞检测方法及系统.pdf（18页珍藏版）》请在专利查询网上搜索。
1、(10)申请公布号 CN 104236618 A (43)申请公布日 2014.12.24 CN 104236618 A (21)申请号 201410379209.3 (22)申请日 2014.08.04 G01D 21/00(2006.01) (71)申请人 湘潭大学 地址 411105 湖南省湘潭市雨湖区西郊羊牯 塘湘潭大学 (72)发明人 姚志强 康琴 盛孟刚 张钰旻 (74)专利代理机构 上海精晟知识产权代理有限 公司 31253 代理人 熊娴 冯子玲 (54) 发明名称 泵车间臂架姿态防碰撞检测方法及系统 (57) 摘要 本发明公开了一种泵车间臂架姿态防碰撞检 测方法及系统， 泵车为。
2、两台或两台以上， 包括如下 步骤 ： 步骤 a) 获取泵车间各臂架的多个臂节姿态 信息 ； 步骤 b) 根据步骤 a) 所获信息， 判断各臂架 的多个臂节运动趋势 ； 步骤 c) 根据步骤 a) 和步 骤 b) 的信息， 将各臂架的多个臂节姿态信息设于 同一参考系后， 再计算各臂架的多个臂节姿态信 息和距离值 ； 步骤 d) 根据步骤 c) 的计算值进行 预警处理。 该检测系统应用于至少两台泵车上， 包 括 ： 姿态感知单元、 趋势判断单元、 处理单元和报 警单元。使用该方法的泵车间臂架姿态防碰撞检 测系统后， 可提高群体作业时臂架的安全性， 进而 有效降低事故的发生率， 因此应用前景十分广阔。
3、。 (51)Int.Cl. 权利要求书 2 页 说明书 11 页 附图 4 页 (19)中华人民共和国国家知识产权局 (12)发明专利申请 权利要求书2页 说明书11页 附图4页 (10)申请公布号 CN 104236618 A CN 104236618 A 1/2 页 2 1. 泵车间臂架姿态防碰撞检测方法， 其特征在于， 泵车为两台或两台以上， 包括如下步 骤 ： 步骤 a) 获取泵车间各臂架的多个臂节姿态信息 ； 步骤 b) 根据步骤 a) 所获信息， 判断各臂架的多个臂节运动趋势 ； 步骤 c) 根据步骤 a) 和步骤 b) 的信息， 将各臂架的多个臂节姿态信息设于同一参考系 后， 再。
4、计算各臂架的多个臂节姿态信息和距离值 ； 步骤 d) 根据步骤 c) 的计算值进行预警处理。 2. 根据权利要求 1 所述的泵车间臂架姿态防碰撞检测方法， 其特征在于， 步骤 a) 的具 体操作为 ： 获取距离信息， 将获取的距离信息拟合成臂架姿态信息。 3. 根据权利要求 1 所述的泵车间臂架姿态防碰撞检测方法， 其特征在于， 步骤 b) 的具 体操作为 ： 通过对多个连续的臂架的历史姿态信息进行分析， 判断其运动趋势。 4. 根据权利要求 1 所述的泵车间臂架姿态防碰撞检测方法， 其特征在于， 步骤 c) 的具 体操作为 ： 将至少两台泵车各自臂架的姿态信息转换到同一参考系中， 根据同一参。
5、考系中 臂架的当前姿态信息、 趋势信息计算出臂架在未来多个时刻的姿态信息和不同泵车间各臂 架的距离值。 5. 根据权利要求 4 所述的泵车间臂架姿态防碰撞检测方法， 其特征在于 ： 所述臂架姿 态信息转换公式为 ：其中， 定义 W 为泵车转台的中 心点， 从转台 (W) 出发沿泵车车尾方向 (V) 作为参考方向W0-V0和 W-V 表示两台不 同泵车 ( 如泵车 0 和泵车 1) 的参考系， (r,a,h) 为 (r0,a0,h0) 转换到 W-V 中的姿态信息， (r0,a0,h0) 为泵车 0 某测量点在 W0-V0参考系中的姿态信息 ； 为与的夹角， 可通 过事先标定得到， 若V0绕h轴。
6、逆时针旋转到V， 则为正， 反之为负 ； (rQ,aQ,hQ)为W0在W-V 中的姿态信息。 6. 根据权利要求 4 所述的泵车间臂架姿态防碰撞检测方法， 其特征在于， 所述未来 t 时刻臂架姿态信息计算公式为 ：其中， (rBi,aBi,hBi) 为第 i 节臂节末端在 t 时刻的姿态信息 ； (rAi-1,aAi-1,hAi-1) 和 (rAi,aAi,hAi) 分别 表示第 i-1 节臂节和第 i 节臂节在当前时刻的姿态信息， 可通过姿态感知单元获取 ； i为 第 i 节臂节的角速度， 当预测运动趋势竖直展开 ( 即向上 ) 时 i 0， 反之， i 0。 7.根据权利要求4所述的泵车间。
7、臂架姿态防碰撞检测方法， 其特征在于， 当得到第i节 臂节在 t 时刻的姿态信息后， 且第 i 节臂节不是最后一节， 则随着该臂节而运动的第 i+1 臂 节末端的姿态信息 (rBi+1,aBi+1,hBi+1) 计算公式为 ： 权 利 要 求 书 CN 104236618 A 2 2/2 页 3 其 中， (rAi+1,aAi+1,hAi+1) 表 示 i+1 臂节末端的当前时刻的姿态信息， 可通过姿态感知单元获取， 各臂节在 t 时刻的姿态信 息构成了整个臂架的姿态信息。 8. 根据权利要求 1 所述的泵车间臂架姿态防碰撞检测方法， 其特征在于， 步骤 d) 的具 体操作为 ： 判断不同泵车。
8、间各臂架所处相对姿态是否安全， 做出相应的预警处理。 9. 根据权利要求 8 所述的泵车间臂架姿态防碰撞检测方法， 其特征在于 ： 若根据某一 预测时刻臂架的姿态信息得出的不同泵车间臂架距离值小于或等于安全距离值， 则发出警 示信息， 将安全运动时间记录下来， 以此作为操作员安全操作臂架运动的依据。 10. 泵车间臂架姿态防碰撞检测系统， 其特征在于， 该检测系统分别应用于至少两台泵 车上， 包括 ： 姿态感知单元， 包括信息获取子单元和姿态拟合子单元， 用于获取泵车间各臂架的多 个臂节姿态信息 ； 趋势判断单元， 用于根据姿态感知单元所获信息， 进行判断各臂架的多个臂节运动趋 势 ； 处理单。
9、元， 包括姿态信息转换子单元和预处理子单元， 用于根据臂架姿态信息、 趋势信 息来判断在未来多个时刻不同泵车间臂架所处相对姿态的安全与否 ； 报警单元， 与处理单元相连， 根据处理单元的输出信息做出相应的报警处理 ； 此外该检测系统的检测方法为权利要求 1 20 任一所述的检测方法。 权 利 要 求 书 CN 104236618 A 3 1/11 页 4 泵车间臂架姿态防碰撞检测方法及系统 技术领域 0001 本发明涉及泵车臂架姿态检测领域， 特别是涉及一种泵车间臂架姿态防碰撞检测 方法及系统。 背景技术 0002 随着城市化的发展， 泵车因其机动、 灵活、 高效等优点， 已成为诸多现代化建设。
10、中 不可缺少的重要施工设备。在泵车的操作过程中， 操作员往往只能根据自身操作经验目测 障碍物及目标的位置来操作臂架展开， 或者是通过使用对讲机以语音交流的方式在指挥员 的指挥下操作臂架展开。然而， 随着泵车的操作环境越来越复杂恶劣， 臂架越来越长， 加之 其臂节臂架个数增多， 经常出现操作员难以或不能目测到臂架位置及其周边的情况， 且语 音方式进行交流时信息量有限且缺乏准确性， 使操作员与指挥员之间的交流难以准确协 调， 容易导致操作员误操作， 造成安全事故， 故而泵车臂架的安全性操作显得尤为重要。 0003 目前， 对臂架全问题的研究主要是针对单台泵车， 一般采用红外线或激光传感器 对臂架与。
11、周边障碍物以及臂架与施工现场底部或顶部进行实时距离检测， 根据距离来判断 臂架的安全性， 如中国发明专利申请 CN 102621993A 公开了一种臂架控制系统， 包括 ： 高度 检测单元， 用于实时检测臂架的高度信息， 并根据高度信息获取最高位置高度 ； 判断单元， 用于根据最高位置高度， 判断臂架的运动趋势 ； 控制单元， 根据臂架的最高位置高度、 运动 趋势及预定的高度阀值控制臂架的运动。 但由于红外或激光传感器所发射的红外线或激光 被臂架本身所阻挡， 臂架与障碍物的碰撞信息检测可能不准确， 所以中国发明专利申请 CN 102032883A 公开了一种利用了声音在固体中的传播来检测碰撞位。
12、置点的系统和方法， 该检 测系统包括 ： 传感系统， 至少包括一个位于机械装置的臂架的第一位置的第一噪声传感器 和一个位于机械装置的臂架的第二位置的第二噪声传感器 ； 中央控制单元， 与传感系统连 接， 接收传感系统感测的噪声信号， 根据第一噪声传感器和第二噪声传感器所接收到的时 间差来判断臂架与障碍物的碰撞位置点。 0004 然而， 在大型工程和群体工程越来越多的大规模基础建设中， 单台泵车已经无法 满足施工需要， 为了保证施工中对作业工程的全部覆盖以及工作效率， 必然会出现多台泵 车共同作业的情况， 此时臂架的姿态信息对于泵车间臂架的安全检测就显得尤为重要。但 就目前基于红外线或激光传感器。
13、的实时距离检测方法不适用于多台泵车间的臂架姿态的 安全检测， 因为多臂节臂架的折叠式放置会使得红外线或激光更容易被泵车本身的臂节所 阻挡， 因而无法及时的对不同泵车间的臂架所处相对姿态的安全与否进行检测 ； 并且现有 的基于各类角度传感器的臂架姿态获取方法由于传感器本身以及计算过程累计误差的影 响已经难以满足智能化和安全化的要求。现有技术中， 也出现了一些防碰撞算法或防碰撞 预警系统相关专利， 如基于包围盒技术的机械臂碰撞检测算法， 但该算法主要是实现机械 手臂对虚拟物体的抓取动作， 针对此刻机械手臂与虚拟物体的位置关系进行碰撞判断， 无 法预先对其之间的动作进行碰撞预测 ； 又如中国实用新型。
14、专利 CN 202558512U 公开了一种 塔群防撞监控系统， 包括多个防撞监控子系统， 每个防撞监控子系统分别设置在塔群内的 说 明 书 CN 104236618 A 4 2/11 页 5 一个塔机上， 每个防撞监控子系统包括微处理器、 时钟、 传感器单元、 无线传输单元、 键盘、 显示器和报警电路 ； 其中， 防撞监控子系统的时钟的时间信息输出端连接微处理器的时间 信息输入端， 传感器单元的采集信号输出端连接微处理器的采集信号输入端， 键盘的预置 信号输出端连接微处理器的预置信号输入端， 微处理器的显示信号输出端连接显示器的显 示信号输入端， 微处理器的报警信号输出端连接报警电路的报警信。
15、号输入端， 无线传输单 元的传输控制信号输入输出端连接微处理器的传输控制信号输出输入端， 所有防撞监控子 系统的无线传输单元之间通过无线通信的方式进行数据传输。 上述专利虽然公开了塔群的 防撞技术， 但其只是针对多台设备的单个臂架进行预警， 不适用于大型工程或群体工程对 多台泵车间多个臂架的防碰撞预警。 0005 因此， 现在迫切需要提出一种泵车间的臂架姿态防碰撞检测方法及系统， 以提高 群体作业时臂架的安全性， 进而有效降低事故的发生率。 发明内容 0006 针对现有技术存在的上述问题， 本发明的目的是提供一种泵车间臂架姿态防碰撞 检测方法， 适用于泵车群体作业时检测其安全性， 进而降低事故。
16、的发生率。 0007 为实现上述发明目的， 本发明采用的技术方案如下 ： 0008 一种泵车间臂架姿态防碰撞检测方法， 泵车为两台或两台以上， 包括如下步骤 ： 0009 步骤 a) 获取泵车间各臂架的多个臂节姿态信息 ； 0010 步骤 b) 根据步骤 a) 所获信息， 判断各臂架的多个臂节运动趋势 ； 0011 步骤 c) 根据步骤 a) 和步骤 b) 的信息， 将各臂架的多个臂节姿态信息设于同一参 考系后， 再计算各臂架的多个臂节姿态信息和距离值 ； 0012 步骤 d) 根据步骤 c) 的计算值进行预警处理。 0013 优选地， 步骤 a) 的具体操作为 ： 获取距离信息， 将获取的距。
17、离信息拟合成臂架姿 态信息。 0014 距离信息定义 ： 臂架各臂节端点到泵车车体上多个不同位置节点间的距离值。 0015 臂架姿态信息定义 ： 参考方向到转台和臂架末端点在转台平面映射点连线的夹角 及该连线的长度以及臂架末端点到转台平面的距离， 其中从转台出发沿泵车车尾方向为参 考方向。 0016 更优选地， 距离信息可通过安装在各臂节端点的未知节点与泵车车体上的已知节 点来获得。 0017 更优选地， 姿态信息的拟合过程在安装于泵车转台处的中心节点 ( 即簇头 ) 内进 行。 0018 优选地， 步骤 b) 的具体操作为 ： 通过对多个连续的臂架的历史姿态信息进行分 析， 判断其运动趋势。。
18、 0019 更优选地， 臂架的运动趋势可通过选定某一臂节末端点运动时的多个连续的姿态 信息相对转台平面的高度 h 为主要依据进行判断 ； 具体来说 ： 当 h 值呈现增大的趋势， 则可 以判断该节臂节的后续运动呈展开趋势 ； 当 h 值呈现减小的趋势， 则可以判断该节臂节的 后续运动呈闭合趋势。 0020 优选地， 步骤 c) 的具体操作为 ： 将至少两台泵车各自臂架的姿态信息转换到同一 说 明 书 CN 104236618 A 5 3/11 页 6 参考系中， 根据同一参考系中臂架的当前姿态信息、 趋势信息计算出臂架在未来多个时刻 的姿态信息和不同泵车间各臂架的距离值。 0021 更优选地，。
19、 所述臂架姿态信息转换公式为 ： 0022 0023 其中， 定义 W 为泵车转台的中心点， 从转台 (W) 出发沿泵车车尾方向 (V) 作为参 考方向W0-V0和 W-V 表示两台不同泵车 ( 如泵车 0 和泵车 1) 的参考系， (r,a,h) 为 (r0,a0,h0) 转换到 W-V 中的姿态信息， (r0,a0,h0) 为泵车 0 某测量点在 W0-V0参考系中的姿 态信息 ； 为与的夹角， 可通过事先标定得到， 若 V0绕 h 轴逆时针旋转到 V， 则 为正， 反之为负 ； (rQ,aQ,hQ) 为 W0在 W-V 中的姿态信息。 0024 更优选地， 在未来 t 时刻臂架姿态信息的。
20、计算公式为 ： 0025 0026 其中， (rBi,aBi,hBi) 为第 i 节臂节末端在 t 时刻的姿态信息 ； (rAi-1,aAi-1,hAi-1) 和 (rAi,aAi,hAi)分别表示第i-1节臂节和第i节臂节在当前时刻的姿态信息， 可通过姿态感知 单元获取 ； i为第 i 节臂节的角速度， 当预测运动趋势竖直展开 ( 即向上 ) 时 i 0， 反 之， i 0。 0027 进一步， 当得到第 i 节臂节在 t 时刻的姿态信息后， 且第 i 节臂节不是最后一节， 则随着该臂节而运动的第 i+1 臂节末端的姿态信息 (rBi+1,aBi+1,hBi+1) 计算公式为 ： 0028 。
21、0029 其中， (rAi+1,aAi+1,hAi+1) 表示 i+1 臂节末端的当前时刻的姿态信息， 可通过姿态感 知单元获取， 各臂节在 t 时刻的姿态信息构成了整个臂架的姿态信息。 0030 判断或计算不同泵车间各臂架的距离值， 通过将结构相似的泵车臂架的各臂节看 做是中间部分半径为D的圆柱体， 两端部分半径为d的半球体模型， 从而不同泵车臂架间的 各臂节的距离可由根据空间两线段间距离求解方法求出的同一参考系中臂节模型中心轴 线的距离值与对应臂节模型参数之差所决定。 0031 优选地， 步骤 d) 的具体操作为 ： 判断不同泵车间各臂架所处相对姿态是否安全， 做出相应的预警处理。 003。
22、2 判断所处相对姿态是否将会发生碰撞的标准是将所求的不同泵车臂架间的各臂 说 明 书 CN 104236618 A 6 4/11 页 7 节的距离值与所设安全距离进行比较。安全距离为 1 1.5 米， 当臂架间的各臂节的距离 值小于 1 米时， 为高危安全等级 ； 距离值为 1 1.5 米时， 为低危安全等级 ； 距离值大于 1.5 米时， 为安全等级。 0033 更优选地， 当某一预测时刻臂架姿态不安全时， 计算出从开始到该危险时刻的前 一时刻的总时间， 作为安全运动时间， 其中， 某一预测时刻姿态不安全包括不同泵车间至少 有一对臂节的相对姿态不安全。 0034 更优选地， 若根据某一预测时。
23、刻臂架的姿态信息得出的不同泵车间臂架距离值小 于或等于安全距离值， 则发出警示信息， 将安全运动时间记录下来， 以此作为操作员安全操 作臂架运动的依据。 0035 本发明的另一目的是提供一种泵车间臂架姿态防碰撞检测系统， 该泵车间臂架姿 态防碰撞系统采用上述检测方法解决在群体工程中存在的多台泵车的臂架作业面相互重 叠而引发的安全问题。 0036 泵车间臂架姿态防碰撞检测系统， 该检测系统分别应用于至少两台泵车上， 包 括 ： 0037 姿态感知单元， 包括信息获取子单元和姿态拟合子单元， 用于获取泵车间各臂架 的多个臂节姿态信息 ； 0038 趋势判断单元， 用于根据姿态感知单元所获信息， 进。
24、行判断各臂架的多个臂节运 动趋势 ； 0039 处理单元， 包括姿态信息转换子单元和预处理子单元， 用于根据臂架姿态信息、 趋 势信息来判断在未来多个时刻不同泵车间臂架所处相对姿态的安全与否 ； 0040 报警单元， 与处理单元相连， 根据处理单元的输出信息做出相应的报警处理 ； 0041 此外该检测系统的检测方法采用上述任一检测方法。 0042 优选地， 信息获取子单元用于获取距离信息， 即获取臂架各臂节端点到泵车车体 上多个不同位置点间的距离值。 0043 优选地， 姿态拟合子单元用于将上述所获取的距离信息拟合成为臂架姿态信息， 即拟合所得信息包括参考方向到转台和臂架末端点在转台平面映射点。
25、连线的夹角及该连 线的长度以及臂架末端点到转台平面的距离， 其中从转台出发沿泵车车尾方向为参考方 向。 0044 优选地， 姿态信息转换子单元用于将至少两台泵车各自臂架的姿态信息同步转换 到同一参考系中。 0045 优选地， 预处理子单元用于根据同一参考系中臂架当前姿态信息、 趋势信息来计 算出臂架在未来多个时刻的姿态信息， 并由此姿态信息计算出的不同泵车间各臂架的距离 值来判断其相对姿态是否安全。 0046 更优选地， 预处理子单元还包括当某一预测时刻臂架姿态不安全时， 计算出从开 始到该危险时刻的前一时刻的总时间， 作为安全运动时间。 0047 优选地， 报警单元在接收到处理单元发出的在未。
26、来某时刻的危险信息时， 发出报 警信号， 并记录安全运动时间， 以此作为操作员安全操作臂架运动的依据。 0048 更优选地， 报警信号为包括在未来某一时刻将要发生碰撞的具体臂节对信息， 换 言之， 即各臂节间的距离与安全距离间的比较结果。 说 明 书 CN 104236618 A 7 5/11 页 8 0049 相比现有技术， 本发明提供的泵车间臂架姿态防碰撞检测方法及系统具有以下有 益效果 ： 0050 1. 该检测方法及系统适用于大型工程或群体工程中多台泵车间臂架姿态的防碰 撞检测 ； 0051 2. 该检测方法及系统是基于测距值来拟合臂架姿态， 可以对多个未来时刻的臂架 所处姿态进行计算。
27、， 更加简便 ； 0052 3. 该检测方法及系统基于该姿态信息对未来不同时刻的泵车之间的臂架所处相 对姿态进行防碰撞检测， 避免了采用红外线或激光传感器时， 所发出的红外线或激光被泵 车本身的臂节所阻挡， 影响泵车之间的臂架姿态防碰撞检测的情况 ； 0053 4. 该检测方法及系统对多个未来时刻进行臂架姿态防碰撞检测， 从而在预先检测 到危险信息时， 可以计算并记录下安全运动时间， 以此作为操作员操作臂架安全运动的时 间依据 ； 0054 5. 该检测方法及系统根据当前时刻到未来某一时刻臂架发生危险的具体臂节信 息， 来提醒操作员对该发生危险的臂节进行相应控制， 从而提高群体作业时臂架的安全。
28、性， 进而有效降低事故的发生率。 0055 综上述， 本发明提供的泵车间臂架姿态防碰撞检测方法及系统可有效的解决现有 技术中针对泵车间臂架无法及时乃至提前获得有效的安全姿态信息等技术难题， 通过本发 明提供的检测方法和系统可精确的获得多个泵车间臂架的多个臂节的实时及趋势信息， 获 得相应的安全距离和安全操作时间， 提高群体作业时臂架的安全性， 进而有效降低事故的 发生率。 附图说明 0056 图 1 为本发明提供的泵车间臂架防碰撞检测方法的流程示意图 ； 0057 图 2 为本发明提供的泵车间臂架防碰撞检测方法及系统中的泵车臂架姿态信息 示意图 ； 0058 图 3 为本发明提供的泵车间臂架防。
29、碰撞检测方法及系统中相邻两泵车防碰撞简 化示意图 ； 0059 图 4 为本发明提供的泵车间臂架防碰撞检测方法及系统中不同泵车间臂架姿态 信息的转换示意图 ； 0060 图 5 为本发明提供的泵车间臂架防碰撞检测方法及系统中臂架在未来某一时刻 的姿态信息计算示意图 ； 0061 图 6 为本发明提供的泵车间臂架防碰撞检测方法及系统中泵车间臂架姿态防碰 撞检测系统的拓扑图 ； 0062 图7为本发明实施例1中两泵车在当前时刻与预测时刻所处相对姿态仿真模拟示 意图。 具体实施方式 0063 为了能够对本发明有进一步的理解， 下述内容以两台四节臂混凝土泵车为例， 结 合附图和实施例对本发明进行进一步。
30、详细说明。 说 明 书 CN 104236618 A 8 6/11 页 9 0064 本发明提供了一种泵车间臂架姿态防碰撞检测方法， 图 1 为该检测方法的流程示 意图， 如图 1 所示， 该方法具体包括以下步骤 ： 0065 步骤 a、 获取臂架的姿态信息 ： 0066 即在获取臂架姿态信息时， 首先获取至少两台泵车上各节点的距离信息， 其次将 所获取的距离信息拟合成臂架姿态信息。距离信息为臂架各臂节端点到泵车车体上多个 不同位置点间的距离值， 通过安装在各臂节端点的未知节点与泵车车体上的已知节点来获 得。 姿态信息包括参考方向到转台和臂架末端点在转台平面映射点连线的夹角及该连线的 长度以及。
31、臂架末端点到转台平面的距离， 其中从转台出发沿泵车车尾方向为参考方向 ； 该 姿态信息的拟合过程在安装于泵车转台处的中心节点 ( 即簇头 ) 内进行。 0067 图 2 为泵车臂架姿态信息构成示意图， 以转台中心 W 为原点， 从转台 (W) 出发沿泵 车车尾方向 (V) 作为参考方向则夹角 a 及长度 r 以及距离 h 构成了臂架姿态信息。 图 3 为相邻两泵车防碰撞简化示意图， 如图 3 所示， 两泵车均停靠在水平面上， 对于泵车 1， 其中 b0为转台， 标记为 W，为参考方向， b1、 b2、 b3、 b4为泵车 1 各臂节末端点 ； 泵车 0 的 转台标记为 W0，为参考方向。 00。
32、68 步骤 b、 根据所获取的臂架姿态信息判断臂架的运动趋势 ： 0069 通过得到泵车上各节点的历史姿态信息判断臂架的运动趋势， 如得到泵车 1 的第 一节臂节末端点 b1运动时的多个连续的姿态信息， 选定其相对转台平面的高度值 h 为主要 依据， 如果这些值呈现增大的趋势， 则可以判断第一节臂节的后续运动呈展开趋势， 如果这 些值呈现减小的趋势， 则可以判断第一节臂节的后续运动呈闭合趋势。连续采取两个时刻 b1 的姿态信息， 则可以根据姿态信息得到 b1相对于转台平面的高度值 h1和 h2， 若 h2-h1 0， 则判断后续运动呈展开趋势， 反之， 则判断后续运动呈闭合趋势。 0070 步。
33、骤 c、 根据臂架姿态信息及趋势信息来判断在未来多个时刻不同泵车间臂架所 处相对姿态的安全与否。 0071 该过程可以分为三步进行 ： 0072 第一步， 将至少两台泵车各自臂架的姿态信息转换到同一参考系中 ； 如图 4 所示 为不同泵车间臂架姿态信息的转换示意图。设 W0和 W 分别为泵车 0 和 1 转台的中心点， 和分别为其参考方向 ； 则 W0-V0中一测量点 P0(r0,a0,h0) 转换到 W-V 中的姿态信息 的计算公式为 ： 0073 0074 其中， Q(rQ,aQ,hQ) 为 W0在 W-V 下的姿态信息 , 可通过泵车 1 车体上的 4 个节点对 泵车0转台处的簇头进行测。
34、距， 在泵车1的簇头内进行姿态拟合得到 ； 为与的夹 角， 可通过事先标定得到， 若 V0绕 h 轴逆时针旋转到 V， 则 为正， 反之为负。 说 明 书 CN 104236618 A 9 7/11 页 10 0075 第二步， 根据同一参考系中臂架当前姿态信息、 趋势信息来计算出臂架在未来多 个时刻的姿态信息， 并由此姿态信息计算出的不同泵车间各臂架的距离值来判断其相对姿 态是否安全。当某一预测时刻臂架姿态不安全时， 计算出从开始到该危险时刻的前一时刻 的总时间， 作为安全运动时间。某一预测时刻姿态不安全包括不同泵车间至少有一对臂节 的相对姿态不安全。 0076 在泵车0和泵车1间各自的当前。
35、臂架姿态信息通过置于泵车车体上的簇头进行无 线通信传输与同步转换后， 对处于同一参考系中的两泵车的臂架在未来时刻所处姿态信息 进行计算。图 5 为臂架在未来某一时刻的姿态信息计算示意图， 如图 5 所示， 若泵车 1 第 2 节臂节运动 ( 即 i 2)， 在运动趋势上的未来时刻 t 的姿态信息的计算公式为 ： 0077 0078 其中， (rB2,aB2,hB2) 为第 2 节臂节末端 (b2) 在 t 时刻的姿态信息， (rA1,aA1,hA1) 和 (rA2,aA2,hA2) 分别表示第 1 节臂节末端 (b1) 和第 2 节臂节末端 (b2) 在泵车 1 的 W-V 中的当 前时刻的姿。
36、态信息， 可通过姿态感知单元获得 ； 2为第 2 节臂节的角速度， 当预测运动趋 势竖直展开 ( 即向上 ) 时 2 0， 反之， 2 0。当得到第 2 节臂节的姿态信息， 随着该 臂节而运动的第 3 臂节末端 (b3) 的姿态信息 (rB3,aB3,hB3) 和第 4 臂节末端 (b4) 的姿态信 息 (rB4,aB4,hB4) 计算公式为 ： 0079 0080 0081 其中， (rA3,aA3,hA3) 和 (rA4,aA4,hA4) 分别表示第 3 臂节和第 4 臂节末端 (b3、 b4) 的 当前时刻的姿态信息。此时对臂节 2 在 t 时刻姿态信息进行计算时， 将得到泵车 1 在 。
37、t 时 刻的整体臂架姿态信息。由此， 以 t 为时间间隔时， 可计算出 t1、 t2、 t3、 t4等多个未来时 刻的臂架姿态信息。 0082 第三步， 由上述方法得到两泵车臂架未来某一时刻的姿态信息， 计算出泵车 0 臂 架与泵车 1 臂架之间的距离。由于泵车臂架各臂节的结构相似， 根据上述姿态信息计算距 离可将其分解为泵车 0 和 1 之间的臂节对的距离求解。 0083 以下对一种优选的臂节对的距离求解方法作简要说明 ： 0084 已知臂节 S1和 S2， E1(rE1,aE1,hE1)、 Q1(rQ1,aQ1,hQ1) 为 S1的中心轴线始端和末端 的姿态信息， E2(rE2,aE2,h。
38、E2)、 Q2(rQ2,aQ2,hQ2) 为 S2的中心轴线始端和末端姿态信息， 求解 距离的前提条件是知道两臂节中心轴线上距离最近时的点的信息。求解臂节 S1中心轴 说 明 书 CN 104236618 A 10 8/11 页 11 上任意一点信息的相关方程为 ： S1(s) E 1+sd1， 其中 d1 Q1-E1,0 s 1， Q 1(rQ1cosaQ1,rQ1sinaQ1,hQ1)， E1(rE1cosaE1,rE1sinaE1,hE1) ； 求解臂节 S2中心轴线上 任意一点信息的相关方程为 ： S2(t) E 2+td2， 其中 d2 Q2-E2,0 t 1， Q2(rQ2cosa。
39、Q2,rQ2sinaQ2,hQ2)， E2(rE2cosaE2,rE2sinaE2,hE2)。 采用高斯消元法求解得出s、 t 的简化表达式为 ： s (b*t-c)/a,t (b*s+f)/e。其中， a d1 d1， b d1 d2， c d1 r， e d2d2， f d2r， r E 1-E2。当 a*e-b*b 0 时， s 0， 否则 s (b*f-c*e)/ (a*e-b*b)， 若 s 值满足 (0,1)， 则将其带入上述求 t 的公式， 否则选择最接近 s 的值 0 或者 1 带入求 t 的公式。若所求 t 值满足 (0,1)， 则将 s、 t 值带入求臂节上任意一点信息的相。
40、关 方程进行求解 ； 若所求 t 值不满足 (0,1)， 则选择最接近 0 或者 1 的值为 t 值， 并将其带入 上述变量为 t 的求 s 的公式， 若 s 不满足 (0,1) 则选择最接近 0 或者 1 的值为 s 值， 否则所 求即为s值， 将此时的s、 t值带入求臂节中心轴线上任意一点信息的相关方程进行求解， 得 出两臂节中心轴线距离最近时的两点的姿态信息， 通过该信息可求出此时的距离 L， 该 L 与 对应臂节模型参数之差即为臂节对的距离。 0085 结合臂架的圆柱模型结构假设 D 为臂节中间部分半径， d 为两端半球半径， 以及所 设定的安全距离 Ls， 当 s、 t 值均满足 (。
41、0,1) 时， 在未来某一时刻臂架所处姿态的臂节中心 轴间的距离 L 小于或等于泵车 1 臂节的 D 与泵车 0 臂节的 D 与 Ls 之和， 则说明该时刻所处 姿态不安全 ； 当 s、 t 值均不满足 (0,1)， 在未来某一时刻臂架所处姿态的臂节中心轴间的距 离 L 小于或等于泵车 1 臂节的 d 与泵车 0 臂节的 d 与 Ls 之和， 则说明该时刻所处姿态不安 全 ； 当 s、 t 值中有一个不满足 (0,1)， 在未来某一时刻臂架所处姿态的臂节中心轴间的距离 L 小于或等于泵车 1 臂节的 d 与泵车 0 臂节的 D 与 Ls 之和或泵车 1 臂节的 D 与泵车 0 臂 节的 d 与。
42、 Ls 之和， 则说明该时刻所处姿态不安全。对泵车 0 和 1 之间的臂架在某时刻进行 防碰撞检测时， 只要有一组臂节不安全， 则整个臂架在即将运动到的时刻所处姿态不安全。 对于 t1、 t2、 t3、 t4等多个未来时刻， 若在 t4时刻时姿态不安全， 则此时的安全运动时间可为 2t。 0086 步骤 d、 根据计算结果进行预警处理 ： 0087 当判断出某一预测时刻臂架姿态不安全时， 发出报警信息， 并计算出从开始到该 危险时刻的前一时刻的总时间， 作为安全运动时间， 操作人员可以此作为操控臂架安全运 动的依据 ； 其中， 某一预测时刻姿态不安全包括不同泵车间至少有一对臂节的相对姿态不 安。
43、全。其中若所设定的安全距离 Ls 有不同的级别， 则此时所发出的报警信号则根据级别的 不同发出不同的提示音， 并且可根据在当前时刻到未来某一时刻臂架发生危险的具体臂节 信息， 来提醒操作员对该发生危险的臂节进行相应控制。 0088 因为不同泵车臂架的姿态信息所处的参考系不同， 所以在对未来某一时刻两泵车 间臂架所处相对姿态进行防碰撞检测时， 必须将不同泵车的臂架姿态信息进行同步转换至 同一参考系中， 所说的参考系可以是其中一台泵车所在的系， 不同泵车间各自的臂架姿态 信息可以通过置于泵车车体上的簇头进行无线通信传输与同步转换。 泵车臂架是由多节臂 节组成， 若某一臂节运动， 且该臂节不是臂架的。
44、最后一节， 则得到该臂节在未来某一时刻的 姿态信息时， 还需要计算出随着该臂节而运动的其它臂节的姿态信息， 从而得到臂架的整 体姿态信息， 进而对两台泵车间臂架进行距离计算， 由此来判断两泵车所处相对姿态是否 安全。 说 明 书 CN 104236618 A 11 9/11 页 12 0089 图6为本发明提供的泵车间臂架姿态防碰撞检测系统的拓扑图， 如图6所示， 该泵 车间臂架姿态安全检测系统 11 应用于至少两台泵车上， 包括 ： 姿态感知单元 111、 趋势判断 单元 112、 处理单元 113 以及报警单元 114。 0090 姿态感知单元 111 用于获取臂架的姿态信息， 包括信息获。
45、取子单元 111A， 用于获 取臂架各臂节端点到泵车车体上多个不同节点间的距离值 ； 姿态拟合子单元 111B， 用于将 上述所获取的测距值拟合成为臂架姿态信息。其中， 距离信息可通过安装在各臂节端点的 未知节点与泵车车体上 4 个已知节点来获得， 可采用到达时间差 (TOA， Time of Arrival) 来获取， 所说 4 个已知节点不能布置在同一水平面上。并且姿态信息的拟合过程可在簇头 内进行， 所说簇头是指安装在泵车转台处的中心节点。感知的信息除了泵车自身臂架端点 的姿态信息还包括相邻泵车簇头在该泵车中的姿态信息。 0091 趋势判断单元 112 用于根据所获取的臂架姿态信息， 判。
46、断臂架的运动趋势。可以 根据姿态感知单元 111 得到多个连续的臂架姿态信息， 通过对这些姿态信息进行分析来判 断其运动趋势。 可以选定与转台平面的距离值为主要依据， 对这些值进行分析 ： 如果这些值 呈现增大的趋势， 则可以判断臂架的后续运动呈展开趋势 ； 如果这些值呈现减小的趋势， 则 可以判断臂架的后续运动呈闭合趋势， 否则， 则判断臂架无运动趋势。 0092 处理单元 113 用于根据臂架姿态信息、 趋势信息来判断在未来多个时刻不同泵车 间臂架所处相对姿态的安全与否， 包括姿态信息转换子单元 113A， 用于将至少两台泵车各 自臂架的姿态信息同步转换到同一参考系中 ； 预处理子单元 1。
47、13B， 用于根据同一参考系中 臂架当前姿态信息、 趋势信息来计算出臂架在未来多个时刻的姿态信息， 并由此姿态信息 计算出的不同泵车间各臂架的距离值来判断其相对姿态是否安全。其中， 预处理子单元还 包括当某一预测时刻臂架姿态不安全时， 计算出从开始到该危险时刻的前一时刻的总时 间， 作为安全运动时间。某一预测时刻姿态不安全包括不同泵车间至少有一对臂节的相对 姿态不安全。 0093 报警单元 114， 与处理单元相连， 根据处理单元的输出信息做出相应的处理。在接 收到处理单元发出的在未来某时刻的危险信息时， 发出报警信号， 并将安全时间记录下来， 以此作为操作员安全操作臂架运动的依据。其中若所设。
48、定的安全距离 Ls 有不同的级别， 则 此时所发出的报警信号则根据级别的不同发出不同的提示音， 并且可根据在当前时刻到未 来某一时刻臂架发生危险的具体臂节信息， 来提醒操作员对该发生危险的臂节进行相应控 制。 0094 将上述检测系统分别应用至泵车间， 并采用上述检测方法对泵车间臂架进行仿真 防碰撞检测， 具体结果如实施例 1 中表 1 4 所示。 0095 实施例 1 0096 预设同一工地上的两台型号相同的泵车 (BC0 和 BC1)， 其结构参数为 ： 整车全长 11.520 米、 全宽 2.5 米、 全高 3.990 米 ； 臂架垂直高度 40.3 米、 水平长度 38.8 米、 垂直。
49、深度 26.8 米、 最小展开高度 11.8 米 ； 第一节臂长度 8.170 米、 第二节臂长度 6.820 米、 第三节臂 长度 6.825 米、 第四节臂长度 8.460 米、 转台旋转角度 270； 安全距离为 1.5 米。图 7 为 此两泵车的防碰撞仿真示意图， 如图 7 所示， 其中包括当前时刻和未来 4s 时刻的两泵车臂 架所处的相对姿态。通过上述检测方法及系统分别获得并计算 BC1 和 BC0 的当前时刻的各 自臂架姿态信息 (r,a,h)， 计算结果见表 1 ： 说 明 书 CN 104236618 A 12 10/11 页 13 0097 表 1 0098 BC1BC0BC0-BC1 转台(。