CN112936242B - 判断臂架操作安全性的方法、装置及工程机械 - Google Patents
判断臂架操作安全性的方法、装置及工程机械 Download PDFInfo
- Publication number
- CN112936242B CN112936242B CN202110129410.6A CN202110129410A CN112936242B CN 112936242 B CN112936242 B CN 112936242B CN 202110129410 A CN202110129410 A CN 202110129410A CN 112936242 B CN112936242 B CN 112936242B
- Authority
- CN
- China
- Prior art keywords
- arm
- arm section
- safety
- operation input
- section
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/08—Programme-controlled manipulators characterised by modular constructions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
- B25J17/02—Wrist joints
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
Abstract
本发明涉及工程机械领域,公开了一种判断臂架操作安全性的方法、装置及工程机械,该方法包括至少获取至少一节臂节中的每一节臂节对应的操作输入,其中,所述至少一节臂节为所述臂架中的期望操作的臂节;基于所获取的操作输入,确定安全性判断参数,其中,所述安全性判断参数用于表达所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的整体情况;以及基于所述安全性判断参数,判断所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的安全性。藉此,实现了避免仅针对单独臂节操作的安全性进行判断导致的丧失控制灵活性。
Description
技术领域
本发明涉及工程机械领域,具体地,涉及一种判断臂架操作安全性的方法、装置及工程机械。
背景技术
高举臂架的工程设备有倾翻风险,须加控制;带折臂的工程设备,臂架姿态复杂,通常追求极限作业(区域),对防倾翻控制具有更高的要求。例如,臂架泵车、带折臂的起重机械、折臂消防车等。
现有技术中公开了一些技术方案,可以实现对臂架操作的安全性进行判断,进而根据判断结果防倾翻。在这些技术方案中,通过对单独臂节操作的安全性进行判断,确保臂架中的每一节臂节的操作都更安全来保证操作的效用整体上一定是有利于稳定安全性的增加。但是,这样会导致丧失控制灵活性。另外,在这些技术方案中,一些技术方案判断臂架操作安全性的判据复杂,运算复杂,增加了系统成本和运行可靠性风险。
发明内容
本发明的目的是提供一种判断臂架操作安全性的方法、装置及工程机械,其可实现解决或至少部分解决上述问题。
为了实现上述目的,本发明的一个方面提供一种用于判断工程机械臂架操作安全性的方法,该方法包括:至少获取至少一节臂节中的每一节臂节对应的操作输入,其中,所述至少一节臂节为所述臂架中的期望操作的臂节;基于所获取的操作输入,确定安全性判断参数,其中,所述安全性判断参数用于表达所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的整体情况;以及基于所述安全性判断参数,判断所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的安全性。
可选地,所述基于所述安全性判断参数判断所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的安全性包括:判断所述安全性判断参数是否大于预设值;在所述安全性判断参数大于预设值的情况下,判定所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作增强稳定安全性;以及在所述安全性判断参数小于或等于预设值的情况下,判定所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作降低稳定安全性。
可选地,所述确定所述安全性判断系数还基于:被获取到对应的所述操作输入的臂节中每一节臂节的始端的始端高度,和/或被获取到对应的所述操作输入的臂节中的每一节臂节至末节臂节的合质心的合质心高度。
可选地,所述确定所述安全性判断系数包括:针对被获取到对应的所述操作输入的臂节中的每一节臂节,基于所述始端高度和所述合质心高度,确定所述合质心高度和所述始端高度的高度差值;以及基于被获取到对应的所述操作输入的臂节中的每一节臂节对应的所述操作输入和所述高度差值,确定安全性判断参数。
可选地,所述确定所述安全性判断系数包括基于以下公式确定所述安全性判断参数:其中,i、j表示在被获取到对应的所述操作输入的臂节中所述臂节的序号,被获取到对应的所述操作输入的臂节按照在所述臂架展开的情况下距离所述工程机械的转台由近及远的顺序进行编号,n表示被获取到对应的所述操作输入的臂节的总数,ηi表示第i节臂节的所述操作输入的响应不平衡的修正系数,Opei表示第i节臂节的所述操作输入,Gin.z表示第i节臂节的所述合质心高度,K0i.z表示第i节臂节的所述始端高度,mj表示第j节臂节的质量,S表示所述安全性判断参数。
此外,本发明的另一方面提供一种用于控制工程机械的臂架的方法,该方法包括:根据上述的用于判断工程机械臂架操作安全性的方法,判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性,其中,所述至少一节臂节为所述臂架中的期望操作的臂节;以及根据安全性的判断结果,控制所述至少一节臂节中的每一节臂节。
可选地,所述根据安全性的判断结果控制所述至少一节臂节中的每一节臂节包括:在所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作增强稳定安全性的情况下,控制所述至少一节臂节中的每一节臂节响应对应的所述操作输入以使得所述至少一节臂节进行动作;以及在所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作降低稳定安全性的情况下,控制所述至少一节臂节中的每一节臂节不响应对应的所述操作输入以使得所述至少一节臂节不进行动作。
相应地,本发明的另一方面还提供一种用于判断工程机械臂架操作安全性的装置,该装置包括:操作输入获取模块,用于至少获取至少一节臂节中的每一节臂节对应的操作输入,其中,所述至少一节臂节为所述臂架中的期望操作的臂节;安全性判断参数确定模块,用于基于所获取的操作输入,确定安全性判断参数,其中,所述安全性判断参数用于表达所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的整体情况;以及安全性判断模块,用于基于所述安全性判断参数,判断所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的安全性。
可选地,所述安全性判断模块基于所述安全性判断参数判断所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的安全性包括:判断所述安全性判断参数是否大于预设值;在所述安全性判断参数大于预设值的情况下,判定所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作增强稳定安全性;以及在所述安全性判断参数小于或等于预设值的情况下,判定所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作降低稳定安全性。
可选地,所述安全性判断参数确定模块确定所述安全性判断系数还基于:被获取到对应的所述操作输入的臂节中每一节臂节的始端的始端高度,和/或被获取到对应的所述操作输入的臂节中的每一节臂节至末节臂节的合质心的合质心高度。
可选地,所述安全性判断参数确定模块确定所述安全性判断系数包括:针对被获取到对应的所述操作输入的臂节中的每一节臂节,基于所述始端高度和所述合质心高度,确定所述合质心高度和所述始端高度的高度差值;以及基于被获取到对应的所述操作输入的臂节中的每一节臂节对应的所述操作输入和所述高度差值,确定安全性判断参数。
可选地,所述安全性判断参数确定模块确定所述安全性判断系数包括基于以下公式确定所述安全性判断参数: 其中,i、j表示在被获取到对应的所述操作输入的臂节中所述臂节的序号,被获取到对应的所述操作输入的臂节按照在所述臂架展开的情况下距离所述工程机械的转台由近及远的顺序进行编号,n表示被获取到对应的所述操作输入的臂节的总数,ηi表示第i节臂节的所述操作输入的响应不平衡的修正系数,Opei表示第i节臂节的所述操作输入,Gin.z表示第i节臂节的所述合质心高度,K0i.z表示第i节臂节的所述始端高度,mj表示第j节臂节的质量,S表示所述安全性判断参数。
相应地,本发明的另一方面还提供一种用于控制工程机械的臂架的装置,该装置包括:判断模块,用于根据上述的用于判断工程机械臂架操作安全性的方法,判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性,其中,所述至少一节臂节为所述臂架中的期望操作的臂节;以及控制模块,用于根据安全性的判断结果,控制所述至少一节臂节中的每一节臂节。
可选地,所述控制模块根据安全性的判断结果控制所述至少一节臂节中的每一节臂节包括:在所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作增强稳定安全性的情况下,控制所述至少一节臂节中的每一节臂节响应对应的所述操作输入以使得所述至少一节臂节进行动作;以及在所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作降低稳定安全性的情况下,控制所述至少一节臂节中的每一节臂节不响应对应的所述操作输入以使得所述至少一节臂节不进行动作。
此外,本发明的另一方面还提供一种工程机械,该工程机械包括上述的用于控制工程机械的臂架的装置。
另外,本发明的另一方面还提供一种机器可读存储介质,该机器可读存储介质上存储有指令,该指令用于使得机器执行上述的方法。
通过上述技术方案,基于获取到的操作输入确定用于表达期望操作的臂节进行动作的整体情况的安全性判断参数,基于安全性判断参数对期望操作的臂节均进行动作导致的整体安全性进行判断,其中,期望操作的臂节包括至少一节臂节,如此,从操作至少一节臂节的整体效果判断安全性,对期望操作的臂节整体进行动作的安全性进行判断,避免了仅针对单独臂节操作的安全性进行判断在基于判断结果控制臂节操作时导致的丧失控制灵活性。另外,判断安全性仅需确定安全性判断参数,判据简单,降低了系统成本和运行可靠性风险。
本发明的其它特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本发明的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本发明,但并不构成对本发明的限制。在附图中:
图1是本发明一实施例提供的用于判断工程机械臂架操作安全性的方法的流程图;
图2是本发明另一实施例提供的合质心示意图;
图3是本发明另一实施例提供的计算始端高度和合质心高度时使用到的参量的示意图;
图4是本发明另一实施例提供的用于控制工程机械的臂架的方法的逻辑示意图;
图5是本发明另一实施例提供的用于判断工程机械臂架操作安全性的装置的结构示意图;以及
图6是本发明另一实施例提供的用于控制工程机械的臂架的装置的结构示意图。
附图标记说明
1 操作输入获取模块 2 安全性判断参数确定模块
3 安全性判断模块 4 判断模块
5 控制模块
具体实施方式
以下结合附图对本发明的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明,并不用于限制本发明。
本发明实施例的一个方面提供一种用于判断工程机械臂架操作安全性的方法。
图1是本发明一实施例提供的用于判断工程机械臂架操作安全性的方法的流程图。如图1所示,该方法包括以下内容。
在步骤S10中,至少获取至少一节臂节中的每一节臂节对应的操作输入,其中,至少一节臂节为臂架中的期望操作的臂节,至少一节臂节可以包括单一臂节或多个臂节,也就是说用户可能仅操作单一臂节(单一操作)或同时操作多节臂节(复合操作)。在本发明实施例中,针对任一臂节,操作输入是控制臂节动作的输入指令,可以用于控制驱动臂节的速度。此外,操作输入的具体形式因情况而异,例如,对泵车而言,操作装置使用的是遥控器,则操作输入体现为操作装置输出的电信号或描述速度的数值信息。另外,在该步骤中,可以是获取臂架的所有臂节中的每一节臂节对应的操作输入,其中包括期望操作的至少一节臂节中的每一节臂节对应的操作输入,其中,臂节中的不期望操作的臂节对应的操作输入为0;也可以是仅获取期望操作的至少一节臂节中的每一节臂节对应的操作输入;还可以是,被获取到对应的操作输入的臂节包括期望操作的至少一节臂节,但被获取到对应的操作输入的臂节的总数小于臂架的所有臂节的总数但是大于期望操作的至少一节臂节的总数。
在步骤S11中,基于所获取的操作输入,确定安全性判断参数,其中,安全性判断参数用于表达至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的整体情况,是至少一节臂节中的每一节臂节均基于对应的操作输入进行动作时对稳定安全性的动态影响的评价指标。
在步骤S12中,基于安全性判断参数,判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性。
通过上述技术方案,基于获取到的操作输入确定用于表达期望操作的臂节进行动作的整体情况的安全性判断参数,基于安全性判断参数对期望操作的臂节均进行动作导致的整体安全性进行判断,其中,期望操作的臂节包括至少一节臂节,如此,对期望操作的臂节整体进行动作的安全性进行判断,避免了仅针对单独臂节操作的安全性进行判断在基于判断结果控制臂节操作时导致的丧失控制灵活性。另外,判断安全性仅需确定安全性判断参数,判据简单,降低了系统成本和运行可靠性风险。
可选地,在本发明实施例中,基于安全性判断参数判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性包括以下内容。判断安全性判断参数是否大于预设值,例如,预设值可以是0。在安全性判断参数大于预设值的情况下,判定至少一节臂节中的每一节臂节均基于对应的操作输入进行动作增强稳定安全性;在安全性判断参数小于或等于预设值的情况下,判定至少一节臂节中的每一节臂节均基于对应的操作输入进行动作降低稳定安全性。
可选地,在本发明实施例中,确定安全性判断系数时除了基于所获取的操作输入以外,还可以基于:被获取到对应的操作输入的臂节中的每一节臂节的始端的始端高度,和/或被获取到对应的操作输入的臂节中的每一节臂节至末节臂节的合质心的合质心高度。其中,在臂架的所有臂节中,任一臂节的始端为在臂架展开的情况下距离转台最近的一端,任一臂节的末端为在臂架展开的情况下距离转台最远的一端;末节臂节为在臂架的所有臂节展开的情况下距离转台最远的一节臂节,在臂架的所有臂架展开的情况下距离转台最近的一节臂节为始端臂节。例如,可以参照图2来理解合质心。如图2所示,假设期望操作的至少一节臂节包括臂架的第j节臂节和第k节臂节,第j节臂节的合质心为Gjn,第j节臂节的合质心的合质心高度可以记为Gjn.z,第k节臂节的合质心为Gkn,第k节臂节的合质心的合质心高度可以记为Gkn.z。其中,j和k为臂节的序号,在该示例中,按照从臂架的始端臂节至末端臂节的顺序对臂架的所有臂节进行编号,序号从1开始,图2中省略了第1-(j-1)节臂节。另外,始端高度和合质心高度可以分别是始端距离地面的竖直高度、合质心距离地面的竖直高度。
另外,在本发明实施例中,可以参照以下示例内容计算任一臂节的始端高度和合质心高度。在该示例中,以计算臂架的第i节臂节的始端高度和合质心高度为例进行说明。这里描述的第i节臂节为将臂架的所有臂节按照从始端臂节到末端臂节的顺序从1进行编号时的序号。需要说明的是,在本发明实施例中,在基于以下内容计算始端高度和合质心高度时,无论被获取到对应的操作输入的臂节是否是包括臂架的所有臂节,需要计算始端高度和合质心高度的臂节需要被确定出其在臂架的所有臂节中按照从臂架的始端臂节到末端臂节的顺序进行编号时的序号,然后再按照以下内容确定出其始端高度和合质心高度。也就是以下内容中的第i节臂节的序号i为该臂节在臂架的所有臂节中的编号,而不管其在被获取到对应的操作输入的臂节中的编号。另外,以下内容中所有涉及到臂节的序号均是针对臂架的所有臂节按照从臂架的始端臂节至末端臂节的顺序进行编号。
1)先计算第i节臂节的始端K0i的始端高度K0i.z
2)再计算第i节臂节质心的高度Gi.z
Gi.z=K0i.z+Di*sin(θi)
3)最后计算i节臂节到末节臂节n的合质心的合质心高度Gin.z
其中,Li为第i节臂节的长度,θi为第i节臂节的倾角,Di为第i节臂节的质心距离其始端的长度,mt为第t节臂节的质量。另外,可以参照图3对本发明实施例中计算始端高度和合质心高度时使用到的参量进行理解。在图3所示的臂架示例中,臂架共5节臂节,对所有臂节按照从始端臂节到末端臂节的顺序进行编号,1-5;θ1、θ2、θ3、θ4、θ5分别表示第1、2、3、4、5节臂节的倾角;K01表示第1节臂节的始端,K02表示第2节臂节的始端,K03表示第3节臂节的始端;K01.z表示第1节臂节的始端高度,K02.z表示第2节臂节的始端高度;G2表示第2节臂节的质心,G2.z表示第2节臂节质心的高度,G25表示从第2节臂节至第5节臂节的合质心,G25.z表示从第2节臂节至第5节臂节的合质心的合质心高度;L2表示第2节臂节的长度;D2表示第2节臂节的质心距离其始端的长度。需要说明的是,无论本发明实施例中涉及到的臂架包括多少节臂节,均可以参照图3来理解计算始端高度和合质心高度以及在计算时用到的参量。此外,在本发明实施例中,获取臂节的倾角的方式可以有多种,例如,可以直接采用倾角传感器检测;也可以由其他检测方式间接获取,如通过编码器检测臂架间的夹角、或检测臂架油缸行程换算出臂架间的夹角;还可以使用现有技术中公开的其他检测臂节倾角的方法来获取倾角。另外,关于臂节的合质心的计算可以采用现有技术中所有公开的技术,在此不再赘述。
可选地,在本发明实施例中,可以基于以下内容来确定安全性判断系数。针对被获取到对应的操作输入的臂节中的每一节臂节,基于始端高度和合质心高度,确定合质心高度和始端高度的高度差值;以及基于被获取到对应的操作输入的臂节中的每一节臂节对应的操作输入和高度差值,确定安全性判断参数。例如,可以是,针对被获取到对应的操作输入的臂节中的每一节臂节,用合质心高度减去始端高度得到高度差值,将该节臂节的高度差值和对应的操作输入相乘得到乘积,然后将被获取到对应的操作输入的臂节中的每一节臂节对应的求和得到安全性判断系数。在本发明实施例中,在计算方面仅仅是简单的加减和乘法运算,无需复杂的函数运算,运算简单,进一步降低了系统成本和运行可靠性风险。
可选地,在计算安全性判断系数时,除了考虑臂节的合质心高度、始端高度和操作输入外,还可以考虑其他参量,例如,修正系数和臂节的质量。
例如,可以基于以下公式计算安全性判断系数。
其中,i、j表示在被获取到对应的操作输入的臂节中臂节的序号,被获取到对应的操作输入的臂节按照在臂架展开的情况下距离工程机械的转台由近及远的顺序进行编号,n表示被获取到对应的操作输入的臂节的总数,ηi表示第i节臂节的操作输入的响应不平衡的修正系数,Opei表示第i节臂节的操作输入,Gin.z表示第i节臂节的合质心高度,K0i.z表示第i节臂节的始端高度,mj表示第j节臂节的质量,S表示安全性判断参数。需要说明的是,在计算安全性判断系数中用到的臂节的序号是针对被获取到对应的操作输入的所有臂节,按照在臂架展开的情况下,距离转台由近及远的顺序进行编号而得到的序号。这里被编号的臂节与上述实施例中计算始端高度和合质心高度时被编号的臂节在被获取到对应的操作输入的臂节是臂架的所有臂节的情况下是包括相同的臂节,当被获取到对应的操作输入的臂节不是臂架的所有臂节的情况下两种情况下被编号的臂节不是包括相同的臂节。但是,在计算安全性判断系数时用到的始端高度和合质心高度均可以参照上述实施例中所述的计算始端高度和合质心高度的方式进行计算。在本发明实施例中,通过计算安全性判断系数S基于S判断臂节操作的安全性,实现了对臂节操作整体安全性的数值计算评价方法;通过计算安全性判断系数S,定量地评估臂节操作对安全性的影响,并且是整体性的判断用户操作臂节对稳定安全性的影响,可以避免现有技术中因仅针对单一臂节操作的安全性进行判断而导致的在控制臂节操作时的丧失控制灵活性。此外,在计算安全性判断参数时仅仅使用到了高度属性,且计算过程仅仅是简单的加减和乘法运算,运算简单,降低了系统成本和运行可靠性风险,且执行效率高,置信度高。另外,在本发明实施例中,给出了计算安全性判断系数的具体算式,不是单纯的理论方法,而是实用的技术,容易在工程上实现,相比于现有技术中的具有方法论意义的技术方案更具有实用性。另外,ηi由工程机械的设计和器件选型(例如,油缸采用粗油缸还是细油缸等等)决定,可以通过测试获取。
此外,本发明实施例的另一方面提供一种控制工程机械的臂架的方法。在本发明实施例中,该用于控制工程机械的臂架的方法可以包括以下内容。根据上述实施例中所述的用于判断工程机械臂架操作安全性的方法,判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性,其中,至少一节臂节为臂架中的期望操作的臂节;以及根据安全性的判断结果,控制至少一节臂节中的每一节臂节。
现有技术中,仅针对单独臂节操作的安全性进行判断且基于针对单独臂节的安全性判断结果控制相应的臂节,导致有些可能单独作用效果会导致稳定安全性变差的操作输入被限制,期望操作的臂节不能按照预期进行动作,可能导致臂架按照非预期的方式动作,不能实现用户期待的臂架姿态,丧失用户操作的灵活性,降低了用户体验,损害了施工效率。在本发明实施例中,从操作期望操作的至少一节臂节的整体效果判断安全性,对期望操作的臂节整体进行动作的安全性进行判断,根据安全性的判断结果控制臂节,允许在至少一节臂节对应的所有操作输入中夹杂着单独作用效果会导致稳定安全性变差的操作输入(尽管单独操作可能会导致稳定安全性变差但整体效果仍是令稳定安全性变好的)并使其可以对其对应的臂节进行相应的动作,尽可能的使得用户期望操作的臂节按照预期的方式进行相应的动作,尽可能的实现用户期待的臂架姿态,使得安全保护措施尽量不违背用户的操作意愿。如此,实现了提高用户操作的灵活性,提高了用户体验,提高了施工效率。
可选地,在本发明实施例中,根据安全性的判断结果控制至少一节臂节中的每一节臂节包括:在至少一节臂节中的每一节臂节均基于对应的操作输入进行动作增强稳定安全性的情况下,控制至少一节臂节中的每一节臂节响应对应的操作输入以使得至少一节臂节进行动作;以及在至少一节臂节中的每一节臂节均基于对应的操作输入进行动作降低稳定安全性的情况下,控制至少一节臂节中的每一节臂节不响应对应的操作输入以使得至少一节臂节不进行动作。
图4是本发明另一实施例提供的用于控制工程机械的臂架的方法的逻辑示意图。下面结合图4对本发明实施例提供的用于控制工程机械的臂架的方法进行示例性介绍。
至少获取至少一节臂节中的每一节臂节对应的操作输入,其中,至少一节臂节为臂架中的期望操作的臂节。获取被获取到对应的操作输入的臂节中的每一节臂节的始端的始端高度以及被获取到对应的操作输入的臂节中的每一节臂节至末节臂节的合质心的合质心高度。参照上述实施例中所述的安全性判断参数S的对应公式确定安全性判断参数S。判断S是否大于0,在S大于的情况下,判定至少一节臂节中的每一节臂节均基于对应的操作输入进行动作增强稳定安全性;在S小于或等于0的情况下,判定至少一节臂节中的每一节臂节均基于对应的操作输入进行动作降低稳定安全性。在至少一节臂节中的每一节臂节均基于对应的操作输入进行动作增强稳定安全性的情况下,控制至少一节臂节中的每一节臂节响应对应的操作输入以使得至少一节臂节进行动作。在至少一节臂节中的每一节臂节均基于对应的操作输入进行动作降低稳定安全性的情况下,控制至少一节臂节中的每一节臂节不响应对应的操作输入以使得至少一节臂节不进行动作。
相应地,本发明实施例的另一方面还提供一种用于判断工程机械臂架操作安全性的装置。
图5是本发明另一实施例提供的用于判断工程机械臂架操作安全性的装置的结构框图。如图5所示,该装置包括操作输入获取模块1、安全性判断参数确定模块2和安全性判断模块3。其中,操作输入获取模块1用于至少获取至少一节臂节中的每一节臂节对应的操作输入,其中,至少一节臂节为臂架中的期望操作的臂节;安全性判断参数确定模块2用于基于所获取的操作输入,确定安全性判断参数,其中,安全性判断参数用于表达至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的整体情况;安全性判断模块3用于基于安全性判断参数,判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性。
可选地,在本发明实施例中,安全性判断模块基于安全性判断参数判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性包括:判断安全性判断参数是否大于预设值;在安全性判断参数大于预设值的情况下,判定至少一节臂节中的每一节臂节均基于对应的操作输入进行动作增强稳定安全性;以及在安全性判断参数小于或等于预设值的情况下,判定至少一节臂节中的每一节臂节均基于对应的操作输入进行动作降低稳定安全性。
可选地,在本发明实施例中,安全性判断参数确定模块确定安全性判断系数还基于:被获取到对应的操作输入的臂节中每一节臂节的始端的始端高度,和/或被获取到对应的操作输入的臂节中的每一节臂节至末节臂节的合质心的合质心高度。
可选地,在本发明实施例中,安全性判断参数确定模块确定安全性判断系数包括:针对被获取到对应的操作输入的臂节中的每一节臂节,基于始端高度和合质心高度,确定合质心高度和始端高度的高度差值;以及基于被获取到对应的操作输入的臂节中的每一节臂节对应的操作输入和高度差值,确定安全性判断参数。
可选地,在本发明实施例中,安全性判断参数确定模块确定安全性判断系数包括基于以下公式确定安全性判断参数: 其中,i、j表示在被获取到对应的操作输入的臂节中臂节的序号,被获取到对应的操作输入的臂节按照在臂架展开的情况下距离工程机械的转台由近及远的顺序进行编号,n表示被获取到对应的操作输入的臂节的总数,ηi表示第i节臂节的操作输入的响应不平衡的修正系数,Opei表示第i节臂节的操作输入,Gin.z表示第i节臂节的合质心高度,K0i.z表示第i节臂节的始端高度,mj表示第j节臂节的质量,S表示安全性判断参数。
本发明实施例提供的用于判断工程机械臂架操作安全性的装置的具体工作原理及益处与本发明实施例提供的用于判断工程机械臂架操作安全性的方法的具体工作原理及益处相似,这里将不再赘述这。
相应地,本发明实施例的另一方面还提供一种用于控制工程机械的臂架的装置。
图6是本发明另一实施例提供的用于控制工程机械的臂架的装置的结构框图。如图6所示,该装置包括判断模块4和控制模块5。其中,判断模块4用于上述实施例中所述的用于判断工程机械臂架操作安全性的方法,判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性,其中,至少一节臂节为所述臂架中的期望操作的臂节;控制模块5用于根据安全性的判断结果,控制至少一节臂节中的每一节臂节。
可选地,在本发明实施例中,控制模块根据安全性的判断结果控制至少一节臂节中的每一节臂节包括:在至少一节臂节中的每一节臂节均基于对应的操作输入进行动作增强稳定安全性的情况下,控制至少一节臂节中的每一节臂节响应对应的操作输入以使得至少一节臂节进行动作;以及在至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作降低稳定安全性的情况下,控制至少一节臂节中的每一节臂节不响应对应的操作输入以使得所述至少一节臂节不进行动作。
本发明实施例提供的用于控制工程机械的臂架的装置的具体工作原理及益处与本发明实施例提供的用于控制工程机械的臂架的方法的具体工作原理及益处相似,这里将不再赘述。
此外,本发明实施例的另一方面还提供一种工程机械,该工程机械包括上述实施例中所述的用于控制工程机械的臂架的装置。
另外,本发明实施例的另一方面还提供一种机器可读存储介质,该机器可读存储介质上存储有指令,该指令用于使得机器执行上述实施例中所述的用于判断工程机械臂架操作安全性的方法或用于控制工程机械的臂架的方法。
以上结合附图详细描述了本发明的优选实施方式,但是,本发明并不限于上述实施方式中的具体细节,在本发明的技术构思范围内,可以对本发明的技术方案进行多种简单变型,这些简单变型均属于本发明的保护范围。
另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合。为了避免不必要的重复,本发明对各种可能的组合方式不再另行说明。
此外,本发明的各种不同的实施方式之间也可以进行任意组合,只要其不违背本发明的思想,其同样应当视为本发明所公开的内容。
Claims (12)
1.一种用于判断工程机械臂架操作安全性的方法,其特征在于,该方法包括:
至少获取至少一节臂节中的每一节臂节对应的操作输入,其中,所述至少一节臂节为所述臂架中的期望操作的臂节;
基于所获取的操作输入、被获取到对应的所述操作输入的臂节中每一节臂节的始端的始端高度和被获取到对应的所述操作输入的臂节中的每一节臂节至末节臂节的合质心的合质心高度,确定安全性判断参数,其中,所述安全性判断参数用于表达所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的整体情况;以及
基于所述安全性判断参数,判断所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的安全性;
其中,所述确定所述安全性判断参数包括:
针对被获取到对应的所述操作输入的臂节中的每一节臂节,基于所述始端高度和所述合质心高度,确定所述合质心高度和所述始端高度的高度差值;以及
基于被获取到对应的所述操作输入的臂节中的每一节臂节对应的所述操作输入和所述高度差值,确定安全性判断参数。
2.根据权利要求1所述的方法,其特征在于,所述基于所述安全性判断参数判断所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的安全性包括:
判断所述安全性判断参数是否大于预设值;
在所述安全性判断参数大于预设值的情况下,判定所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作增强稳定安全性;以及
在所述安全性判断参数小于或等于预设值的情况下,判定所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作降低稳定安全性。
4.一种用于控制工程机械的臂架的方法,其特征在于,该方法包括:
根据权利要求1-3中任一项所述的方法,判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性,其中,所述至少一节臂节为所述臂架中的期望操作的臂节;以及
根据安全性的判断结果,控制所述至少一节臂节中的每一节臂节。
5.根据权利要求4所述的方法,其特征在于,所述根据安全性的判断结果控制所述至少一节臂节中的每一节臂节包括:
在所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作增强稳定安全性的情况下,控制所述至少一节臂节中的每一节臂节响应对应的所述操作输入以使得所述至少一节臂节进行动作;以及
在所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作降低稳定安全性的情况下,控制所述至少一节臂节中的每一节臂节不响应对应的所述操作输入以使得所述至少一节臂节不进行动作。
6.一种用于判断工程机械臂架操作安全性的装置,其特征在于,该装置包括:
操作输入获取模块,用于至少获取至少一节臂节中的每一节臂节对应的操作输入,其中,所述至少一节臂节为所述臂架中的期望操作的臂节;
安全性判断参数确定模块,用于基于所获取的操作输入、被获取到对应的所述操作输入的臂节中每一节臂节的始端的始端高度和被获取到对应的所述操作输入的臂节中的每一节臂节至末节臂节的合质心的合质心高度,确定安全性判断参数,其中,所述安全性判断参数用于表达所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的整体情况;以及
安全性判断模块,用于基于所述安全性判断参数,判断所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的安全性;
其中,所述安全性判断参数确定模块确定所述安全性判断参数包括:
针对被获取到对应的所述操作输入的臂节中的每一节臂节,基于所述始端高度和所述合质心高度,确定所述合质心高度和所述始端高度的高度差值;以及
基于被获取到对应的所述操作输入的臂节中的每一节臂节对应的所述操作输入和所述高度差值,确定安全性判断参数。
7.根据权利要求6所述的装置,其特征在于,所述安全性判断模块基于所述安全性判断参数判断所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作的安全性包括:
判断所述安全性判断参数是否大于预设值;
在所述安全性判断参数大于预设值的情况下,判定所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作增强稳定安全性;以及
在所述安全性判断参数小于或等于预设值的情况下,判定所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作降低稳定安全性。
9.一种用于控制工程机械的臂架的装置,其特征在于,该装置包括:
判断模块,用于根据权利要求1-3中任一项所述的方法,判断至少一节臂节中的每一节臂节均基于对应的操作输入进行动作的安全性,其中,所述至少一节臂节为所述臂架中的期望操作的臂节;以及
控制模块,用于根据安全性的判断结果,控制所述至少一节臂节中的每一节臂节。
10.根据权利要求9所述的装置,其特征在于,所述控制模块根据安全性的判断结果控制所述至少一节臂节中的每一节臂节包括:
在所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作增强稳定安全性的情况下,控制所述至少一节臂节中的每一节臂节响应对应的所述操作输入以使得所述至少一节臂节进行动作;以及
在所述至少一节臂节中的每一节臂节均基于对应的所述操作输入进行动作降低稳定安全性的情况下,控制所述至少一节臂节中的每一节臂节不响应对应的所述操作输入以使得所述至少一节臂节不进行动作。
11.一种工程机械,其特征在于,该工程机械包括权利要求9或10所述的装置。
12.一种机器可读存储介质,该机器可读存储介质上存储有指令,该指令用于使得机器执行权利要求1-5中任一项所述的方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110129410.6A CN112936242B (zh) | 2021-01-29 | 2021-01-29 | 判断臂架操作安全性的方法、装置及工程机械 |
PCT/CN2021/099533 WO2022160558A1 (zh) | 2021-01-29 | 2021-06-11 | 判断臂架操作安全性的方法、装置及工程机械 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110129410.6A CN112936242B (zh) | 2021-01-29 | 2021-01-29 | 判断臂架操作安全性的方法、装置及工程机械 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112936242A CN112936242A (zh) | 2021-06-11 |
CN112936242B true CN112936242B (zh) | 2022-07-26 |
Family
ID=76240091
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110129410.6A Active CN112936242B (zh) | 2021-01-29 | 2021-01-29 | 判断臂架操作安全性的方法、装置及工程机械 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN112936242B (zh) |
WO (1) | WO2022160558A1 (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102508494A (zh) * | 2011-09-28 | 2012-06-20 | 中联重科股份有限公司 | 机械臂、工程机械和确定机械臂臂节位置的方法 |
CN103321428A (zh) * | 2013-07-03 | 2013-09-25 | 中联重科股份有限公司 | 一种臂架智能控制装置、系统、方法和工程机械 |
CN106744554A (zh) * | 2016-12-20 | 2017-05-31 | 徐州海伦哲专用车辆股份有限公司 | 一种可实现车身防自损的下折式高空作业车控制方法 |
CN110673653A (zh) * | 2019-09-12 | 2020-01-10 | 中联重科股份有限公司 | 工程机械的防倾翻控制方法、装置及该工程机械 |
CN111761574A (zh) * | 2020-05-28 | 2020-10-13 | 中联重科股份有限公司 | 判断臂架可进行的操作的安全性的方法和装置及工程机械 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07229161A (ja) * | 1994-02-16 | 1995-08-29 | Komatsu Ltd | 建設機械の作業機軌跡制御装置 |
CN102385391B (zh) * | 2011-07-14 | 2014-09-10 | 中联重科股份有限公司 | 机械臂的控制方法与控制装置以及工程机械 |
CN102393754B (zh) * | 2011-09-28 | 2014-04-16 | 三一重工股份有限公司 | 臂架动作控制方法、系统及臂架末端直线位移控制方法、系统及混凝土泵车 |
CN202257258U (zh) * | 2011-10-27 | 2012-05-30 | 中联重科股份有限公司 | 带臂架的工程机械及其控制装置 |
CN103604408B (zh) * | 2013-11-22 | 2017-01-25 | 长沙中联消防机械有限公司 | 臂架工作状态参数检测方法、设备、系统及工程机械 |
-
2021
- 2021-01-29 CN CN202110129410.6A patent/CN112936242B/zh active Active
- 2021-06-11 WO PCT/CN2021/099533 patent/WO2022160558A1/zh active Application Filing
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102508494A (zh) * | 2011-09-28 | 2012-06-20 | 中联重科股份有限公司 | 机械臂、工程机械和确定机械臂臂节位置的方法 |
CN103321428A (zh) * | 2013-07-03 | 2013-09-25 | 中联重科股份有限公司 | 一种臂架智能控制装置、系统、方法和工程机械 |
CN106744554A (zh) * | 2016-12-20 | 2017-05-31 | 徐州海伦哲专用车辆股份有限公司 | 一种可实现车身防自损的下折式高空作业车控制方法 |
CN110673653A (zh) * | 2019-09-12 | 2020-01-10 | 中联重科股份有限公司 | 工程机械的防倾翻控制方法、装置及该工程机械 |
CN111761574A (zh) * | 2020-05-28 | 2020-10-13 | 中联重科股份有限公司 | 判断臂架可进行的操作的安全性的方法和装置及工程机械 |
Also Published As
Publication number | Publication date |
---|---|
WO2022160558A1 (zh) | 2022-08-04 |
CN112936242A (zh) | 2021-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104591051B (zh) | 一种曲臂式高空作业车多模式幅度控制系统 | |
JPH07125987A (ja) | 移動式クレーンの吊り荷重、転倒モーメント検出装置 | |
JP6518279B2 (ja) | クレーンの積載荷重を確認する方法、およびクレーン | |
CN106586918A (zh) | 一种可实现自动限幅的折叠臂高空作业车控制方法 | |
US20020013666A1 (en) | Method for the overload protection of a mobile crane | |
US9126812B2 (en) | Method for determining the load capacity of cranes | |
CN112936242B (zh) | 判断臂架操作安全性的方法、装置及工程机械 | |
EP0731054A1 (en) | Mobile reach tower crane | |
CN102491177B (zh) | 可回转工程机械及其回转控制方法与装置 | |
KR20230128371A (ko) | 크레인 슈퍼 리프팅 반경 제어 방법, 시스템 및 크레인 | |
CN112627279B (zh) | 主动降低挖掘机动作冲击的方法、装置及工程机械 | |
CN110654995B (zh) | 臂长修正、检测、工况识别系统与方法、及起重机 | |
CN113504763A (zh) | 工作台负载重量的控制方法、装置、设备及存储介质 | |
CN111943049A (zh) | 电气控制系统、方法、控制器和工程机械 | |
CN114314394B (zh) | 用于起重机的控制方法、处理器、控制装置及起重机 | |
CN115043338B (zh) | 起重设备的安全控制方法及系统 | |
CN115195674A (zh) | 用于工程设备支腿的控制方法、控制器、装置和工程设备 | |
CN113136907B (zh) | 作业机械的数据识别方法、装置、系统及电子设备 | |
CN115973975A (zh) | 用于高空作业平台的控制方法、控制器及高空作业平台 | |
CN116377930A (zh) | 运行控制方法以及除冰车 | |
EP3822118B1 (en) | A hooklift arrangement, a vehicle, and a method in relation thereto | |
CN113753751B (zh) | 用于起重机防摇控制的方法、控制器、装置及起重机 | |
KR102413757B1 (ko) | 리깅 분석 장치 및 그 방법 | |
CN113623291B (zh) | 臂架液压系统的故障诊断方法、装置及作业机械 | |
CN109236801B (zh) | 起重机伸缩油缸油压状态检测方法、装置及起重机 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |