工程机械以及控制工程机械的机械臂的方法、装置和系统.pdf

上传人:1** 文档编号:127790 上传时间:2018-01-27 格式:PDF 页数:16 大小:521.88KB
返回 下载 相关 举报
摘要
申请专利号:

CN201110197808.X

申请日:

2011.07.14

公开号:

CN102360223A

公开日:

2012.02.22

当前法律状态:

授权

有效性:

有权

法律详情:

授权|||实质审查的生效IPC(主分类):G05D 3/00申请日:20110714|||著录事项变更IPC(主分类):G05D 3/00变更事项:申请人变更前:长沙中联重工科技发展股份有限公司变更后:中联重科股份有限公司变更事项:地址变更前:410013 湖南省长沙市岳麓区银盆南路361号变更后:410013 湖南省长沙市岳麓区银盆南路361号|||公开

IPC分类号:

G05D3/00; E04G21/04

主分类号:

G05D3/00

申请人:

长沙中联重工科技发展股份有限公司

发明人:

易伟春; 王帅; 李学俊; 李昱; 李葵芳; 李仁玉

地址:

410013 湖南省长沙市岳麓区银盆南路361号

优先权:

专利代理机构:

北京康信知识产权代理有限责任公司 11240

代理人:

吴贵明

PDF下载: PDF下载
内容摘要

本发明提供了一种工程机械以及控制工程机械的机械臂的方法、装置和系统,用以解决现有技术中对于多级臂机械臂的操作存在操作繁琐、操作人员劳动强度较大的问题。该方法包括:接收对机械臂进行遥控操作时的操作方向的信息,由该操作方向确定遥控驱动方向;按照遥控驱动方向、获取的机械臂姿态数据、预设的选臂方式和机械臂的目标姿态确定机械臂的运动内容,所述运动内容包括机械臂是否回转、机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值;按机械臂的运动内容对机械臂进行控制。使用本发明的技术方案,有助于降低操作机手的劳动强度,同时能够提高机械臂位置移动的准确性和效率。

权利要求书

1: 一种控制工程机械的机械臂的方法, 其特征在于, 包括 : 接收对所述机械臂进行遥控操作时的操作方向的信息, 由该操作方向确定遥控驱动方 向; 按照所述遥控驱动方向、 获取的机械臂姿态数据、 预设的选臂方式和所述机械臂的目 标姿态确定所述机械臂的运动内容, 所述运动内容包括机械臂是否回转、 机械臂运动时的 运动臂节及运动臂节的自由度所对应的夹角的变化值 ; 按所述机械臂的运动内容对所述机械臂进行控制。
2: 根据权利要求 1 所述的方法, 其特征在于, 所述由该操作方向确定遥控驱动方向包 括: 确定所述机械臂的控制起始方向 ; 根据所述控制起始方向和所述操作方向的夹角确定遥控驱动方向。
3: 根据权利要求 1 所述的方法, 其特征在于, 所述由该操作方向确定遥控驱动方向包 括: 获取以参考基准方向为始边、 所述操作方向为终边, 按预定的转动正方向所成的夹角 的大小 ; 将与所述参考基准方向按所述转动正方向成所述夹角的大小的方向作为遥控驱动方 向。
4: 根据权利要求 1 所述的方法, 其特征在于, 所述机械臂姿态数据包括各臂节的斜率 ; 所述预设的选臂方式包括 : 选择两个臂节, 使所述机械臂以所选两个臂节为运动臂运 动到达所述目标姿态后斜率发生改变的节臂的数目最小。
5: 根据权利要求 4 所述的方法, 其特征在于, 所述机械臂姿态数据包括各臂节的斜率 ; 所述预设的选臂方式包括 : 选择所有斜率为正的臂节中最靠近所述机械臂末端的臂 节, 并且选择所有斜率为负的臂节中最靠近所述机械臂末端的臂节。
6: 根据权利要求 1 所述的方法, 其特征在于, 所述机械臂姿态数据包括各组相邻两个臂节之间的转折程度 ; 所述预设的选臂方式包括 : 在所述机械臂作伸展运动时, 选择转折程度最大的两个臂 节, 在所述机械臂作收缩运动时, 选择转折程度最小的两个臂节。
7: 一种控制工程机械的机械臂的装置, 其特征在于, 包括 : 接收设备, 用于接收对所述机械臂进行遥控操作时的操作方向的信息 ; 第一确定设备, 用于由所述操作方向确定遥控驱动方向 ; 第二确定设备, 用于按照所述遥控驱动方向、 获取的机械臂姿态数据、 预设的选臂方 式和所述机械臂的目标姿态确定所述机械臂的运动内容, 所述运动内容包括机械臂是否回 转、 机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值 ; 控制设备, 用于按所述机械臂的运动内容对所述机械臂进行控制。
8: 根据权利要求 7 所述的装置, 其特征在于, 所述第一确定设备还用于确定所述机械 臂的控制起始方向, 根据所述控制起始方向和所述操作方向的夹角确定遥控驱动方向。
9: 根据权利要求 7 所述的装置, 其特征在于, 所述第一确定设备还用于获取以参考基 准方向为始边、 所述操作方向为终边, 按预定的转动正方向所成的夹角的大小 ; 将与所述参 2 考基准方向按所述转动正方向成所述夹角的大小的方向作为遥控驱动方向。
10: 根据权利要求 7 所述的装置, 其特征在于, 所述第二确定设备还用于保存所述机械 臂各臂节的斜率的数据, 以及选择两个臂节, 使所述机械臂以所选两个臂节为运动臂运动 到达所述目标姿态后斜率发生改变的节臂的数目最小。
11: 根据权利要求 10 所述的装置, 其特征在于, 所述第二确定设备还用于选择所有斜 率为正的臂节中最靠近所述机械臂末端的臂节, 并且选择所有斜率为负的臂节中最靠近所 述机械臂末端的臂节。
12: 根据权利要求 7 所述的装置, 其特征在于, 所述第二确定设备还用于保存所述机械 臂的各组相邻两个臂节之间的转折程度的数据, 在所述机械臂作伸展运动时, 选择转折程 度最大的两个臂节, 在所述机械臂作收缩运动时, 选择转折程度最小的两个臂节。
13: 一种控制工程机械的机械臂的系统, 其特征在于, 包括 : 遥控操作系统, 用于发出对所述机械臂进行遥控操作时的操作方向的信息 ; 机械臂姿态监测系统, 用于获取机械臂姿态数据 ; 控制设备, 包括权利要求 7 至 12 中任一项所述的机械臂控制装置。
14: 一种工程机械, 具有机械臂, 其特征在于, 所述工程机械具有权利要求 13 所述的控 制工程机械的机械臂的系统。

说明书


工程机械以及控制工程机械的机械臂的方法、 装置和系统

    技术领域 本发明涉及工程机械技术领域, 特别地涉及一种工程机械以及控制工程机械的机 械臂的方法、 装置和系统。
     背景技术 目前, 多级臂机械臂被广泛应用于工程机械领域。 其中比较典型的有混凝土泵车、 混凝土布料机等混凝土机械的机械臂。这类机械臂具有如下特点 : 臂节数大于等于 3 节, 相邻臂节采用转轴进行连接, 每个臂节通过液压油缸推动可绕转轴在有限的角度范围内旋 转。 机械臂通过回转台固定在汽车底盘或布料塔上, 并可绕垂直于固定底座平面的轴作 360 度旋转。 工作时, 通过遥控装置控制臂节及转台的旋转以控制机械臂末端位置, 完成混凝土 布料工作。
     以图 1 所示的五级臂混凝土泵车机械臂结构为例, 来详细说明这类机械臂的结构 组成及操作。 图 1 是具有五个臂节的机械臂的基本结构的示意图。 图 1 中示出了如下部件 : 回转台 1, 机械臂油缸 2, 一臂 3, 二臂 4, 三臂 5, 四臂 6, 五臂 7, 软管 8, 连杆 9, 转轴 10, 倾角
     传感器 11。
     如图 1 所示, 回转台 1 固定在汽车底盘机架上, 通过减速机 ( 图上未示出 ) 驱动, 带动机械臂绕回转轴作 0 至 360 度旋转。一臂 3 与回转台 1 采用转轴 10 铰接, 通过连接在 回转台和一臂上的液压油缸 2 的伸缩运动, 实现其绕转轴作 0-90 旋转。一臂 3、 二臂 4、 三 臂 5、 四臂 6、 五臂 7 之间同样采用转轴 10 铰接, 通过油缸 2 的伸缩运动驱动连杆 9 使臂节 绕转轴在一定的角度范围内旋转, 实现机械臂的展、 收。液压油缸 2 及减速机采用多摇杆遥 控器进行控制。 遥控器接收机接收到发射机发出的摇杆位置信号后直接输出或通过控制器 输出相应比例的电流信号, 控制机械臂多路阀的动作方向及开度, 进而控制机械臂相应臂 节的展、 收或回转方向以及动作速度。
     对于五臂节机械臂系统, 通常采用六摇杆遥控器进行操作, 其中第一个摇杆控制 机械臂回转, 第二至六摇杆分别控制一至五臂。以混凝土泵车为例, 在实际施工过程中, 操 作机手通过操作遥控器相应摇杆控制相应臂节及回转台动作, 进行机械臂姿态和回转角度 的调整, 最终实现将机械臂末端的浇注软管 8 移动到需要浇注混凝土的区域上方, 进行混 凝土浇注。对于目前常见的采用此种单臂节控制方式的机械臂控制系统, 要想将机械臂末 端从一点移动到另一点且保持移动过程中高度不变, 至少需要同时操作两臂节, 有时还需 要加入回转操作, 操作繁琐, 对于经验较少的操作机手来说是一个不小的挑战。同时, 在操 作过程中, 机手必需根据现场情况判断该动哪几臂节, 以及臂节的移动方向, 使操作人员的 劳动强度较大。
     在现有技术中, 对于多级臂机械臂的操作存在操作繁琐、 操作人员劳动强度较大 的问题, 尚未提出有效解决方案。 发明内容本发明的主要目的是提供一种工程机械以及控制工程机械的机械臂的方法、 装置 和系统, 以解决现有技术中对于多级臂机械臂的操作存在操作繁琐、 操作人员劳动强度较 大的问题。
     为解决上述问题, 根据本发明的一个方面, 提供了一种控制工程机械的机械臂的 方法。
     本发明的控制工程机械的机械臂的方法包括 : 接收对所述机械臂进行遥控操作时 的操作方向的信息, 由该操作方向确定遥控驱动方向 ; 按照所述遥控驱动方向、 获取的机械 臂姿态数据、 预设的选臂方式和所述机械臂的目标姿态确定所述机械臂的运动内容, 所述 运动内容包括机械臂是否回转、 机械臂运动时的运动臂节及运动臂节的自由度所对应的夹 角的变化值 ; 按所述机械臂的运动内容对所述机械臂进行控制。
     根据本发明的另一方面, 提供了一种控制工程机械的机械臂的装置。
     本发明的控制工程机械的机械臂的装置包括 : 接收设备, 用于接收对所述机械臂 进行遥控操作时的操作方向的信息 ; 第一确定设备, 用于由所述操作方向确定遥控驱动方 向; 第二确定设备, 用于按照所述遥控驱动方向、 获取的机械臂姿态数据、 预设的选臂方式 和所述机械臂的目标姿态确定所述机械臂的运动内容, 所述运动内容包括机械臂是否回 转、 机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值 ; 控制设备, 用于 按所述机械臂的运动内容对所述机械臂进行控制。
     根据本发明的又一方面, 提供了一种控制工程机械的机械臂的系统。
     本发明的控制工程机械的机械臂的系统包括 : 遥控操作系统, 用于发出对所述机 械臂进行遥控操作时的操作方向的信息 ; 机械臂姿态监测系统, 用于获取机械臂姿态数据 ; 控制设备, 包括本发明的机械臂控制装置。
     根据本发明的又一方面, 提供了一种工程机械。
     本发明的工程机械具有机械臂, 还具有本发明的控制工程机械的机械臂的系统。
     根据本发明的技术方案, 在接收到操作人员通过一个控制手柄发送的操作方向的 信息后, 结合机械臂的姿态和预设的选臂方式确定机械臂的运动方式, 使得机械臂的整体 能够根据该操作方向的信息做出运动, 无需操作人员针对每个臂节分别进行遥控操作, 大 大简化了操作人员对机械臂进行遥控时的操作动作, 并减轻了操作人员的劳动强度。 附图说明
     说明书附图用来提供对本发明的进一步理解, 构成本申请的一部分, 本发明的示 意性实施例及其说明用于解释本发明, 并不构成对本发明的不当限定。在附图中 :
     图 1 是具有五个臂节的机械臂的基本结构的示意图 ;
     图 2 是根据本发明实施例的多级臂机械臂的控制系统基本结构的示意图 ;
     图 3 是根据本发明实施例的一种确定遥控驱动方向的示意图 ;
     图 4 是根据本发明实施例的确定遥控驱动方向的另一方式的示意图 ;
     图 5 是根据本发明实施例的确定遥控驱动方向的又一方式的示意图 ;
     图 6 是与本发明实施例有关的转角传感器安装位置的示意图 ;
     图 7 是与本发明实施例有关的倾角传感器安装位置的示意图 ;
     图 8 是与本发明实施例有关的一种选臂方案的示意图 ;图 9 是机械臂一部分臂节斜率为正、 另一部分臂节斜率为负的状态的示意图 ; 图 10 是机械臂除根部起第一臂以外的所有臂节的斜率为负的状态的示意图 ; 图 11 是与本发明实施例有关的机械臂产生多种姿态到达目标姿态的示意图 ; 图 12 是根据本发明实施例的控制工程机械的机械臂的装置的示意图 ; 以及 图 13 是根据本发明实施例中的控制工程机械的机械臂的系统的示意图。具体实施方式
     需要说明的是, 在不冲突的情况下, 本申请中的实施例及实施例中的特征可以相 互组合。下面将参考附图并结合实施例来详细说明本发明。
     图 2 是根据本发明实施例的控制工程机械的机械臂的方法的基本步骤示意图。如 图 2 所示, 本发明实施例的控制工程机械的机械臂的方法可由安装在工程机械上的控制设 备完成, 主要包括以下步骤 S21 至步骤 S27。
     步骤 S21 : 接收对机械臂进行遥控操作时的操作方向的信息。
     步骤 S23 : 根据该操作方向确定遥控驱动方向。
     步骤 S25 : 按照遥控驱动方向、 获取的机械臂姿态数据、 预设的选臂方式和机械臂 的目标姿态, 确定机械臂的运动内容。 本实施例中, 机械臂的运动内容主要包括机械臂是否 回转、 机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值。 步骤 S27 : 按机械臂的运动内容对机械臂进行控制。
     以下对本发明实施例的技术方案作进一步详细说明。
     步骤 S21 中的操作方向的信息的内容可以操作人员通过遥控器提供的机械臂末 端的移动方向。此时操作人员使用一个控制手柄, 通过该控制手柄给出针对机械臂末端的 移动方向。在步骤 S23 中确定遥控驱动方向时, 一种方式如图 3 所示, 图 3 是根据本发明实 施例的一种确定遥控驱动方向的示意图。
     如图 3 所示, 操作人员 31 手持遥控器 32 的控制手柄 321 进行操作以移动工程机 械 33 的机械臂 331 的布料点 332, 操作方向是以 OY 为起始按顺时针转到 OM 方向, 此时基于 机械臂伸展方向确定遥控驱动方向, 即遥控驱动方向以工程机械 33 的机械臂 331 延长线为 起始按顺时针转过上述以 OY 为起始按顺时针转到 OM 方向的角度, 从图 3 可以看出按上述 方式处理时, 对于站在 A 处的操作人员来说, 当需要使机械臂末端按箭头 34 移动时, 要将自 己想象成位于 B 位置, 然后按箭头 35( 与箭头 34 平行 ) 操作遥控手柄, 而不是直接按箭头 36 操作。
     从图 3 可以看出上述的遥控驱动方向对于操作人员来说需想象自己位于另外一 个位置, 操作不够直观。本实施例中给出一种更为直观的遥控驱动方向确定方式, 如图 4 所 示, 图 4 是根据本发明实施例的确定遥控驱动方向的另一方式的示意图。本实施例的这种 确定遥控驱动方向的方式中, 首先确定机械臂的控制起始方向, 再根据该控制起始方向和 操作方向的夹角确定遥控驱动方向。根据这种方式, 遥控器 42 上设置有一个坐标同步开关 421, 参考图 4, 操作人员 41 在操作时, 首先按住坐标同步开关并按照与机械臂 431 的延长 线的方向即箭头 44 平行的方向 ( 箭头 441) 拨动操作手柄, 此时遥控器将确认信息和操作 方向信息一并发往工程机械, 工程机械收到该确认信息后得知与该确认信息一并收到的操 作方向信息中包含的是控制起始方向即箭头 44, 从而并不立即按照该操作方向进行操作 ;
     接下来操作人员 41 操作遥控手柄, 例如操作方向为箭头 442, 控制起始方向 ( 箭头 441) 与 操作方向 ( 箭头 442) 成 α 角, 此时遥控驱动方向即确定为与箭头 44 成 α 角的箭头 444。 可以看出这种方式并不按与 Y 轴成 α 角的箭头 443 进行操作, 操作人员 41 在其位置对于 控制手柄的操作方向与机械臂末端 432 要移动的方向相一致, 因此对于操作人员 41 来说较 为直观、 方便。
     根据该方式, 易于确定机械臂是否回转以及是否伸展。 参考图 4, 当 α 角不为 0 或 360 度时, 表明机械臂需回转。当 α 角大于 0 度小于 90 度、 或者大于 270 度小于 360 度时 表明机械臂需伸展。当 α 角大于 90 度小于 270 度时表明机械臂需收缩。
     本实施例中再给出一种确定遥控驱动方向的方式。图 5 是根据本发明实施例的确 定遥控驱动方向的又一方式的示意图。在这种确定遥控驱动方向的方式中, 遥控器和工程 机械的本体需要有共认的参考基准方向, 可以在工程机械和遥控器中安装传感器来实现, 例如利用地磁原理的传感器、 利用陀螺仪原理的传感器 ; 利用光影原理的传感器等, 使遥控 器给出的关于方向的数据所依据的基准方向与工程机械的控制器在计算方向时依据的基 准方向相同, 参考图 5, 工程机械 51 依据的基准方向 O2X2 与遥控器 53 依据的基准方向 O1X1 平行。 当遥控器的控制手柄按 O1A1 方向操作时, 遥控器将 β1 的大小的信息向工程机械 51 发送。如图 5, β1 是以 O1X1 为始边, 按预定的转动正方向 ( 图中以顺时针为例 ) 转到 O1A1 所成的角。 工程机械 51 的控制器在收到 β1 的大小的信息后, 将 O2A2 的方向作为遥控驱动 方向。这里 O2A2 是从参考基准方向 O2X2 按顺时针转动 β2 角后的方向, 并且 β2 = β1。 参考图 5, α1 为基准方向 O3X3(O3X3 与 O2X2 平行 ) 按顺时针转到机械臂 52 所得 到的角。若 β1 > α1, 则机械臂需顺时针回转, 反之则为逆时针回转 ; 在 α1-90 度< β1 < α1+90 度的情况下机械臂需伸展 ; 其他情况下, 在 β1 不等于 α1±90 度时机械臂需收 缩。
     在需要控制机械臂末端作垂直运动的情况下, 当机械臂末端高于机械臂始端即回 转台时, 在机械臂末端垂直向上运动时机械臂需伸展, 垂直向下运动时机械臂需收缩 ; 当机 械臂末端低于回转台时, 在机械臂末端垂直向下运动时机械臂需伸展, 垂直向上运动时机 械臂需收缩。 另外, 机械臂在伸展或收缩时各臂节之间的相对位置改变, 此时涉及选择臂节 进行转动控制以改变机械臂姿态的问题。因此需要确定机械臂各臂节的位置, 以便选择臂 节以及判断机械臂末端是否高于回转台。
     臂节的位置可根据臂节之间的夹角 ( 或称相对角度 ) 或臂节与水平面的夹角 ( 或 称绝对角度 ), 以及臂节的长度通过计算而获得。要测量臂节的相对角度, 可以在臂节铰接 处安装转角传感器。图 6 是与本发明实施例有关的转角传感器安装位置的示意图。如图 6 所示, 臂节 61 和臂节 62 在铰接点 60 处铰接, 此处安装有转角传感器 63。这种测量方法可 直接获得两个臂节之间的夹角。
     图 7 是与本发明实施例有关的倾角传感器安装位置的示意图。如图 7 所示, 在臂 节 70 的两端附近分别安装有倾角传感器 71、 72。这样可以测量得到绝对角度的两个值, 因 变形挠度的关系, 该两个值并不相等, 因此可通过加权计算得到一个绝对角度值。 这种测量 方法考虑了机械臂的变形挠度。
     基于各个臂节的倾角值, 通过建立合适的坐标系, 例如以机械臂根部作为坐标原 点建立三维直角坐标系, 易于计算得到机械臂的姿态数据, 例如各臂节的斜率、 相邻臂节之
     间的转折程度等。
     以下对于本实施例中的臂节选择的方案做出说明。
     在臂节伸展或收缩时, 一种方式是选择末端两个臂节并控制其作运动, 这种方式 较为节省运动所需能量。图 8 是与本发明实施例有关的一种选臂方案的示意图。如图 8 所 示, 选择臂节 84、 85 进行控制, 从图 8 可以看出臂节 84、 85 在水平方向的运动方向是相反 的, 水平方向上的部分位移相抵消, 运动速度较慢。 本实施例中给出一种运动速度较快的选 臂方式。参考图 9, 图 9 是机械臂一部分臂节斜率为正、 另一部分臂节斜率为负的状态的示 意图。 通过对臂节绝对角度的检测, 可以得到臂节靠近根部一侧的一端为顶点、 经过该顶点 的水平线为始边、 臂节所在直线为终边按逆时针转动得到的角度, 例如图 9 中的角度 θ1。 该角度的大小可用来确定臂节的斜率正负, 即该角度大于 0 小于 90 度时, 臂节斜率为正 ; 该 角度大于 270 度小于 360 度时, 臂节斜率为负。参考图 9, 臂节 91、 92、 93 的斜率为正, 臂节 94、 95 的斜率为负。
     在机械臂的一部分臂节斜率为正、 另一部分臂节斜率为负的情况下, 本实施例中 的选臂方案是 : 选择两个臂节, 使机械臂以所选两个臂节为运动臂运动到达目标姿态后斜 率发生改变的节臂的数目最小。 具体可以从所有斜率为正的臂节中选择最靠近机械臂末端 的臂节, 从所有斜率为负的臂节中选择最靠近机械臂末端的臂节, 以这两个选择的臂节作 为运动臂, 可以实现机械臂运动到达目标姿态后斜率发生改变的节臂的数目最小, 如果选 择这两个臂节无法实现等高运动, 则可以更换其中一节臂, 仍以机械臂运动到达目标姿态 后斜率发生改变的节臂的数目最小为原则。根据这种选臂方式, 运动的臂节在水平方向的 运动方向一致, 有助于使机械臂末端更快地到达目标点。这种选臂方式同样适用于机械臂 在垂直方向运动的情形。 图 10 是机械臂除根部起第一臂以外的所有臂节的斜率为负的状态的示意图。在 初始姿态下除从机械臂根部 101( 固定在回转台 100 上 ) 起第一臂 102 以外的所有臂节的斜 率为负的情况下, 或者在机械臂所有臂节斜率为正的情况下, 本实施例中的选臂方案是 : 针 对机械臂的自由度的两两组合计算各组合中的自由度所对应的夹角的变化值得到多组数 值, 每组数值包含两个夹角变化值 ; 选择多组数值中两个夹角变化值之和最小的一组数值, 得到该组数值的自由度组合所对应的臂节为所选的运动臂。例如机械臂末端从 10A 向 10B
     运动, 夹角 θ3 和 θ4 分别变为 和 时, 变化值之和最小, 因此选择图 10 中的自由度 θ3 和 θ4。相应的要运动的臂节为臂节 103 和臂节 104。这种选臂方式使臂节以最小的角度改变 量到达目标位置, 同样有助于使机械臂末端更快地到达目标点。该选臂方式同样适用于机 械臂的所有臂节斜率同为正的情形。
     本实施例中的上述选臂方案适用于机械臂的伸展或收缩。 当机械臂末端远离其根 部或者回转台时, 机械臂作伸展运动 ; 当机械臂末端接近回转台时, 机械臂作收缩运动。
     对于用来输送流体的机械臂, 例如混凝土泵车的机械臂, 本实施例再给出一种有 利于流体的输送流畅性的选臂方案。图 11 是与本发明实施例有关的机械臂产生多种姿态 到达目标姿态的示意图。 如图 11 所示, 机械臂 111 末端在从 11A 点运动到 11B 点后, 具有两 种姿态 112、 113。从图中可直观地看出 113 所示的姿态中存在一个较大程度的弯折处 11C 点, 这不利于流体输送的流畅性。针对于此, 本实施例中的这种选臂方案中, 将机械臂中各 组相邻两个臂节之间的转折程度作为机械臂姿态数据, 在机械臂作伸展运动时, 选择转折程度最大的两个臂节, 从而使这两个臂节伸展从而转折程度减小, 有助于优化机械臂的整 体姿态使其有利于流畅地输送流体 ; 当机械臂作收缩运动时, 选择转折程度最小的相邻两 个臂节运动, 避免机械臂中的其他相邻的臂进一步加剧转折程度, 这样有助于使机械臂的 整体中不至于出现转折程度特别大的相邻臂节, 同样有助于使机械臂尽可能流畅地输送流 体。
     以下针对本发明实施例中的控制工程机械的机械臂的装置做出说明。图 12 是根 据本发明实施例的控制工程机械的机械臂的装置的示意图。如图 12 所示, 控制工程机械的 机械臂的装置 129 主要包括接收设备 128、 第一确定设备 127、 第二确定设备 126 和控制设 备 125。
     接收设备 128 用于接收对机械臂进行遥控操作时的操作方向的信息 ; 第一确定设 备 127 用于由操作方向确定遥控驱动方向 ; 第二确定设备 126 用于按照遥控驱动方向、 获取 的机械臂姿态数据、 预设的选臂方式和机械臂的目标姿态确定机械臂的运动内容, 该运动 内容包括机械臂是否回转、 机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的 变化值 ; 控制设备 125 用于按机械臂的运动内容对机械臂进行控制。
     第一确定设备 127 还可用于确定机械臂的控制起始方向, 根据该控制起始方向和 操作方向的夹角确定遥控驱动方向。
     第一确定设备 127 还可以用于获取以参考基准方向为始边、 操作方向为终边, 按 预定的转动正方向所成的夹角的大小 ; 将与参考基准方向按转动正方向成该夹角的大小的 方向作为遥控驱动方向。
     第二确定设备 126 还可用于保存机械臂各臂节的斜率的数据, 以及选择两个臂 节, 使机械臂以所选两个臂节为运动臂运动到达目标姿态后斜率发生改变的节臂的数目最 小。第二确定设备 126 还可用于选择所有斜率为正的臂节中最靠近机械臂末端的臂节, 并 且选择所有斜率为负的臂节中最靠近机械臂末端的臂节。
     第二确定设备 126 还可用于保存机械臂的各组相邻两个臂节之间的转折程度的 数据, 以及在机械臂作伸展运动时, 选择转折程度最大的两个臂节, 在机械臂作收缩运动 时, 选择转折程度最小的两个臂节。
     图 13 是根据本发明实施例中的控制工程机械的机械臂的系统的示意图。如图 13 所示, 控制工程机械的机械臂的系统 130 主要包括遥控操作系统 131、 机械臂姿态监测系统 132 和控制设备 133。其中控制设备 133 包含本发明实施例中的控制工程机械的机械臂的 装置 129。 本发明实施例中的工程机械具有机械臂, 并且具有本发明实施例中的控制工程机 械的机械臂的系统 130。
     根据本发明实施例的技术方案, 在接收到操作人员通过一个控制手柄发送的操作 方向的信息后, 结合机械臂的姿态和预设的选臂方式确定机械臂的运动方式, 使得机械臂 的整体能够根据该操作方向的信息做出运动, 无需操作人员针对每个臂节分别进行遥控操 作, 大大简化了操作人员对机械臂进行遥控时的操作动作, 并减轻了操作人员的劳动强度。 此外本实施例的技术方案中, 能够使操作人员根据自己所处方位直观地进行操作, 另外机 械臂在受控移动时的速度较快, 消耗能量较少。因此采用本实施例的技术方案使机械臂的 运动具有较好的可操作性并且受控性能较佳。
     显然, 本领域的技术人员应该明白, 上述的本发明的各模块或各步骤可以用通用的计算装置来实现, 它们可以集中在单个的计算装置上, 或者分布在多个计算装置所组成 的网络上, 可选地, 它们可以用计算装置可执行的程序代码来实现, 从而, 可以将它们存储 在存储装置中由计算装置来执行, 或者将它们分别制作成各个集成电路模块, 或者将它们 中的多个模块或步骤制作成单个集成电路模块来实现。这样, 本发明不限制于任何特定的 硬件和软件结合。
     以上所述仅为本发明的优选实施例而已, 并不用于限制本发明, 对于本领域的技 术人员来说, 本发明可以有各种更改和变化。 凡在本发明的精神和原则之内, 所作的任何修 改、 等同替换、 改进等, 均应包含在本发明的保护范围之内。

工程机械以及控制工程机械的机械臂的方法、装置和系统.pdf_第1页
第1页 / 共16页
工程机械以及控制工程机械的机械臂的方法、装置和系统.pdf_第2页
第2页 / 共16页
工程机械以及控制工程机械的机械臂的方法、装置和系统.pdf_第3页
第3页 / 共16页
点击查看更多>>
资源描述

《工程机械以及控制工程机械的机械臂的方法、装置和系统.pdf》由会员分享,可在线阅读,更多相关《工程机械以及控制工程机械的机械臂的方法、装置和系统.pdf(16页珍藏版)》请在专利查询网上搜索。

1、10申请公布号CN102360223A43申请公布日20120222CN102360223ACN102360223A21申请号201110197808X22申请日20110714G05D3/00200601E04G21/0420060171申请人长沙中联重工科技发展股份有限公司地址410013湖南省长沙市岳麓区银盆南路361号72发明人易伟春王帅李学俊李昱李葵芳李仁玉74专利代理机构北京康信知识产权代理有限责任公司11240代理人吴贵明54发明名称工程机械以及控制工程机械的机械臂的方法、装置和系统57摘要本发明提供了一种工程机械以及控制工程机械的机械臂的方法、装置和系统,用以解决现有技术中对于。

2、多级臂机械臂的操作存在操作繁琐、操作人员劳动强度较大的问题。该方法包括接收对机械臂进行遥控操作时的操作方向的信息,由该操作方向确定遥控驱动方向;按照遥控驱动方向、获取的机械臂姿态数据、预设的选臂方式和机械臂的目标姿态确定机械臂的运动内容,所述运动内容包括机械臂是否回转、机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值;按机械臂的运动内容对机械臂进行控制。使用本发明的技术方案,有助于降低操作机手的劳动强度,同时能够提高机械臂位置移动的准确性和效率。51INTCL19中华人民共和国国家知识产权局12发明专利申请权利要求书2页说明书7页附图6页CN102360240A1/2页21一种控制。

3、工程机械的机械臂的方法,其特征在于,包括接收对所述机械臂进行遥控操作时的操作方向的信息,由该操作方向确定遥控驱动方向;按照所述遥控驱动方向、获取的机械臂姿态数据、预设的选臂方式和所述机械臂的目标姿态确定所述机械臂的运动内容,所述运动内容包括机械臂是否回转、机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值;按所述机械臂的运动内容对所述机械臂进行控制。2根据权利要求1所述的方法,其特征在于,所述由该操作方向确定遥控驱动方向包括确定所述机械臂的控制起始方向;根据所述控制起始方向和所述操作方向的夹角确定遥控驱动方向。3根据权利要求1所述的方法,其特征在于,所述由该操作方向确定遥控驱动方向包。

4、括获取以参考基准方向为始边、所述操作方向为终边,按预定的转动正方向所成的夹角的大小;将与所述参考基准方向按所述转动正方向成所述夹角的大小的方向作为遥控驱动方向。4根据权利要求1所述的方法,其特征在于,所述机械臂姿态数据包括各臂节的斜率;所述预设的选臂方式包括选择两个臂节,使所述机械臂以所选两个臂节为运动臂运动到达所述目标姿态后斜率发生改变的节臂的数目最小。5根据权利要求4所述的方法,其特征在于,所述机械臂姿态数据包括各臂节的斜率;所述预设的选臂方式包括选择所有斜率为正的臂节中最靠近所述机械臂末端的臂节,并且选择所有斜率为负的臂节中最靠近所述机械臂末端的臂节。6根据权利要求1所述的方法,其特征在。

5、于,所述机械臂姿态数据包括各组相邻两个臂节之间的转折程度;所述预设的选臂方式包括在所述机械臂作伸展运动时,选择转折程度最大的两个臂节,在所述机械臂作收缩运动时,选择转折程度最小的两个臂节。7一种控制工程机械的机械臂的装置,其特征在于,包括接收设备,用于接收对所述机械臂进行遥控操作时的操作方向的信息;第一确定设备,用于由所述操作方向确定遥控驱动方向;第二确定设备,用于按照所述遥控驱动方向、获取的机械臂姿态数据、预设的选臂方式和所述机械臂的目标姿态确定所述机械臂的运动内容,所述运动内容包括机械臂是否回转、机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值;控制设备,用于按所述机械臂的运动。

6、内容对所述机械臂进行控制。8根据权利要求7所述的装置,其特征在于,所述第一确定设备还用于确定所述机械臂的控制起始方向,根据所述控制起始方向和所述操作方向的夹角确定遥控驱动方向。9根据权利要求7所述的装置,其特征在于,所述第一确定设备还用于获取以参考基准方向为始边、所述操作方向为终边,按预定的转动正方向所成的夹角的大小;将与所述参权利要求书CN102360223ACN102360240A2/2页3考基准方向按所述转动正方向成所述夹角的大小的方向作为遥控驱动方向。10根据权利要求7所述的装置,其特征在于,所述第二确定设备还用于保存所述机械臂各臂节的斜率的数据,以及选择两个臂节,使所述机械臂以所选两。

7、个臂节为运动臂运动到达所述目标姿态后斜率发生改变的节臂的数目最小。11根据权利要求10所述的装置,其特征在于,所述第二确定设备还用于选择所有斜率为正的臂节中最靠近所述机械臂末端的臂节,并且选择所有斜率为负的臂节中最靠近所述机械臂末端的臂节。12根据权利要求7所述的装置,其特征在于,所述第二确定设备还用于保存所述机械臂的各组相邻两个臂节之间的转折程度的数据,在所述机械臂作伸展运动时,选择转折程度最大的两个臂节,在所述机械臂作收缩运动时,选择转折程度最小的两个臂节。13一种控制工程机械的机械臂的系统,其特征在于,包括遥控操作系统,用于发出对所述机械臂进行遥控操作时的操作方向的信息;机械臂姿态监测系。

8、统,用于获取机械臂姿态数据;控制设备,包括权利要求7至12中任一项所述的机械臂控制装置。14一种工程机械,具有机械臂,其特征在于,所述工程机械具有权利要求13所述的控制工程机械的机械臂的系统。权利要求书CN102360223ACN102360240A1/7页4工程机械以及控制工程机械的机械臂的方法、装置和系统技术领域0001本发明涉及工程机械技术领域,特别地涉及一种工程机械以及控制工程机械的机械臂的方法、装置和系统。背景技术0002目前,多级臂机械臂被广泛应用于工程机械领域。其中比较典型的有混凝土泵车、混凝土布料机等混凝土机械的机械臂。这类机械臂具有如下特点臂节数大于等于3节,相邻臂节采用转轴。

9、进行连接,每个臂节通过液压油缸推动可绕转轴在有限的角度范围内旋转。机械臂通过回转台固定在汽车底盘或布料塔上,并可绕垂直于固定底座平面的轴作360度旋转。工作时,通过遥控装置控制臂节及转台的旋转以控制机械臂末端位置,完成混凝土布料工作。0003以图1所示的五级臂混凝土泵车机械臂结构为例,来详细说明这类机械臂的结构组成及操作。图1是具有五个臂节的机械臂的基本结构的示意图。图1中示出了如下部件回转台1,机械臂油缸2,一臂3,二臂4,三臂5,四臂6,五臂7,软管8,连杆9,转轴10,倾角传感器11。0004如图1所示,回转台1固定在汽车底盘机架上,通过减速机图上未示出驱动,带动机械臂绕回转轴作0至36。

10、0度旋转。一臂3与回转台1采用转轴10铰接,通过连接在回转台和一臂上的液压油缸2的伸缩运动,实现其绕转轴作090旋转。一臂3、二臂4、三臂5、四臂6、五臂7之间同样采用转轴10铰接,通过油缸2的伸缩运动驱动连杆9使臂节绕转轴在一定的角度范围内旋转,实现机械臂的展、收。液压油缸2及减速机采用多摇杆遥控器进行控制。遥控器接收机接收到发射机发出的摇杆位置信号后直接输出或通过控制器输出相应比例的电流信号,控制机械臂多路阀的动作方向及开度,进而控制机械臂相应臂节的展、收或回转方向以及动作速度。0005对于五臂节机械臂系统,通常采用六摇杆遥控器进行操作,其中第一个摇杆控制机械臂回转,第二至六摇杆分别控制一。

11、至五臂。以混凝土泵车为例,在实际施工过程中,操作机手通过操作遥控器相应摇杆控制相应臂节及回转台动作,进行机械臂姿态和回转角度的调整,最终实现将机械臂末端的浇注软管8移动到需要浇注混凝土的区域上方,进行混凝土浇注。对于目前常见的采用此种单臂节控制方式的机械臂控制系统,要想将机械臂末端从一点移动到另一点且保持移动过程中高度不变,至少需要同时操作两臂节,有时还需要加入回转操作,操作繁琐,对于经验较少的操作机手来说是一个不小的挑战。同时,在操作过程中,机手必需根据现场情况判断该动哪几臂节,以及臂节的移动方向,使操作人员的劳动强度较大。0006在现有技术中,对于多级臂机械臂的操作存在操作繁琐、操作人员劳。

12、动强度较大的问题,尚未提出有效解决方案。发明内容说明书CN102360223ACN102360240A2/7页50007本发明的主要目的是提供一种工程机械以及控制工程机械的机械臂的方法、装置和系统,以解决现有技术中对于多级臂机械臂的操作存在操作繁琐、操作人员劳动强度较大的问题。0008为解决上述问题,根据本发明的一个方面,提供了一种控制工程机械的机械臂的方法。0009本发明的控制工程机械的机械臂的方法包括接收对所述机械臂进行遥控操作时的操作方向的信息,由该操作方向确定遥控驱动方向;按照所述遥控驱动方向、获取的机械臂姿态数据、预设的选臂方式和所述机械臂的目标姿态确定所述机械臂的运动内容,所述运动。

13、内容包括机械臂是否回转、机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值;按所述机械臂的运动内容对所述机械臂进行控制。0010根据本发明的另一方面,提供了一种控制工程机械的机械臂的装置。0011本发明的控制工程机械的机械臂的装置包括接收设备,用于接收对所述机械臂进行遥控操作时的操作方向的信息;第一确定设备,用于由所述操作方向确定遥控驱动方向;第二确定设备,用于按照所述遥控驱动方向、获取的机械臂姿态数据、预设的选臂方式和所述机械臂的目标姿态确定所述机械臂的运动内容,所述运动内容包括机械臂是否回转、机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值;控制设备,用于按所述机械臂。

14、的运动内容对所述机械臂进行控制。0012根据本发明的又一方面,提供了一种控制工程机械的机械臂的系统。0013本发明的控制工程机械的机械臂的系统包括遥控操作系统,用于发出对所述机械臂进行遥控操作时的操作方向的信息;机械臂姿态监测系统,用于获取机械臂姿态数据;控制设备,包括本发明的机械臂控制装置。0014根据本发明的又一方面,提供了一种工程机械。0015本发明的工程机械具有机械臂,还具有本发明的控制工程机械的机械臂的系统。0016根据本发明的技术方案,在接收到操作人员通过一个控制手柄发送的操作方向的信息后,结合机械臂的姿态和预设的选臂方式确定机械臂的运动方式,使得机械臂的整体能够根据该操作方向的信。

15、息做出运动,无需操作人员针对每个臂节分别进行遥控操作,大大简化了操作人员对机械臂进行遥控时的操作动作,并减轻了操作人员的劳动强度。附图说明0017说明书附图用来提供对本发明的进一步理解,构成本申请的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中0018图1是具有五个臂节的机械臂的基本结构的示意图;0019图2是根据本发明实施例的多级臂机械臂的控制系统基本结构的示意图;0020图3是根据本发明实施例的一种确定遥控驱动方向的示意图;0021图4是根据本发明实施例的确定遥控驱动方向的另一方式的示意图;0022图5是根据本发明实施例的确定遥控驱动方向的又一方式。

16、的示意图;0023图6是与本发明实施例有关的转角传感器安装位置的示意图;0024图7是与本发明实施例有关的倾角传感器安装位置的示意图;0025图8是与本发明实施例有关的一种选臂方案的示意图;说明书CN102360223ACN102360240A3/7页60026图9是机械臂一部分臂节斜率为正、另一部分臂节斜率为负的状态的示意图;0027图10是机械臂除根部起第一臂以外的所有臂节的斜率为负的状态的示意图;0028图11是与本发明实施例有关的机械臂产生多种姿态到达目标姿态的示意图;0029图12是根据本发明实施例的控制工程机械的机械臂的装置的示意图;以及0030图13是根据本发明实施例中的控制工程。

17、机械的机械臂的系统的示意图。具体实施方式0031需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。0032图2是根据本发明实施例的控制工程机械的机械臂的方法的基本步骤示意图。如图2所示,本发明实施例的控制工程机械的机械臂的方法可由安装在工程机械上的控制设备完成,主要包括以下步骤S21至步骤S27。0033步骤S21接收对机械臂进行遥控操作时的操作方向的信息。0034步骤S23根据该操作方向确定遥控驱动方向。0035步骤S25按照遥控驱动方向、获取的机械臂姿态数据、预设的选臂方式和机械臂的目标姿态,确定机械臂的运动内容。本实。

18、施例中,机械臂的运动内容主要包括机械臂是否回转、机械臂运动时的运动臂节及运动臂节的自由度所对应的夹角的变化值。0036步骤S27按机械臂的运动内容对机械臂进行控制。0037以下对本发明实施例的技术方案作进一步详细说明。0038步骤S21中的操作方向的信息的内容可以操作人员通过遥控器提供的机械臂末端的移动方向。此时操作人员使用一个控制手柄,通过该控制手柄给出针对机械臂末端的移动方向。在步骤S23中确定遥控驱动方向时,一种方式如图3所示,图3是根据本发明实施例的一种确定遥控驱动方向的示意图。0039如图3所示,操作人员31手持遥控器32的控制手柄321进行操作以移动工程机械33的机械臂331的布料。

19、点332,操作方向是以OY为起始按顺时针转到OM方向,此时基于机械臂伸展方向确定遥控驱动方向,即遥控驱动方向以工程机械33的机械臂331延长线为起始按顺时针转过上述以OY为起始按顺时针转到OM方向的角度,从图3可以看出按上述方式处理时,对于站在A处的操作人员来说,当需要使机械臂末端按箭头34移动时,要将自己想象成位于B位置,然后按箭头35与箭头34平行操作遥控手柄,而不是直接按箭头36操作。0040从图3可以看出上述的遥控驱动方向对于操作人员来说需想象自己位于另外一个位置,操作不够直观。本实施例中给出一种更为直观的遥控驱动方向确定方式,如图4所示,图4是根据本发明实施例的确定遥控驱动方向的另一。

20、方式的示意图。本实施例的这种确定遥控驱动方向的方式中,首先确定机械臂的控制起始方向,再根据该控制起始方向和操作方向的夹角确定遥控驱动方向。根据这种方式,遥控器42上设置有一个坐标同步开关421,参考图4,操作人员41在操作时,首先按住坐标同步开关并按照与机械臂431的延长线的方向即箭头44平行的方向箭头441拨动操作手柄,此时遥控器将确认信息和操作方向信息一并发往工程机械,工程机械收到该确认信息后得知与该确认信息一并收到的操作方向信息中包含的是控制起始方向即箭头44,从而并不立即按照该操作方向进行操作;说明书CN102360223ACN102360240A4/7页7接下来操作人员41操作遥控手。

21、柄,例如操作方向为箭头442,控制起始方向箭头441与操作方向箭头442成角,此时遥控驱动方向即确定为与箭头44成角的箭头444。可以看出这种方式并不按与Y轴成角的箭头443进行操作,操作人员41在其位置对于控制手柄的操作方向与机械臂末端432要移动的方向相一致,因此对于操作人员41来说较为直观、方便。0041根据该方式,易于确定机械臂是否回转以及是否伸展。参考图4,当角不为0或360度时,表明机械臂需回转。当角大于0度小于90度、或者大于270度小于360度时表明机械臂需伸展。当角大于90度小于270度时表明机械臂需收缩。0042本实施例中再给出一种确定遥控驱动方向的方式。图5是根据本发明实。

22、施例的确定遥控驱动方向的又一方式的示意图。在这种确定遥控驱动方向的方式中,遥控器和工程机械的本体需要有共认的参考基准方向,可以在工程机械和遥控器中安装传感器来实现,例如利用地磁原理的传感器、利用陀螺仪原理的传感器;利用光影原理的传感器等,使遥控器给出的关于方向的数据所依据的基准方向与工程机械的控制器在计算方向时依据的基准方向相同,参考图5,工程机械51依据的基准方向O2X2与遥控器53依据的基准方向O1X1平行。当遥控器的控制手柄按O1A1方向操作时,遥控器将1的大小的信息向工程机械51发送。如图5,1是以O1X1为始边,按预定的转动正方向图中以顺时针为例转到O1A1所成的角。工程机械51的控。

23、制器在收到1的大小的信息后,将O2A2的方向作为遥控驱动方向。这里O2A2是从参考基准方向O2X2按顺时针转动2角后的方向,并且21。0043参考图5,1为基准方向O3X3O3X3与O2X2平行按顺时针转到机械臂52所得到的角。若11,则机械臂需顺时针回转,反之则为逆时针回转;在190度1190度的情况下机械臂需伸展;其他情况下,在1不等于190度时机械臂需收缩。0044在需要控制机械臂末端作垂直运动的情况下,当机械臂末端高于机械臂始端即回转台时,在机械臂末端垂直向上运动时机械臂需伸展,垂直向下运动时机械臂需收缩;当机械臂末端低于回转台时,在机械臂末端垂直向下运动时机械臂需伸展,垂直向上运动时。

24、机械臂需收缩。另外,机械臂在伸展或收缩时各臂节之间的相对位置改变,此时涉及选择臂节进行转动控制以改变机械臂姿态的问题。因此需要确定机械臂各臂节的位置,以便选择臂节以及判断机械臂末端是否高于回转台。0045臂节的位置可根据臂节之间的夹角或称相对角度或臂节与水平面的夹角或称绝对角度,以及臂节的长度通过计算而获得。要测量臂节的相对角度,可以在臂节铰接处安装转角传感器。图6是与本发明实施例有关的转角传感器安装位置的示意图。如图6所示,臂节61和臂节62在铰接点60处铰接,此处安装有转角传感器63。这种测量方法可直接获得两个臂节之间的夹角。0046图7是与本发明实施例有关的倾角传感器安装位置的示意图。如。

25、图7所示,在臂节70的两端附近分别安装有倾角传感器71、72。这样可以测量得到绝对角度的两个值,因变形挠度的关系,该两个值并不相等,因此可通过加权计算得到一个绝对角度值。这种测量方法考虑了机械臂的变形挠度。0047基于各个臂节的倾角值,通过建立合适的坐标系,例如以机械臂根部作为坐标原点建立三维直角坐标系,易于计算得到机械臂的姿态数据,例如各臂节的斜率、相邻臂节之说明书CN102360223ACN102360240A5/7页8间的转折程度等。0048以下对于本实施例中的臂节选择的方案做出说明。0049在臂节伸展或收缩时,一种方式是选择末端两个臂节并控制其作运动,这种方式较为节省运动所需能量。图8。

26、是与本发明实施例有关的一种选臂方案的示意图。如图8所示,选择臂节84、85进行控制,从图8可以看出臂节84、85在水平方向的运动方向是相反的,水平方向上的部分位移相抵消,运动速度较慢。本实施例中给出一种运动速度较快的选臂方式。参考图9,图9是机械臂一部分臂节斜率为正、另一部分臂节斜率为负的状态的示意图。通过对臂节绝对角度的检测,可以得到臂节靠近根部一侧的一端为顶点、经过该顶点的水平线为始边、臂节所在直线为终边按逆时针转动得到的角度,例如图9中的角度1。该角度的大小可用来确定臂节的斜率正负,即该角度大于0小于90度时,臂节斜率为正;该角度大于270度小于360度时,臂节斜率为负。参考图9,臂节9。

27、1、92、93的斜率为正,臂节94、95的斜率为负。0050在机械臂的一部分臂节斜率为正、另一部分臂节斜率为负的情况下,本实施例中的选臂方案是选择两个臂节,使机械臂以所选两个臂节为运动臂运动到达目标姿态后斜率发生改变的节臂的数目最小。具体可以从所有斜率为正的臂节中选择最靠近机械臂末端的臂节,从所有斜率为负的臂节中选择最靠近机械臂末端的臂节,以这两个选择的臂节作为运动臂,可以实现机械臂运动到达目标姿态后斜率发生改变的节臂的数目最小,如果选择这两个臂节无法实现等高运动,则可以更换其中一节臂,仍以机械臂运动到达目标姿态后斜率发生改变的节臂的数目最小为原则。根据这种选臂方式,运动的臂节在水平方向的运动。

28、方向一致,有助于使机械臂末端更快地到达目标点。这种选臂方式同样适用于机械臂在垂直方向运动的情形。0051图10是机械臂除根部起第一臂以外的所有臂节的斜率为负的状态的示意图。在初始姿态下除从机械臂根部101固定在回转台100上起第一臂102以外的所有臂节的斜率为负的情况下,或者在机械臂所有臂节斜率为正的情况下,本实施例中的选臂方案是针对机械臂的自由度的两两组合计算各组合中的自由度所对应的夹角的变化值得到多组数值,每组数值包含两个夹角变化值;选择多组数值中两个夹角变化值之和最小的一组数值,得到该组数值的自由度组合所对应的臂节为所选的运动臂。例如机械臂末端从10A向10B运动,夹角3和4分别变为和时。

29、,变化值之和最小,因此选择图10中的自由度3和4。相应的要运动的臂节为臂节103和臂节104。这种选臂方式使臂节以最小的角度改变量到达目标位置,同样有助于使机械臂末端更快地到达目标点。该选臂方式同样适用于机械臂的所有臂节斜率同为正的情形。0052本实施例中的上述选臂方案适用于机械臂的伸展或收缩。当机械臂末端远离其根部或者回转台时,机械臂作伸展运动;当机械臂末端接近回转台时,机械臂作收缩运动。0053对于用来输送流体的机械臂,例如混凝土泵车的机械臂,本实施例再给出一种有利于流体的输送流畅性的选臂方案。图11是与本发明实施例有关的机械臂产生多种姿态到达目标姿态的示意图。如图11所示,机械臂111末。

30、端在从11A点运动到11B点后,具有两种姿态112、113。从图中可直观地看出113所示的姿态中存在一个较大程度的弯折处11C点,这不利于流体输送的流畅性。针对于此,本实施例中的这种选臂方案中,将机械臂中各组相邻两个臂节之间的转折程度作为机械臂姿态数据,在机械臂作伸展运动时,选择转折说明书CN102360223ACN102360240A6/7页9程度最大的两个臂节,从而使这两个臂节伸展从而转折程度减小,有助于优化机械臂的整体姿态使其有利于流畅地输送流体;当机械臂作收缩运动时,选择转折程度最小的相邻两个臂节运动,避免机械臂中的其他相邻的臂进一步加剧转折程度,这样有助于使机械臂的整体中不至于出现转。

31、折程度特别大的相邻臂节,同样有助于使机械臂尽可能流畅地输送流体。0054以下针对本发明实施例中的控制工程机械的机械臂的装置做出说明。图12是根据本发明实施例的控制工程机械的机械臂的装置的示意图。如图12所示,控制工程机械的机械臂的装置129主要包括接收设备128、第一确定设备127、第二确定设备126和控制设备125。0055接收设备128用于接收对机械臂进行遥控操作时的操作方向的信息;第一确定设备127用于由操作方向确定遥控驱动方向;第二确定设备126用于按照遥控驱动方向、获取的机械臂姿态数据、预设的选臂方式和机械臂的目标姿态确定机械臂的运动内容,该运动内容包括机械臂是否回转、机械臂运动时的。

32、运动臂节及运动臂节的自由度所对应的夹角的变化值;控制设备125用于按机械臂的运动内容对机械臂进行控制。0056第一确定设备127还可用于确定机械臂的控制起始方向,根据该控制起始方向和操作方向的夹角确定遥控驱动方向。0057第一确定设备127还可以用于获取以参考基准方向为始边、操作方向为终边,按预定的转动正方向所成的夹角的大小;将与参考基准方向按转动正方向成该夹角的大小的方向作为遥控驱动方向。0058第二确定设备126还可用于保存机械臂各臂节的斜率的数据,以及选择两个臂节,使机械臂以所选两个臂节为运动臂运动到达目标姿态后斜率发生改变的节臂的数目最小。第二确定设备126还可用于选择所有斜率为正的臂。

33、节中最靠近机械臂末端的臂节,并且选择所有斜率为负的臂节中最靠近机械臂末端的臂节。0059第二确定设备126还可用于保存机械臂的各组相邻两个臂节之间的转折程度的数据,以及在机械臂作伸展运动时,选择转折程度最大的两个臂节,在机械臂作收缩运动时,选择转折程度最小的两个臂节。0060图13是根据本发明实施例中的控制工程机械的机械臂的系统的示意图。如图13所示,控制工程机械的机械臂的系统130主要包括遥控操作系统131、机械臂姿态监测系统132和控制设备133。其中控制设备133包含本发明实施例中的控制工程机械的机械臂的装置129。本发明实施例中的工程机械具有机械臂,并且具有本发明实施例中的控制工程机械。

34、的机械臂的系统130。0061根据本发明实施例的技术方案,在接收到操作人员通过一个控制手柄发送的操作方向的信息后,结合机械臂的姿态和预设的选臂方式确定机械臂的运动方式,使得机械臂的整体能够根据该操作方向的信息做出运动,无需操作人员针对每个臂节分别进行遥控操作,大大简化了操作人员对机械臂进行遥控时的操作动作,并减轻了操作人员的劳动强度。此外本实施例的技术方案中,能够使操作人员根据自己所处方位直观地进行操作,另外机械臂在受控移动时的速度较快,消耗能量较少。因此采用本实施例的技术方案使机械臂的运动具有较好的可操作性并且受控性能较佳。0062显然,本领域的技术人员应该明白,上述的本发明的各模块或各步骤。

35、可以用通用说明书CN102360223ACN102360240A7/7页10的计算装置来实现,它们可以集中在单个的计算装置上,或者分布在多个计算装置所组成的网络上,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。这样,本发明不限制于任何特定的硬件和软件结合。0063以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。说明书CN102360223ACN102360240A1/6页11图1图2说明书附图CN102360223ACN102360240A2/6页12图3图4说明书附图CN102360223ACN102360240A3/6页13图5图6图7说明书附图CN102360223ACN102360240A4/6页14图8图9说明书附图CN102360223ACN102360240A5/6页15图10图11说明书附图CN102360223ACN102360240A6/6页16图12图13说明书附图CN102360223A。

展开阅读全文
相关资源
猜你喜欢
相关搜索

当前位置:首页 > 物理 > 控制;调节


copyright@ 2017-2020 zhuanlichaxun.net网站版权所有
经营许可证编号:粤ICP备2021068784号-1