CN102508494B - 机械臂、工程机械和确定机械臂臂节位置的方法 - Google Patents
机械臂、工程机械和确定机械臂臂节位置的方法 Download PDFInfo
- Publication number
- CN102508494B CN102508494B CN201110302722.9A CN201110302722A CN102508494B CN 102508494 B CN102508494 B CN 102508494B CN 201110302722 A CN201110302722 A CN 201110302722A CN 102508494 B CN102508494 B CN 102508494B
- Authority
- CN
- China
- Prior art keywords
- arm
- joint
- arm joint
- obliquity sensor
- mechanical arm
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000012937 correction Methods 0.000 claims description 5
- 239000004744 fabric Substances 0.000 claims description 5
- 238000001514 detection method Methods 0.000 abstract description 4
- 238000004364 calculation method Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 238000009434 installation Methods 0.000 description 6
- 238000006073 displacement reaction Methods 0.000 description 5
- 238000012360 testing method Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 230000005284 excitation Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000037147 athletic performance Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 239000012141 concentrate Substances 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000005489 elastic deformation Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
Landscapes
- Jib Cranes (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本发明提供了一种机械臂、工程机械和确定机械臂臂节位置的方法,以解决现有技术中机械臂的臂节倾角检测存在精度不足以及成本较高的问题。该方法包括:在机械臂的每个臂节上安装有一个倾角传感器,倾角传感器用于检测所在臂节的倾角;倾角传感器安装在臂节的挠度变形最大的区域。根据本发明实施例的技术方案,有助于以低成本准确地获得机械臂的臂节位置。
Description
技术领域
本发明涉及工程机械技术领域,特别地涉及一种机械臂、工程机械和确定机械臂臂节位置的方法。
背景技术
机械臂是一种常用的工程机械部件,其一端固定在工程机械的回转台上,能够在水平面上进行回转运动,并且机械臂具有多个铰接的臂节,在臂节上的油缸的支撑作用下,各个臂节之间的角度能够改变,从而使整个机械臂的姿态发生变化,特别是其末端臂节的自由端能够改变位置,以混凝土泵车为例,末端臂节的自由端为布料点,能够向不同的浇注位置进行浇注。在机混凝土泵车在工作布料时惯常都是采用多个手柄对各节臂的展开与收拢动作进行一一对应控制,该种控制方式的精度完全由操作人员的熟练程度决定,操作效率低,精准度差。
为解决上述问题,人们考虑研发能够由操作人员发出简单指令,就能够对臂架复杂运动进行控制的运动控制***。为实现该种运动控制功能,前提条件之一是要对运动中的臂架情况(如:臂架各臂节的倾角)进行实时测量,确定臂架的实时位置,然后由控制器通过一定的程序计算后,对臂架后续的运动动作发出指令。
臂节的倾角是表征臂架姿态的重要指标,根据该倾角可以确定臂节的位置。臂节的位置可采用臂节末端的位置来表征。臂节的倾角一般是指臂节与水平面的夹角。
在相关技术中,在臂节两端附近各设置1个倾角传感器,根据臂架两端的倾角传感器的测量值计算该臂节的倾角。发明人发现该方式的精度不足并且成本较高。
对于相关技术中的机械臂的臂节倾角检测存在精度不足以及成本较高的问题,目前尚未提出有效解决方案。
发明内容
本发明的主要目的是提供一种机械臂、工程机械和确定机械臂臂节位置的方法,以解决现有技术中机械臂的臂节倾角检测存在精度不足以及成本较高的问题。
为解决上述问题,根据本发明的一个方面,提供了一种机械臂。
本发明的机械臂包括多个臂节以及驱动各个臂节的油缸,在所述机械臂的臂节上安装有一个倾角传感器,所述倾角传感器用于检测所述倾角传感器所在臂节的倾角;所述倾角传感器安装在所述臂节的挠度变形最大的区域。
根据本发明的另一方面,提供了一种工程机械。
本发明的工程机械具有本发明的机械臂。
根据本发明的又一方面,提供了一种确定机械臂臂节位置的方法,其中机械臂为本发明的机械臂,该方法包括:确定所述机械臂的各个臂节的倾角;根据下式计算第n个臂节的末端与第1个臂节的始端的水平距离:Xn=L1cosθ1+L2cosθ2+…+Lncosθn,以及根据下式计算第n个臂节的末端与第1个臂节的始端的垂直距离:Yn=L1sinθ1+L2sinθ2+…+Lnsinθn,其中Xn和Yn分别表示第n个臂节的末端与第1个臂节的始端的水平距离和垂直距离,Ln表示第n个臂节的长度,θn表示第n个臂节的倾角,当臂节的始端低于末端时取正值,反之取负值。
经过实验证明,根据本发明的技术方案能准确、真实的反应臂架的真实姿态和动态特性。并且因为在每个臂节只安装1个传感器,因此降低了成本,并且安装方便。
附图说明
说明书附图用来提供对本发明的进一步理解,构成本申请的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1是根据本发明实施例的倾角传感器在机械臂上的安装位置的示意图;
图2是根据相关技术的一种转角传感器的安装示意图;
图3是与本发明实施例有关的设置拉线传感器的示意图;
图4A和图4B是根据本发明实施例的臂架末端计算位置与臂架末端实际位置的对比的示意图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。
图1是根据本发明实施例的倾角传感器在机械臂上的安装位置的示意图。在实现本发明的过程中,发明人考虑到,每个臂节上均有几个支撑点,导致臂节受力是不均匀变化的,即其挠度变形也不是均匀的,所以不能简单的把每个臂节作为悬臂刚性梁自由端进行处理,并且,每个臂节在两个油缸支撑点之间的变形是最大的,参考图1,例如对于臂节21,其上有两个油缸23、24的支撑点D、E,则臂节21中的DE段具有最大的变形,将倾角传感器25安装在DE段中;又如对于臂节22,其上的油缸支点为B和F(F处的油缸未示出),则臂节22中的BF段具有最大的变形,将倾角传感器26安装在BF段中。对于上述的具有最大变形的段,因每一段的长度有限,所以可以把该段臂节的形变看成是均匀的。
根据上述的臂架结构与受力的分析,在本实施例中,倾角传感器在臂架上安装位置的原则是:倾角传感器在该处测得的角度最大限度的接近臂架发生弹性变形后的两个端点之间连线的角度值。而满足此原则的区域是臂节挠度变形最大的区域,因此,在本实施例中,在机械臂的臂节上安装一个倾角传感器,倾角传感器安装在臂节的挠度变形最大的区域。优选地,可在每个臂节上各安装一个倾角传感器。
对于末节臂来说,油缸支撑点至末节臂末端之间是挠度变形最大的区域,因此末节臂上的倾角传感器安装在末节臂上的油缸支撑点至末节臂末端之间,非末节臂上的倾角传感器安装在该臂节上的两个油缸支撑点之间。
发明人进一步发现,倾角传感器安装在挠度变形最大的区域的中部时,能够获得更精确的检测结果。因此在本实施例中,优选地,对于末节臂,可将倾角传感器安装在末节臂上的油缸支撑点与末节臂末端的中点附近;对于非末节臂,可将倾角传感器安装在非末节臂上的两个油缸支撑点的中点附近。
根据本实施例中的倾角传感器安装方式安装了倾角传感器之后,可以根据本实施例中的确定机械臂臂节位置的方法来确定机械臂臂节位置。以下对于本实施例中确定机械臂臂节位置的方法做出说明。
确定所述机械臂的各个臂节的倾角;分别根据(1)式和(2)式计算第n个臂节的末端与第1个臂节的始端的水平距离:
Xn=L1cosθ1+L2cosθ2+…+Lncosθn…………(1)
Yn=L1sinθ1+L2sinθ2+…+Lnsinθn…………(2)
其中,Xn和Yn分别表示第n个臂节的末端与第1个臂节的始端的水平距离和垂直距离,Ln表示第n个臂节的长度,θn表示第n个臂节的倾角,当臂节的始端低于末端时取正值,反之取负值。
在确定机械臂的各个臂节的倾角时,具体可以是直接获取倾角传感器的检测值。另外,可以通过试验,对臂架的位置进行修正。在实际中比较关心的是臂架末端即布料点的位置,以该位置的修正为例加以说明。例如臂架为五节臂,则(1)式和(2)式n=5,计算得到X5和Y5,则臂架末端在修正前的位置(即臂架末端与第1个臂节始端的直线距离)H0为:
在对H0修正时可按如下公式得到修正值H:其中R表示所有臂架的长度总和,r表示实际测量的臂架末端离转台中心的距离即布料半径。L表示预设的参数,反映了臂架理论变型量,取值范围可以是[-1.5,1.5],例如取1.0,可以根据实际情况调整L值。
与相关技术相比,本实施例的技术方案有助于提高臂节倾角检测的精度,并且能够降低成本。参考图2,图2是根据相关技术的一种转角传感器的安装示意图。
如图2所示,在相关技术的方案中,采用2个倾角传感器B1和B2,分别设置在臂架20的两端附近。根据该方案,测定的臂架角度为臂架与地面的倾角,通过2个倾角传感器得到某一节臂的2个倾角值,在将得到的2个角度值进行加权计算后得到一个计算后的角度值,该种测量方法在计算的过程中将臂架的刚性进行了理想化处理,在加权计算前的公式计算中就已将臂架的刚性值进行了设定,该种角度计算取值与实际的臂架倾角之间存在较大的误差,因此精度不高。另外,该方案采用两个倾角传感器,在产品生产上,增加了生产成本。
而本实施例的技术方案有助于克服上述相关技术中的不足。以下结合试验加以说明。该试验中,设置拉线传感器以取得实际的臂架末端与第1个臂节始端之间的距离,并将该距离与根据本实施例的技术方案获得的臂架末端与第1个臂节始端之间的距离相比较。图3是与本发明实施例有关的设置拉线传感器的示意图。
如图3所示,展开臂架后在臂架41末端附近连接一只拉线传感器42,拉线传感器42直接检测到连接点与第1个臂节始端之间的距离,再加上连接点至臂架41末端的距离即得到实际的臂架末端与第1个臂节始端之间的距离。
在臂架的合适位置例如第2节臂处给一定的助动信号(正弦助动和阶跃助动)作为激励使臂架末端参数相应位移,得到实际的臂架末端与第1个臂节始端之间的距离,以及根据本实施例得到的臂架末端与第1个臂节始端之间的距离,分别如图4A和图4B所示。图4A和图4B是根据本发明实施例的臂架末端计算位置与臂架末端实际位置的对比的示意图。图4A和图4B分别对应于臂架的正弦激励响应和阶跃激励响应,其中,图4A中的线条4A1表示拉线传感器检测得到的臂架末端位移与时间的关系,线条4A2表示根据本发明实施例的方案得到的臂架末端位移与时间的关系;图4B中的线条4B1表示拉线传感器检测得到的臂架末端位移与时间的关系,其中对臂架末端的位置作了修正,线条4B2表示根据本发明实施例的方案得到的臂架末端位移与时间的关系,其中对臂架末端的位置作了修正。从图4A和图4B可以看出,采用本发明实施例的技术方案能准确、真实的反应臂架的真实姿态和动态特性。
显然,本领域的技术人员应该明白,上述的本发明的各模块或各步骤可以用通用的计算装置来实现,它们可以集中在单个的计算装置上,或者分布在多个计算装置所组成的网络上,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。这样,本发明不限制于任何特定的硬件和软件结合。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种确定机械臂臂节位置的方法,所述机械臂包括多个臂节以及驱动各个臂节的油缸,在所述机械臂的臂节上安装有一个倾角传感器,所述倾角传感器用于检测所述倾角传感器所在臂节的倾角;所述倾角传感器安装在所述臂节的挠度变形最大的区域,其特征在于,所述方法包括:
确定所述机械臂的各个臂节的倾角;
根据下式计算第n个臂节的末端与第1个臂节的始端的水平距离:
Xn=L1cosθ1+L2cosθ2+…+Lncosθn,
以及根据下式计算第n个臂节的末端与第1个臂节的始端的垂直距离:
Yn=L1sinθ1+L2sinθ2+…+Lnsinθn,
其中Xn和Yn分别表示第n个臂节的末端与第1个臂节的始端的水平距离和垂直距离,Ln表示第n个臂节的长度,θn表示第n个臂节的倾角,当臂节的始端低于末端时取正值,反之取负值。
2.根据权利要求1所述的方法,其特征在于,在进行所述计算得到第n个臂节的末端与第1个臂节的始端的水平距离与垂直距离后,其中,第n个臂节的末端即为臂架末端,所述方法还包括:
根据所述臂架末端与第1个臂节的始端的水平距离与垂直距离得出所述臂架末端与所述第1个臂节的始端的直线距离;
按如下公式修正所述直线距离:其中,H表示修正后的所述直线距离,H0表示修正前的所述直线距离,R表示臂架的总长度,r表示臂架的布料半径,L表示预设的参数,取值范围是[-1.5,1.5]。
3.根据权利要求1所述的方法,其特征在于,所述臂节为非末节臂,所述倾角传感器安装在该臂节上的两个油缸支撑点之间。
4.根据权利要求3所述的方法,其特征在于,所述倾角传感器安装在所述臂节上的两个油缸支撑点的中点附近。
5.根据权利要求1所述的方法,其特征在于,所述臂节为末节臂,所述倾角传感器安装在所述臂节上的油缸支撑点至末节臂末端之间。
6.根据权利要求5所述的方法,其特征在于,所述倾角传感器安装在所述臂节上的油缸支撑点与末节臂末端的中点附近。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110302722.9A CN102508494B (zh) | 2011-09-28 | 2011-09-28 | 机械臂、工程机械和确定机械臂臂节位置的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110302722.9A CN102508494B (zh) | 2011-09-28 | 2011-09-28 | 机械臂、工程机械和确定机械臂臂节位置的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102508494A CN102508494A (zh) | 2012-06-20 |
CN102508494B true CN102508494B (zh) | 2014-12-24 |
Family
ID=46220595
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110302722.9A Active CN102508494B (zh) | 2011-09-28 | 2011-09-28 | 机械臂、工程机械和确定机械臂臂节位置的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102508494B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103058081A (zh) * | 2012-12-26 | 2013-04-24 | 三一重工股份有限公司 | 超起展开角度测量***及方法和起重机 |
CN106115492A (zh) * | 2016-08-31 | 2016-11-16 | 润邦卡哥特科工业有限公司 | 一种用于起重机的三维坐标定位*** |
CN106943698A (zh) * | 2017-04-28 | 2017-07-14 | 三汽车制造有限公司 | 一种破拆消防车 |
CN109648606A (zh) * | 2018-12-29 | 2019-04-19 | 深圳市越疆科技有限公司 | Scara机器人的拉线测试方法 |
CN112520584A (zh) * | 2020-11-13 | 2021-03-19 | 南京中船绿洲机器有限公司 | Profinet编码器在船用折臂起重机上的运用方法 |
CN112828934B (zh) * | 2021-01-04 | 2022-05-20 | 中联重科股份有限公司 | 确定臂架姿态的方法和装置、监控方法和装置及工程机械 |
CN112936242B (zh) * | 2021-01-29 | 2022-07-26 | 中联重科股份有限公司 | 判断臂架操作安全性的方法、装置及工程机械 |
CN113622673A (zh) * | 2021-07-30 | 2021-11-09 | 三一汽车制造有限公司 | 防干涉方法、装置及作业机械 |
CN114562111B (zh) * | 2022-02-14 | 2023-09-08 | 三一汽车制造有限公司 | 臂架位置确定方法、装置、设备及作业机械 |
CN114800502B (zh) * | 2022-04-25 | 2024-06-21 | 上海睿尤准智控技术有限公司 | 臂架形变补偿方法、补偿控制***及工程机械设备 |
JP2023164067A (ja) * | 2022-04-28 | 2023-11-10 | 株式会社小松製作所 | 取付位置決定方法、作業機、作業機械および姿勢検出センサ |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101776526A (zh) * | 2010-01-26 | 2010-07-14 | 郭孔辉 | 悬架运动学与全工况弹性试验机 |
CN101870110A (zh) * | 2010-07-01 | 2010-10-27 | 三一重工股份有限公司 | 一种机械铰接臂的控制方法及控制装置 |
CN102009413A (zh) * | 2010-11-02 | 2011-04-13 | 北京航空航天大学 | 一种适用于球电机的具有姿态检测的三自由度被动球关节 |
CN201872171U (zh) * | 2010-07-01 | 2011-06-22 | 三一重工股份有限公司 | 一种机械铰接臂的控制装置 |
CN102360223A (zh) * | 2011-07-14 | 2012-02-22 | 长沙中联重工科技发展股份有限公司 | 工程机械以及控制工程机械的机械臂的方法、装置和*** |
-
2011
- 2011-09-28 CN CN201110302722.9A patent/CN102508494B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101776526A (zh) * | 2010-01-26 | 2010-07-14 | 郭孔辉 | 悬架运动学与全工况弹性试验机 |
CN101870110A (zh) * | 2010-07-01 | 2010-10-27 | 三一重工股份有限公司 | 一种机械铰接臂的控制方法及控制装置 |
CN201872171U (zh) * | 2010-07-01 | 2011-06-22 | 三一重工股份有限公司 | 一种机械铰接臂的控制装置 |
CN102009413A (zh) * | 2010-11-02 | 2011-04-13 | 北京航空航天大学 | 一种适用于球电机的具有姿态检测的三自由度被动球关节 |
CN102360223A (zh) * | 2011-07-14 | 2012-02-22 | 长沙中联重工科技发展股份有限公司 | 工程机械以及控制工程机械的机械臂的方法、装置和*** |
Also Published As
Publication number | Publication date |
---|---|
CN102508494A (zh) | 2012-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102508494B (zh) | 机械臂、工程机械和确定机械臂臂节位置的方法 | |
US9989973B2 (en) | Measurement control system for multi-shaft supported air floatation platform | |
CN102878975B (zh) | 一种隧道收敛变形监测方法 | |
CN102392664B (zh) | 一种带倾角传感器的液压支架及其高度测量方法 | |
CN102953552B (zh) | 管桁架相贯口定位方法 | |
CN103206090A (zh) | 一种混凝土泵车智能臂架控制及其变形补偿的方法 | |
CN106370149A (zh) | 发动机正时角度测量装置及检测方法 | |
CN102607599A (zh) | 工程机械的倾角指示器标定方法、标定***和工程机械 | |
CN103792896A (zh) | 集成的重型机械智能臂架控制***及控制方法 | |
CN103542830A (zh) | 圆度测量仪及其测量方法 | |
CN102288149B (zh) | 制动盘外倾角检测装置和制动盘生产线装置 | |
CN105136035A (zh) | 非接触式测量圆桶圆心坐标的装置及其方法 | |
CN106744325A (zh) | 一种测量与预报起重机臂架头部侧移的方法和装置 | |
CN103175454A (zh) | 一种固定百分表的便携式找中表架 | |
CN108458846B (zh) | 一种梁式结构挠度的计算方法、装置和*** | |
CN102910533A (zh) | 一种基于吊机的空间角度测量方法 | |
JP2020003468A (ja) | 軸方向圧力に基づく柱体のササエ圧断面のオフセットを決定する方法及びシステム | |
CN103557823A (zh) | 布料臂架振动位移检测方法、检测***、控制器及设备 | |
CN211178454U (zh) | 一种高支模智能安全监控装置 | |
CN102889875A (zh) | 一种隧道收敛变形监测用的传感*** | |
CN210293120U (zh) | 一种钢卷宽度测量装置 | |
CN111551374A (zh) | 一种动力总成质心加速度道路谱的确定方法 | |
CN205642267U (zh) | 一种塑料波纹管内径变形测量装置 | |
CN108502736A (zh) | 一种基于gnss的塔机吊钩定位方法 | |
RU2332650C1 (ru) | Способ определения статического момента тела |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |