CN115302509B - 用于控制工程设备臂架的方法、处理器、装置及工程设备 - Google Patents
用于控制工程设备臂架的方法、处理器、装置及工程设备 Download PDFInfo
- Publication number
- CN115302509B CN115302509B CN202210983552.3A CN202210983552A CN115302509B CN 115302509 B CN115302509 B CN 115302509B CN 202210983552 A CN202210983552 A CN 202210983552A CN 115302509 B CN115302509 B CN 115302509B
- Authority
- CN
- China
- Prior art keywords
- arm
- pose information
- kinematic pairs
- current
- joint
- 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
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A20/00—Water conservation; Efficient water supply; Efficient water use
- Y02A20/20—Controlling water pollution; Waste water treatment
- Y02A20/204—Keeping clear the surface of open water from oil spills
Abstract
本发明涉及工程设备技术领域,公开了一种用于控制工程设备臂架的方法、处理器、装置及工程设备。方法包括:获取臂架的当前位姿信息,以此确定臂架的末端的当前位置;根据当前位置和输入的运动指令确定臂架的末端的期望位置;确定同一平面内臂架的自由度数;在确定自由度数超过预设数量的情况下,根据期望位置、第一数量的运动副对应的当前位姿信息确定臂架的除第一数量的运动副以外的其他运动副对应的期望位姿信息,进而根据第一数量的运动副对应的当前位姿信息和其他运动副对应的期望位姿信息生成用于调节臂架位姿的控制指令。本发明可以解决冗余自由度多解的问题,从而有效地降低了在确定用于调节臂架位姿的控制指令时的计算难度。
Description
技术领域
本发明涉及工程设备技术领域,具体地涉及一种用于控制工程设备臂架的方法、处理器、装置及工程设备。
背景技术
现有的包括臂架的工程设备的臂架通常是冗余自由度串联机构,以高空作业车为例,其广泛应用于市政、风电、机场、设备安装维护等场合。工程设备的应用场合日益广泛,同时也将面临作业环境复杂、作业难度高等问题,这就对高空作业车作业的高效性、智能性提出更高要求。
工程设备的臂架由多个节臂和连接节臂的关节组成,目前,在常规技术中针对工程设备臂架末端的位置进行控制时,采用的控制算法运算时间较长,无法达到实时控制效果。并且,当臂式高空作业平台的臂架自由度存在冗余时,会为求解各关节逆运动学带来困难,常规方式会采用比较通用的解法,例如几何法、迭代法,但是采用这些方法时,计算量会随着臂架自由度的提高而增加,求解时间无法满足实时控制的要求。
发明内容
针对现有技术中的上述不足,本发明实施例的目的是提供一种用于控制工程设备臂架的方法、处理器、装置及工程设备。
为了实现上述目的,本发明第一方面提供一种用于控制工程设备臂架的方法,臂架包括多个节臂以及连接多个节臂的关节,包括:
获取臂架的当前位姿信息,当前位姿信息包括节臂的当前转动角度和/或节臂的当前伸缩量;
根据当前位姿信息确定臂架的末端的当前位置;
根据当前位置和输入的运动指令确定臂架的末端的期望位置;
确定同一平面内臂架的自由度数,自由度数包括节臂转动和/或节臂伸缩的数量;
在确定自由度数超过预设数量的情况下,确定第一数量的运动副,运动副包括节臂转动和/或节臂伸缩,第一数量为自由度数与预设数量的差值;
根据期望位置、第一数量的运动副对应的当前位姿信息确定臂架的除第一数量的自由度以外的其他运动副对应的期望位姿信息;以及
根据第一数量的运动副对应的当前位姿信息和其他运动副对应的期望位姿信息生成用于调节臂架位姿的控制指令。
在本发明实施例中,根据期望位置、第一数量的运动副对应的当前位姿信息确定臂架的除第一数量的运动副以外的其他运动副对应的期望位姿信息,包括:
将期望位置和第一数量的运动副对应的当前位姿信息输入至逆向运动学模型,以确定其他运动副对应的期望位姿信息。
在本发明实施例中,将期望位置和第一数量的运动副对应的当前位姿信息输入至逆向运动学模型,以确定其他运动副对应的期望位姿信息,包括:
基于期望位置和第一数量的运动副对应的当前位姿信息确定逆向运动学模型是否存在实数解;
如果确定逆向运动学模型存在实数解,则判断实数解是否超出其他运动副对应的第一预设运动范围;
如果实数解未超出第一预设运动范围,则基于实数解确定其他运动副对应的期望位姿信息。
在本发明实施例中,将期望位置和第一数量的运动副对应的当前位姿信息输入至逆向运动学模型,以确定第一数量的运动副以外的其他运动副对应的期望位姿信息,包括:
如果确定逆向运动学模型不存在实数解,或存在超出第一预设运动范围的实数解,则基于第一数量的运动副对应的第二预设运动范围对第一数量的运动副对应的当前位姿信息进行调整,以重新确定逆向运动学模型是否存在实数解,直至得到未超出第一预设运动范围的实数解。
在本发明实施例中,基于第一数量的运动副对应的第二预设运动范围对第一数量的运动副对应的当前位姿信息进行调整,包括:
确定第一数量的运动副中用于对臂架的末端进行调节以使末端保持水平状态的平台调平转动自由度,保持平台调平转动自由度对应的当前位姿信息不变;
基于第一数量的运动副中剩余自由度对应的第二预设运动范围对剩余运动副对应的当前位姿信息进行调整。
在本发明实施例中,逆向运动学模型是通过以下步骤建立的:
获取臂架的初始位姿信息,初始位姿信息包括连接多个节臂的关节的初始位置和臂架的末端的初始位置;
基于多个节臂之间的空间几何关系和初始位姿信息建立逆向运动学模型。
在本发明实施例中,获取臂架的当前位姿信息,包括:
响应于监测到用于控制臂架的末端移动的控制信号,获取当前时刻的臂架的当前位姿信息。
在本发明实施例中,根据当前位姿信息确定臂架的末端的当前位置,包括:
将当前位姿信息输入至正向运动学模型,以确定臂架的末端的当前位置;
其中,正向运动学模型是基于旋量法建立的。
在本发明实施例中,多个节臂包括塔臂、主臂、飞臂以及工作平台,关节包括转台转动关节、塔臂转动关节、塔臂伸缩、主臂转动关节、主臂伸缩、飞臂转动关节以及平台调平转动关节,
转台转动关节通过塔臂转动关节与塔臂的一端连接,塔臂的另一端通过塔臂伸缩关节与主臂转动关节的一端连接,主臂转动关节的另一端与主臂的一端连接,主臂的另一端通过主臂伸缩关节与飞臂转动关节的一端连接,飞臂转动关节的另一端与飞臂的一端连接,飞臂的另一端通过平台调平转动关节与工作平台连接;
当前位姿信息包括转台转动的第一当前转动角度、塔臂转动的第二当前转动角度、主臂转动的第三当前转动角度、飞臂转动的第四当前转动角度、平台调平转动的第五当前转动角度、塔臂伸缩的第一伸缩量以及主臂伸缩的第二伸缩量;
同一平面内臂架的运动副包括:塔臂转动、主臂转动、飞臂转动、平台调平转动、塔臂伸缩以及主臂伸缩;
确定第一数量的运动副包括:基于实际工况确定的同一平面内运动频率最低的第一数量的运动副。
在本发明实施例中,第一数量的运动副包括塔臂转动、塔臂伸缩以及平台调平转动。
本发明第二方面提供一种处理器,被配置成执行时实现如上的用于控制工程设备臂架的方法的步骤。
本发明第三方面提供一种用于控制工程设备臂架的装置,包括:
液压驱动系统,用于驱动臂架运动;
传感器,用于检测臂架的位姿;
如上的处理器;以及
液压伺服控制器,被配置成:
响应于接收到的控制信号,根据传感器检测的位姿生成位姿信息,并将生成的位姿信息输送至处理器;
根据从处理器接收的用于调节臂架位姿的控制指令控制液压驱动系统驱动臂架运动。
在本发明实施例中,还包括:
遥控器,用于响应于用户操作发送控制信号。
本发明第四方面提供一种工程设备,包括:
臂架,臂架包括多个节臂以及连接多个节臂的关节;
如上的用于控制工程设备臂架的装置。
在本发明实施例中,多个节臂包括塔臂、主臂、飞臂以及工作平台,关节包括转台转动关节、塔臂转动关节、塔臂伸缩、主臂转动关节、主臂伸缩、飞臂转动关节以及平台调平转动关节,转台转动关节通过塔臂转动关节与塔臂的一端连接,塔臂的另一端通过塔臂伸缩关节与主臂转动关节的一端连接,主臂转动关节的另一端与主臂的一端连接,主臂的另一端通过主臂伸缩关节与飞臂转动关节的一端连接,飞臂转动关节的另一端与飞臂的一端连接,飞臂的另一端通过平台调平转动关节与工作平台连接。
本发明第五方面提供一种存储介质,存储介质上存储有指令,指令在被处理器执行时使得处理器执行如上的用于控制工程设备臂架的方法。
通过上述技术方案,在臂架的自由度存在冗余时,通过划分出第一数量的运动副,以解决冗余自由度多解的问题,从而有效的降低了在确定用于调节臂架位姿的控制指令时的计算难度,并极大的加快了计算的速度,有效提升在复杂高空作业场景中的适应性和灵活性,并且,通过用于调节臂架位姿的控制指令,可以实现臂式高空作业平台末端位置的自动控制,无需操作人员预先熟悉工程设备臂架的结构形式,降低了高空作业平台的使用门槛,使臂式高空作业平台的操作更加简单直观、可控性更好,降低劳动强度。
本发明的其它特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本发明的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本发明,但并不构成对本发明的限制。在附图中:
图1为根据本发明一实施例的用于控制工程设备臂架方法的流程示意图;
图2为根据本发明一实施例的用于控制设备臂架的装置的示意框图;
图3为根据本发明一实施例的逆向运动学模型求解的流程示意图;
图4为根据本发明一实施例的工程设备的臂架的示意图。
附图标记说明
100、用于控制工程设备臂架的装置;101、处理器;102、液压驱动系统;103、液压伺服控制器;104、传感器;105、遥控器;111、转台转动关节;112、塔臂转动关节;113、塔臂;114、塔臂伸缩关节;115、主臂转动关节;116、主臂;117、主臂伸缩关节;118、飞臂转动关节;119、飞臂;120、平台调平转动关节;121、工作平台;θ1、转台转动;θ2、塔臂转动;θ3、塔臂伸缩;θ4、主臂转动;θ5、主臂伸缩;θ6、飞臂转动;θ7、平台调平转动。
具体实施方式
以下结合附图对本发明的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明,并不用于限制本发明。
图1为根据本发明一实施例的用于控制工程设备臂架方法的流程示意图。如图1所示,在本发明实施例中,提供了一种用于控制工程设备臂架的方法,臂架包括多个节臂以及连接多个节臂的关节,以该方法应用于处理器为例进行说明,该方法可以包括以下步骤:
步骤S100,获取臂架的当前位姿信息,当前位姿信息包括节臂的当前转动角度和/或节臂的当前伸缩量;
本实施例中,需要说明的是,工程设备的臂架可以是串联结构,其可以包括多个节臂,节臂间通过可以控制节臂转动的关节连接,臂架的所有节臂可以均为可伸缩的节臂或者均为不可伸缩的节臂,还可以为既包括可伸缩的节臂也包括不可伸缩的节臂。当前位姿信息包括节臂的当前转动角度和/或节臂的当前伸缩量,其中,当前转动角度或者当前伸缩量表示当前时刻对应的节臂的转动角度或者节臂的伸缩量。可以通过获在臂架的节臂或者关节对应的位置安装的传感器来获取臂架的当前位姿信息。
具体地,获取臂架的当前位姿信息,包括:
步骤a,响应于监测到用于控制臂架的末端移动的控制信号,获取当前时刻的臂架的当前位姿信息。
本实施例中,需要说明的是,控制臂架的末端移动的控制信号可以触发对臂架的末端进行移动,此时需要确定如何控制臂架的节臂或关节进行运动,以实现臂架末端的位置移动。具体地,当处理器监测到用于控制臂架的末端移动的控制信号时,可以从传感器获取当前时刻的臂架的当前位姿信息。在一个示例中,控制信号可以是用户(操作员)通过操作遥控器产生的。
步骤S200,根据当前位姿信息确定臂架的末端的当前位置;
本实施例中,需要说明的是,工程设备在控制臂架运动时,主要目的是为了控制臂架末端达到指定位置,例如,高空作业平台车控制末端的工作平台移动,以到达指定位置。在对臂架的位姿进行调整之前,需要确定臂架调整前的当前时刻其末端的位置,即末端的当前位置。
具体地,根据当前位姿信息确定臂架的末端的当前位置,包括:
步骤b,将当前位姿信息输入至正向运动学模型,以确定臂架的末端的当前位置;其中,正向运动学模型是基于旋量法建立的。
本实施例中,需要说明的是,控制臂架的末端从当前位置移动到期望位置时,需要确定当前时刻臂架末端的当前位置,以在确定末端的当前位置后依据运动指令确定末端的期望位置,进而根据期望位置确定控制臂架的自由度进行姿态调整的期望位姿信息,以实现对臂架的姿态进行调整,在此过程前,将建立运动学模型以实现期望位姿信息的确定,而在建立运动学模型的初始时刻臂架的状态为初始状态,臂架处于初始状态下的位姿信息为臂架的初始位姿信息。
本实施例中,运动学模型包括正向运动学模型和逆向运动学模型,其中,根据旋量法建立正向运动学模型。可以理解,旋量法建立正向运动学模型为根据旋量理论,将串联式臂架的关节运动视为各个节臂的旋量运动,且基于旋量理论中的刚体的旋转运动可由运动旋量的指数积的形式表示,进而可得到刚体转动一定角度后的位姿表达式。其具体的计算方法是所属领域技术人员所知的,此处不再赘述。
具体地,在确定正向运动学模型时,确定在初始状态下臂架节臂以及关节的初始位姿信息,并确定臂架的末端的初始位置,以及确定在初始状态下各节臂和关节对应的单位运动旋量,最终建立正向运动学模型。将臂架的当前位姿信息输入至该正向运动学模型后,即可确定臂架的末端的当前位置。
例如,在一实施例中,正向运动学模型为:其中,gst(θ)表示臂架的末端的当前位置,gst(0)表示臂架的末端的初始位置,θi(i=1、2、3、4、5、6、7)表示臂架的各个运动副对应的当前位姿信息,运动副包括节臂转动和/或节臂伸缩,ξi(i=1、2、3、4、5、6、7)表示初始状态下臂架的各个运动副对应的单位运动旋量。
步骤S300,根据当前位置和输入的运动指令确定臂架的末端的期望位置;
本实施例中,需要说明的是,在实际应用中,在操作臂架时可以根据实际需求向臂架下达对应的运动指令以使臂架运动,例如,往前移动5米。处理器接收到该运动指令后,需要对该运动指令进行转换,以得到在空间中基于预设基坐标系的臂架末端的期望位置。期望位置是指想要操作臂架末端所到达的位置。运动指令由操作人员输入,例如可以是通过遥控器进行输入,控制按钮进行输入等输入方式。运动指令可以包括在控制所述臂架的末端移动的控制信号中,或可以是在控制所述臂架的末端移动的控制信号输入后单独输入的。
本实施例中,以臂架的转台关节所在位置为原点建立的坐标系作为基坐标系,处理器在确定臂架末端的当前位置后,根据输入的运动指令在该当前位置的基础上加上该运动指令对应的运动量,以确定臂架的末端在基坐标系中的期望位置。
步骤S400,确定同一平面内臂架的自由度数,自由度数包括节臂转动和/或节臂伸缩的数量;
本实施例中,需要说明的是,自由度表示臂架的可运动性,臂架的自由度数为臂架的节臂或关节中的可以伸缩的节臂或可以使得节臂转动的关节数量。也即臂架的运动副的数量,运动副包括节臂转动的转动副和节臂伸缩的移动副,单个臂架的所有节臂和关节并不一定均在同一平面内。本实施例中,同一平面是指能够最大限度的包括臂架的运动副的平面,臂架的节臂和关节可分别处于无数个不同的平面,该最大限度的包括臂架的运动副的平面是指同时处于该平面的节臂伸缩的数量以及垂直于该平面的节臂转动的数量的总和最大的一个平面。例如,以图4示出的根据本发明一实施例的工程设备的臂架示例为例,臂架的运动副包括:转台转动θ1、塔臂转动θ2、塔臂伸缩θ3、主臂转动θ4、主臂伸缩θ5、飞臂转动θ6以及平台调平转动θ7。最大限度的包括臂架的运动副的平面,即可同时包括塔臂转动θ2、塔臂伸缩θ3、主臂转动θ4、主臂伸缩θ5、飞臂转动θ6以及平台调平转动θ7的共同的平面,在该平面内的臂架的运动副的数量也即该处于平面的节臂伸缩的数量2(塔臂伸缩θ3和主臂伸缩θ5)以及垂直于该平面的节臂转动的数量4(塔臂转动θ2、主臂转动θ4、飞臂转动θ6以及平台调平转动θ7),即同一平面内的臂架的自由度数为6(2+4=6)。
具体地,处理器确定处于同一平面内的节臂转动和/或节臂伸缩,以得到该同一平面内臂架的自由度数。
步骤S500,在确定自由度数超过预设数量的情况下,确定第一数量的运动副,第一数量为运动副的数量与预设数量的差值;
本实施例中,需要说明的是,当臂架的自由度存在冗余时,对臂架各个节臂和/或关节的控制指令可以存在多种解,而其多种解为对臂架进行运动控制进行指令确定带来了困难。本实施例中,利用预设数量对臂架在同一平面内的自由度是否存在冗余进行判断,如果同一平面内臂架的自由度数超过预设数量,则认为该同一平面内臂架的自由度存在冗余。从而在确定同一平面内的自由度存在冗余时,执行相关的冗余自由度处理策略。其中,冗余自由度处理策略为对于存在冗余自由度的臂架,在确定用于调节臂架位姿的控制指令时,先对冗余的自由度进行划分,将同一平面内超出预设数量的运动副划分出来,得到第一数量的运动副。以预设数量为3作为示例,同一平面内的自由度数超过3,则该臂架的自由度存在冗余。例如,若臂架在同一平面内的自由度数为6,6大于3,确定该臂架在同一平面内存在自由度冗余,确定出第一数量为3的运动副,其中,6-3=3,即自由度数与预设数量的差值为3。
具体地,处理器在确定自由度数超过预设数量的情况下,确定第一数量的运动副,第一数量为自由度数与预设数量的差值;若自由度数未超过预设数量,则第一数量为零。
步骤S600,根据期望位置、第一数量的运动副对应的当前位姿信息确定臂架的除第一数量的运动副以外的其他运动副对应的期望位姿信息;
本实施例中,需要说明的是,其他运动副是指臂架所有的运动副中除了第一数量的运动副外其余的运动副;期望位姿信息是指使得臂架末端运动至期望位置时,需要对该其他运动副的进行设置的参数。
具体地,处理器根据期望位置、第一数量的运动副对应的当前位姿信息来确定臂架的除第一数量的运动副以外的其他运动副对应的期望位姿信息。
步骤S700,根据第一数量的运动副对应的当前位姿信息和其他运动副对应的期望位姿信息生成用于调节臂架位姿的控制指令。
本实施例中,需要说明的是,控制指令用于调节臂架位姿,具体为基于运动副已设置的参数对臂架的所有的运动副进行控制的指令。用于调节所述臂架位姿的控制指令包括了对臂架所有的运动副的位姿信息进行设置的指令,其中,第一数量的运动副对应设置的参数为当前位姿信息,其他运动副对应设置的参数为期望位姿信息。通过将第一数量的运动副进行确定,并将该第一数量的运动副对应的当前位姿信息作为控制该第一数量的运动副的参数,降低了因为自由度冗余带来的求解难度。
具体地,处理器可以根据第一数量的运动副对应的当前位姿信息和其他运动副对应的期望位姿信息生成用于调节臂架位姿的控制指令。
参考图2,在一应用场景中,用于控制工程设备臂架的方法应用于用于控制工程设备臂架的装置100,用于控制工程设备臂架的装置100包括遥控器105、传感器104、液压伺服控制器103、液压驱动系统102以及处理器101。当遥控器105被触发,液压伺服控制器103根据遥控器105触发的当前时刻t,从传感器104获取当前时刻臂架的各个运动副对应的当前位姿信息,将该当前时刻和该当前位姿信息输入至处理器101,处理器101基于获取的前时刻和该当前位姿信息确定用于控制臂架的位姿的控制指令,该控制指令包括对臂架的每一个自由度对应的位姿信息。具体地,处理器101通过正向运动学模型确定臂架末端的当前位置,输入至笛卡尔空间轨迹规划中,以得到根据该当前位置以及输入的运动指令确定臂架的末端的期望位置,从而将该期望位置输入至逆向运动学模型中,确定臂架的每一个运动副对应的期望位置,关节空间轨迹规划通过每一个运动副对应的期望位置确定每一个运动副对应的期望位姿信息,以生成用于调节臂架位姿的控制指令。液压伺服控制器103根据该控制指令控制液压驱动系统102驱动臂架的多个运动副进行同步运动。其中,输入的运动指令可以由遥控器105按钮对应的控制信号进行确定。
上述用于控制工程设备臂架的方法,通过获取臂架的当前位姿信息,以根据当前位姿信息确定臂架的末端的当前位置,从而根据当前位置和输入的运动指令确定臂架的末端的期望位置,并确定同一平面内臂架的自由度数,以在确定自由度数超过预设数量的情况下,根据期望位置、第一数量的运动副对应的当前位姿信息确定臂架的除第一数量的运动副以外的其他运动副对应的期望位姿信息,进而根据第一数量的运动副对应的当前位姿信息和其他运动副对应的期望位姿信息生成用于调节臂架位姿的控制指令。上述方法在臂架的自由度存在冗余时,通过划分出第一数量的运动副,以解决冗余自由度多解的问题,从而有效的降低了在确定用于调节臂架位姿的控制指令时的计算难度,并极大的加快了计算的速度,有效提升在复杂高空作业场景中的适应性和灵活性,并且,通过用于调节臂架位姿的控制指令,可以实现臂式高空作业平台末端位置的自动控制,无需操作人员预先熟悉工程设备臂架的结构形式,降低了高空作业平台的使用门槛,使臂式高空作业平台的操作更加简单直观、可控性更好,降低劳动强度。
在一个实施例中,根据期望位置、第一数量的运动副对应的当前位姿信息确定臂架的除第一数量的运动副以外的其他运动副对应的期望位姿信息,包括:
步骤c,将期望位置和第一数量的运动副对应的当前位姿信息输入至逆向运动学模型,以确定其他运动副对应的期望位姿信息。
本实施例中,需要说明的是,逆运动学是决定要达成所需要的姿势所要设置的关节可活动对象的参数的过程,即对臂架的运动副的期望位姿信息进行设置的过程,逆向运动学模型可实现对该期望位姿信息的求解。在建立逆向运动学模型时,对臂架的除第一数量的运动副以外的其他运动副进行求解方程的确定,以在获取到期望位置和第一数量的运动副对应的当前位姿信息时,将该获取到的期望位置和第一数量的运动副对应的当前位姿信息作为已知量,代入确定的求解方程,从而得到该其他运动副对应的期望位姿信息。
具体地,针对臂架的除第一数量的运动副以外的其他自由度的期望位姿信息进行计算时,处理器将确定的第一数量的运动副对应的当前位姿信息和臂架的末端的期望位置作为已知量输入至逆向运动学模型,以在经过逆向运动学模型中的运算过程后,得到该其他运动副对应的期望位姿信息。
具体地,逆向运动学模型可以是通过以下步骤建立的:
步骤c1,获取臂架的初始位姿信息,初始位姿信息包括关节的初始位置和臂架的末端的初始位置;
步骤c2,基于多个节臂之间的空间几何关系和初始位姿信息建立逆向运动学模型。
本实施例中,需要说明的是,控制臂架的末端从当前位置移动在期望位置时,将在确定末端的当前位置后依据运动指令确定末端的期望位置,进而根据期望位置确定控制臂架的运动副进行姿态调整的期望位姿信息,以实现对臂架的姿态进行调整,在此过程前,将建立运动学模型以实现期望位姿信息的确定,而在建立运动学模型的初始时刻臂架的状态为初始状态,臂架处于初始状态下的位姿信息为臂架的初始位姿信息。可以理解的是,该初始位姿信息可以是臂架的出厂位姿信息,还可以是臂架在进行一定的姿态调整后的位姿信息,其确定的依据为建立运动学模型的初始时刻,可以根据实际需求进行确定或变更。
运动学模型包括正向运动学模型和逆向运动学模型,其中,当存在自由度冗余时,基于末端的期望位置进行逆向运动学求解,以得到臂架所有的运动副的期望位姿信息时,无法确定唯一解且计算过程复杂,耗时长。本实施例中,针对存在自由度冗余的情况,减少需要进行计算的运动副的数量,选取第一数量的运动副的当前位姿信息作为定值,基于该确定的定值对其他运动副进行求解,以得到使得臂架的末端到达期望位置时臂架所有的运动副唯一对应的位姿信息。建立逆向运动学模型时,将对臂架的除第一数量的运动副以外的其他运动副进行求解方程的确定,而在建立逆向运动学模型之前需要对第一数量的运动副进行确定,第一数量的运动副对应的当前位姿信息作为逆向运动学模型中进行逆向运动学求解的已知量,也即该第一数量的运动副对应的当前位姿信息将直接作为定值,不需要再进一步进行位姿信息的求解。
具体地,在一实施例中,臂架的自由度数为7,包括的运动副有:转台转动θ1、塔臂转动θ2、塔臂伸缩θ3、主臂转动θ4、主臂伸缩θ5、飞臂转动θ6、平台调平转动θ7、以及;同一平面内自由度数为6,包括的运动副有:塔臂转动θ2、塔臂伸缩θ3、主臂转动θ4、主臂伸缩θ5、飞臂转动θ6、平台调平转动θ7。同一平面内自由度数为6,大于预设数量3,则此时确定第一数量的运动副,也即3个运动副,本实施例中,考虑实际工况的臂架的运动副中,平台调平转动θ7用于工作平台的调平,其通过角度传感器进行主动的调节;同时,塔臂转动θ2及塔臂伸缩θ3之间存在约束条件,当塔臂转动θ2的转动角度到达最大值时塔臂伸缩θ3才能动作,塔臂伸缩θ3完全缩回时塔臂转动θ2才能进行相关的转动,且塔臂转动θ2及塔臂伸缩θ3在实际的工作过程中要求尽量的保持不动,故考虑将塔臂转动θ2、塔臂伸缩θ3以及平台调平转动θ7作为第一数量的运动副,在臂架的逆向运动学模型中的运算过程中直接读取塔臂转动θ2、塔臂伸缩θ3以及平台调平转动θ7对应的当前位姿信息,将其作为当前求逆的一个定值进行求解。以转台转动关节的位置建立的坐标系为基坐标系。
可根据旋量法建立相关的正向运动学模型:其中,gst(θ)表示臂架的末端的当前位置,gst(0)表示臂架的末端的初始位置,θi(i=1、2、3、4、5、6、7)表示臂架的运动副对应的当前位姿信息,ξi(i=1、2、3、4、5、6、7)表示初始状态下臂架的自由度对应的单位运动旋量。
根据正向运动学公式,可得臂架的末端位置的表达式:
x=((zc-z6)*s246+(xa-x6)*c246+(x6+θ5-x4)*c24+z6-z4*s24+x4-x2-θ3*c2+z4-z2*s2+x2*c1;
y=((zc-z6)*s246+(xa-x6)*c246+(x6+θ5-x4)*c24+z6-z4*s24+x4-x2-θ3*c2+z4-z2*s2+x2*s1;
z=(zc-z6)*c246+(x6-xa)*s246+(x4-θ5-x6)*s24+(z6-z4)*c24+(x2-x4+θ3)*s2+(z4-z2)*c2+z2;
同时为保持臂架的末端水平的姿态,故有:
θ2+θ4+θ6+θ7=0;
本实施例中,将塔臂转动θ2、塔臂伸缩θ3以及平台调平转动θ7作为第一数量的运动副,则其他运动副包括转台转动θ1、主臂转动θ4、主臂伸缩θ5、飞臂转动θ6,联立以上4个方程组可得确定该其他自由度的期望位姿信息的逆向运动学模型:
其中,
x2、x4、x6分别是运动副为塔臂转动、主臂转动、飞臂转动对应的初始位姿在基坐标系下x轴的位置;
z2、z4、z6分别是运动副为塔臂转动、主臂转动、飞臂转动对应的初始位姿在基坐标系下z轴的位置;
xa、zc分别为臂架的末端的初始位姿在基坐标系下x轴与z轴的位置;x,y,z为臂架末端的期望位置在基坐标系下x,y,z轴的位置;
a4=(x/c1-x2)*s2+(z-z2)*c2-(zc-z6)*c27-(xa-x6)*s27-(z4-z2);
b4=(x/c1-x2)*c2+(z2-z)*s2+(zc-z6)*s27-(xa-x6)*c27-(x4-x2);
k4=z6-z4;
k5=(zc-z6)*c246+(x6-xa)*s246+(z6-z4)*c24+(z4-z2)*c2+(x2-x4+θ3)*s2+z2-z;
c1=cosθ1;c2=cosθ2;s2=sinθ2;c27=cos(θ2+θ7);s27=sin(θ2+θ7);
c24=cos(θ2+θ4);s24=sin(θ2+θ4);c246=cos(θ2+θ4+θ6);
s246=sin(θ2+θ4+θ6);
θi(i=1、4、5、6)表示其他运动副(转台转动01、主臂转动θ4、主臂伸缩θ5、飞臂转动θ6)对应的期望位姿信息;
θi(i=2、3、7)表示第一数量的运动副(塔臂转动θ2、塔臂伸缩θ3以及平台调平转动θ7)对应的当前位姿信息;
注:当s24=0时,由以上4个方程组亦可推出θ5的另一表达式,再次不在赘述。
可以理解的是,在一实施例中,还可以采用D-H(Denavit-Hartenberg)参数法建立运动学模型。D-H参数法中,各连杆相对于前一连杆建立坐标系,得到各个连杆相对于前一连杆的相对运动,其具体的建立工程设备臂架的运动学方程的方式是所属领域技术人员所知的,在此不再赘述。且在确定臂架的所有运动副中作为第一数量的运动副时,可根据实际工况进行选择,并不做固定的运动副选择限制。
在一个实施例中,将期望位置和第一数量的运动副对应的当前位姿信息输入至逆向运动学模型,以确定臂架的除第一数量的运动副以外的其他运动副对应的期望位姿信息,还包括:
步骤d,基于期望位置和第一数量的运动副对应的当前位姿信息确定逆向运动学模型是否存在实数解;
步骤e,如果确定逆向运动学模型存在实数解,则判断实数解是否超出其他运动副对应的第一预设运动范围;
步骤f,如果实数解未超出第一预设运动范围,则基于实数解确定其他运动副对应的期望位姿信息。
本实施例中,需要说明的是,在通过逆向运动学模型确定其他运动副对应的期望位姿信息为利用逆向运动学模型中的求解方程进行计算。期望位姿信息对应的值应为实数,且需要在该求解的运动副所对应的运动范围内。其他运动副对应的运动范围为第一预设运动范围,该第一预设运动范围表示该其他运动副在出厂时可以或者被允许的运动范围。故需在将期望位置和第一数量的运动副对应的当前位姿信息代入计算结束后,对逆向运动学模型是否存在实数解进行判断,当求出的解是实数解时,判断其是否在该第一预设运动范围内;只有确定的解为实数解且该实数解在第一预设运动范围内时,才可基于该实数解确定其他运动副对应的期望位姿信息。可以理解的是,该实数解为多个,分别对应各个其他运动副,基于各个其他运动副对应的实数解分别确定各个其他运动副对应的期望位姿信息。
具体地,处理器将基于期望位置和第一数量的运动副对应的当前位姿信息确定逆向运动学模型是否存在实数解,如果确定逆向运动学模型存在实数解,则判断该实数解是否超出臂架的除第一数量的运动副以外的其他运动副对应的第一预设运动范围,若实数解未超出第一预设运动范围,则基于实数解确定其他运动副对应的期望位姿信息。
在一个实施例中,将期望位置和第一数量的运动副对应的当前位姿信息输入至逆向运动学模型,以确定臂架的除第一数量的运动副以外的其他运动副对应的期望位姿信息,还包括:
步骤g,如果确定逆向运动学模型不存在实数解,或存在超出第一预设运动范围的实数解,则基于第一数量的运动副对应的第二预设运动范围对第一数量的运动副对应的当前位姿信息进行调整,以重新确定逆向运动学模型是否存在实数解,直至得到未超出第一预设运动范围的实数解。
本实施例中,需要说明的是,第二预设运动范围表示该第一数量的运动副在出厂时可以或者被允许的运动范围。在对逆向运动学模型是否存在实数解进行判断时,当求出的解不是实数解或存在实数解但该实数解超出第一预设运动范围时,将对该第一数量的运动副对应的当前位姿信息进行调整,调整的范围为第一数量的运动副对应的第二预设运动范围。其中,调整第一数量的运动副对应的当前位姿信息的调整参数将根据传感器的测量精度在第二预设运动范围内进行相关的设计给定。
具体地,处理器在确定逆向运动学模型不存在实数解,或存在超出第一预设运动范围的实数解时,将基于第一数量的运动副对应的第二预设运动范围对第一数量的运动副对应的当前位姿信息进行调整,以根据期望位置和该调整后的当前位姿信息重新确定逆向运动学模型是否存在实数解,直至得到未超出第一预设运动范围的实数解。
在一个实施例中,基于第一数量的运动副对应的第二预设运动范围对第一数量的运动副对应的当前位姿信息进行调整,包括:
步骤h,确定第一数量的运动副中用于对臂架的末端进行调节以使末端保持水平状态的的平台调平转动的运动副,保持平台调平转动的运动副对应的当前位姿信息不变;
步骤i,基于第一数量的运动副中剩余自由度对应的第二预设运动范围对剩余运动副对应的当前位姿信息进行调整。
本实施例中,需要说明的是,臂架对应的运动副中,平台调平转动运动副为控制臂架末端保持水平的运动副,该运动副的位姿信息无需计算,可直接通过角度传感器进行读取,因此,在确定作为计算定值的第一数量的运动副时,将会把该平台调平转动运动副作为第一数量的运动副中的一个。由于该平台调平转动运动副是通过角度传感器主动控制的,无需计算,控制臂架末端保持水平即可,因此,在对第一数量的运动副对应的当前位姿信息进行调整时,该平台调平转动运动副对应的当前位姿信息保持不变。而对于第一数量的运动副中除该平台调平转动运动副外的剩余自由度进行当前位姿信息的调整。调整的范围为该其他的第一数量的运动副对应的第二预设运动范围。其中,调整该剩余运动副对应的当前位姿信息的调整参数将根据传感器的测量精度在第二预设运动范围内进行相关的设计给定。
在本发明实施例中,当前位姿信息包括转台的第一当前转动角度、塔臂转动关节的第二当前转动角度、主臂转动关节的第三当前转动角度、飞臂转动关节的第四当前转动角度、平台调平转动关节的第五当前转动角度、塔臂的第一伸缩量以及主臂的第二伸缩量;
同一平面内臂架的运动副包括:塔臂转动、主臂转动、飞臂转动、平台调平转动、塔臂伸缩以及主臂伸缩;
确定第一数量的运动副包括:基于实际工况确定的同一平面内运动频率最低的第一数量的运动副。
在本发明实施例中,第一数量的运动副包括塔臂转动、塔臂伸缩以及平台调平转动。
图3为根据本发明一实施例的逆向运动学模型求解的流程示意图,图4为根据本发明一实施例的工程设备的臂架的示意图。参考图3和图4,在本发明实施例中,多个节臂可以包括塔臂113、主臂116、飞臂119以及工作平台121,关节包括转台转动关节111、塔臂转动关节112、塔臂伸缩关节114、主臂转动关节115、主臂伸缩关节117、飞臂转动关节118以及平台调平转动关节120。转台转动关节111通过塔臂转动关节112与塔臂113的一端连接,塔臂113的另一端通过塔臂伸缩关节114与主臂转动关节115的一端连接,主臂转动关节115的另一端与主臂116的一端连接,主臂116的另一端通过主臂伸缩关节117与飞臂转动关节118的一端连接,飞臂转动关节118的另一端与飞臂119的一端连接,飞臂119的另一端通过平台调平转动关节120与工作平台121连接。臂架的运动副包括:转台转动θ1、塔臂转动θ2、塔臂伸缩θ3、主臂转动θ4、主臂伸缩θ5、飞臂转动θ6以及平台调平转动θ7。在本发明实施例中,考虑实际工况,在臂架的运动副中平台调平转动θ7用于工作平台121的调平,其通过角度传感器进行主动的调节;同时,塔臂转动θ2及塔臂伸缩θ3之间存在约束条件,当塔臂转动θ2的转动角度到达最大值时塔臂伸缩θ3才能动作,塔臂伸缩θ3完全缩回时塔臂转动θ2才能进行相关的转动,且塔臂转动θ2及塔臂伸缩θ3在实际的工作过程中要求尽量的保持不动,故考虑将塔臂转动θ2、塔臂伸缩θ3以及平台调平转动θ7作为第一数量的运动副。进行运动学求解的流程时,将直接读取该第一数量的运动副:塔臂转动θ2、塔臂伸缩θ3以及平台调平转动θ7对应的当前位姿信息,从而计算臂架的所有运动副中除第一数量的运动副之外其他运动副对应的期望位姿信息:转台转动θ1、主臂转动θ4、主臂伸缩θ5、飞臂转动θ6;判断计算的结果是否存在实数解,若存在实数解,则判断该实数解是否超出第一预设运动范围,若该实数解未超出第一预设运动范围,则确定存在可行解,此时可以确定其他运动副对应的期望位姿信息;若不存在实数解,或者存在超出第一预设运动范围,则对保持第一数量的运动副中的平台调平转动θ7不变,在第二预设运动范围内调整塔臂转动θ2或塔臂伸缩θ3,并将调整后的塔臂转动θ2或塔臂伸缩θ3代入计算流程中,重新执行计算,直到确定出可行解。
现有技术中,针对臂架的末端位置进行控制时,采用的控制算法运算时间较长,无法达到实时控制效果。并且,当臂架的自由度存在冗余时,会为求解各节臂和连接该节臂的关节逆运动学带来困难,而常规方式会采用比较通用的解法,计算量会随着臂架自由度的提高而增加,求解时间无法满足实时控制的要求。而本发明实施例提供的技术方案,当臂架在同一平面内的自由度数超过预设数量时,确定第一数量的运动副后,对其余运动副进行求解,很好地解决了冗余自由度多解的问题,可以获得冗余自由度臂架逆运动学的封闭解析解,运算速度快,求解精度高,满足实时性控制要求;并且,通过自动控制,无需操作人员预先熟悉臂车的结构形式,降低了高空作业平台的使用门槛,使臂式高空作业平台的操作更加简单直观、可控性更好,降低劳动强度。
本发明实施例提供了一种处理器,该处理器被配置成执行根据上述实施方式中的用于控制工程设备臂架的方法。
本发明实施例提供了一种用于控制工程设备臂架的装置,包括:
液压驱动系统,用于驱动臂架运动;
传感器,用于检测臂架的位姿;
如上实施例所述的处理器;以及
液压伺服控制器,被配置成:
响应于接收到的控制信号,根据传感器检测的位姿生成位姿信息,并将生成的位姿信息输送至处理器;
根据从处理器接收的用于调节臂架位姿的控制指令控制液压驱动系统驱动臂架运动。
在本发明实施例中,还包括:
遥控器,用于响应于用户操作发送控制信号。
本发明实施例提供了一种工程设备,包括:
臂架,臂架包括多个节臂以及连接多个节臂的关节;
如上实施例所述的用于控制工程设备臂架的装置。
在本发明实施例中,多个节臂包括塔臂、主臂、飞臂以及工作平台,关节包括转台转动关节、塔臂转动关节、塔臂伸缩、主臂转动关节、主臂伸缩、飞臂转动关节以及平台调平转动关节,转台通过塔臂转动关节与塔臂的一端连接,塔臂的另一端通过塔臂伸缩关节与主臂转动关节的一端连接,主臂转动关节的另一端与主臂的一端连接,主臂的另一端通过主臂伸缩关节与飞臂转动关节的一端连接,飞臂转动关节的另一端与飞臂的一端连接,飞臂的另一端通过平台调平转动关节与工作平台连接。
在本发明实施例中,工程设备的示例可以包括:高空作业车、起重机、机械手臂等。
本发明实施例提供了一种存储介质,该存储介质上存储有指令,指令在被处理器执行时使得处理器执行根据上述实施方式中的用于控制工程设备臂架的方法。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
还需要说明的是,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、商品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、商品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括要素的过程、方法、商品或者设备中还存在另外的相同要素。
以上仅为本申请的实施例而已,并不用于限制本申请。对于本领域技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原理之内所作的任何修改、等同替换、改进等,均应包含在本申请的权利要求范围之内。
以上结合附图详细描述了本发明的优选实施方式,但是,本发明并不限于上述实施方式中的具体细节,在本发明的技术构思范围内,可以对本发明的技术方案进行多种简单变型,这些简单变型均属于本发明的保护范围。另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合。为了避免不必要的重复,本发明对各种可能的组合方式不再另行说明。
此外,本发明的各种不同的实施方式之间也可以进行任意组合,只要其不违背本发明的思想,其同样应当视为本发明所公开的内容。
Claims (16)
1.一种用于控制工程设备臂架的方法,其特征在于,所述臂架包括多个节臂以及连接所述多个节臂的关节,所述方法包括:
获取所述臂架的当前位姿信息,所述当前位姿信息包括节臂的当前转动角度和/或节臂的当前伸缩量;
根据所述当前位姿信息确定所述臂架的末端的当前位置;
根据所述当前位置和输入的运动指令确定所述臂架的末端的期望位置;
确定同一平面内所述臂架的自由度数,所述自由度数包括节臂转动和/或节臂伸缩的数量;
在确定所述自由度数超过预设数量的情况下,确定第一数量的运动副,所述运动副包括节臂转动和/或节臂伸缩,所述第一数量为所述自由度数与所述预设数量的差值;
根据所述期望位置、所述第一数量的运动副对应的当前位姿信息确定所述臂架的除所述第一数量的运动副以外的其他运动副对应的期望位姿信息;以及
根据所述第一数量的运动副对应的当前位姿信息和所述其他运动副对应的期望位姿信息生成用于调节所述臂架位姿的控制指令。
2.根据权利要求1所述的方法,其特征在于,所述根据所述期望位置、所述第一数量的运动副对应的当前位姿信息确定所述臂架的除所述第一数量的运动副以外的其他运动副对应的期望位姿信息,包括:
将所述期望位置和所述第一数量的运动副对应的当前位姿信息输入至逆向运动学模型,以确定所述其他运动副对应的期望位姿信息。
3.根据权利要求2所述的方法,其特征在于,所述将所述期望位置和所述第一数量的运动副对应的当前位姿信息输入至逆向运动学模型,以确定所述其他运动副对应的期望位姿信息,包括:
基于所述期望位置和所述第一数量的运动副对应的当前位姿信息确定所述逆向运动学模型是否存在实数解;
如果确定所述逆向运动学模型存在实数解,则判断所述实数解是否超出所述其他运动副对应的第一预设运动范围;
如果所述实数解未超出所述第一预设运动范围,则基于所述实数解确定所述其他运动副对应的期望位姿信息。
4.根据权利要求3所述的方法,其特征在于,所述将所述期望位置和所述第一数量的运动副对应的当前位姿信息输入至逆向运动学模型,以确定所述其他运动副对应的期望位姿信息,包括:
如果确定所述逆向运动学模型不存在实数解,或存在超出所述第一预设运动范围的实数解,则基于所述第一数量的运动副对应的第二预设运动范围对所述第一数量的运动副对应的当前位姿信息进行调整,以重新确定所述逆向运动学模型是否存在实数解,直至得到未超出所述第一预设运动范围的实数解。
5.根据权利要求4所述的方法,其特征在于,所述基于所述第一数量的运动副对应的第二预设运动范围对所述第一数量的运动副对应的当前位姿信息进行调整,包括:
确定所述第一数量的运动副中用于对臂架的末端进行调节以使所述末端保持水平状态的平台调平转动的运动副,保持所述平台调平转动的运动副对应的当前位姿信息不变;
基于所述第一数量的运动副中剩余运动副对应的第二预设运动范围对所述剩余运动副对应的当前位姿信息进行调整。
6.根据权利要求2所述的方法,其特征在于,所述逆向运动学模型是通过以下步骤建立的:
获取所述臂架的初始位姿信息,所述初始位姿信息包括所述关节的初始位置和所述臂架的末端的初始位置;
基于所述多个节臂之间的空间几何关系和所述初始位姿信息建立逆向运动学模型。
7.根据权利要求1所述的方法,其特征在于,所述获取所述臂架的当前位姿信息,包括:
响应于监测到用于控制所述臂架的末端移动的控制信号,获取当前时刻的所述臂架的当前位姿信息。
8.根据权利要求1所述的方法,其特征在于,所述根据所述当前位姿信息确定所述臂架的末端的当前位置,包括:
将所述当前位姿信息输入至正向运动学模型,以确定所述臂架的末端的当前位置;
其中,所述正向运动学模型是基于旋量法建立的。
9.根据权利要求1至8中任意一项所述的方法,其特征在于,所述多个节臂包括塔臂、主臂、飞臂以及工作平台,所述关节包括转台转动关节、塔臂转动关节、塔臂伸缩关节、主臂转动关节、主臂伸缩关节、飞臂转动关节以及平台调平转动关节,
所述转台转动关节通过所述塔臂转动关节与所述塔臂的一端连接,所述塔臂的另一端通过所述塔臂伸缩关节与所述主臂转动关节的一端连接,所述主臂转动关节的另一端与所述主臂的一端连接,所述主臂的另一端通过所述主臂伸缩关节与所述飞臂转动关节的一端连接,所述飞臂转动关节的另一端与所述飞臂的一端连接,所述飞臂的另一端通过所述平台调平转动关节与所述工作平台连接;
所述当前位姿信息包括所述转台转动的第一当前转动角度、所述塔臂转动的第二当前转动角度、所述主臂转动的第三当前转动角度、所述飞臂转动的第四当前转动角度、所述平台调平转动的第五当前转动角度、所述塔臂伸缩的第一伸缩量以及所述主臂伸缩的第二伸缩量;
同一平面内所述臂架的运动副包括:塔臂转动、主臂转动、飞臂转动、平台调平转动、塔臂伸缩以及主臂伸缩;
所述确定第一数量的运动副包括:基于实际工况确定的同一平面内运动频率最低的第一数量的运动副。
10.根据权利要求9所述的方法,其特征在于,所述第一数量的运动副包括塔臂转动、塔臂伸缩以及平台调平转动。
11.一种处理器,其特征在于,被配置成执行根据权利要求1至10中任意一项所述的用于控制工程设备臂架的方法。
12.一种用于控制工程设备臂架的装置,其特征在于,包括:
液压驱动系统,用于驱动臂架运动;
传感器,用于检测所述臂架的位姿;
根据权利要求11所述的处理器;以及
液压伺服控制器,被配置成:
响应于接收到的控制信号,根据所述传感器检测的位姿生成位姿信息,并将生成的位姿信息输送至所述处理器;
根据从所述处理器接收的用于调节所述臂架位姿的控制指令控制所述液压驱动系统驱动所述臂架运动。
13.根据权利要求12所述的装置,其特征在于,还包括:
遥控器,用于响应于用户操作发送所述控制信号。
14.一种工程设备,其特征在于,包括:
臂架,所述臂架包括多个节臂以及连接所述多个节臂的关节;
根据权利要求12或13所述的用于控制工程设备臂架的装置。
15.根据权利要求14所述的工程设备,其特征在于,多个节臂包括塔臂、主臂、飞臂以及工作平台,所述关节包括转台转动关节、塔臂转动关节、塔臂伸缩关节、主臂转动关节、主臂伸缩关节、飞臂转动关节以及平台调平转动关节,所述转台转动关节通过所述塔臂转动关节与所述塔臂的一端连接,所述塔臂的另一端通过所述塔臂伸缩关节与所述主臂转动关节的一端连接,所述主臂转动关节的另一端与所述主臂的一端连接,所述主臂的另一端通过所述主臂伸缩关节与所述飞臂转动关节的一端连接,所述飞臂转动关节的另一端与所述飞臂的一端连接,所述飞臂的另一端通过所述平台调平转动关节与所述工作平台连接。
16.一种存储介质,所述存储介质上存储有指令,其特征在于,所述指令在被处理器执行时使得所述处理器执行根据权利要求1至10中任意一项的用于控制工程设备臂架的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210983552.3A CN115302509B (zh) | 2022-08-16 | 2022-08-16 | 用于控制工程设备臂架的方法、处理器、装置及工程设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210983552.3A CN115302509B (zh) | 2022-08-16 | 2022-08-16 | 用于控制工程设备臂架的方法、处理器、装置及工程设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115302509A CN115302509A (zh) | 2022-11-08 |
CN115302509B true CN115302509B (zh) | 2023-09-05 |
Family
ID=83862424
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210983552.3A Active CN115302509B (zh) | 2022-08-16 | 2022-08-16 | 用于控制工程设备臂架的方法、处理器、装置及工程设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115302509B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103901898A (zh) * | 2014-03-28 | 2014-07-02 | 哈尔滨工程大学 | 一种多自由度机器人的逆运动学通用求解方法 |
CN109296019A (zh) * | 2018-11-08 | 2019-02-01 | 北京拓疆者智能科技有限公司 | 挖掘机臂运动控制方法、系统及装置 |
CN113119098A (zh) * | 2019-12-30 | 2021-07-16 | 深圳市优必选科技股份有限公司 | 机械臂控制方法、机械臂控制装置及终端设备 |
CN113737885A (zh) * | 2021-09-15 | 2021-12-03 | 北京拓疆者智能科技有限公司 | 挖掘机控制方法、装置、挖掘机及存储介质 |
-
2022
- 2022-08-16 CN CN202210983552.3A patent/CN115302509B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103901898A (zh) * | 2014-03-28 | 2014-07-02 | 哈尔滨工程大学 | 一种多自由度机器人的逆运动学通用求解方法 |
CN109296019A (zh) * | 2018-11-08 | 2019-02-01 | 北京拓疆者智能科技有限公司 | 挖掘机臂运动控制方法、系统及装置 |
CN113119098A (zh) * | 2019-12-30 | 2021-07-16 | 深圳市优必选科技股份有限公司 | 机械臂控制方法、机械臂控制装置及终端设备 |
CN113737885A (zh) * | 2021-09-15 | 2021-12-03 | 北京拓疆者智能科技有限公司 | 挖掘机控制方法、装置、挖掘机及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN115302509A (zh) | 2022-11-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPH0527125B2 (zh) | ||
US9120223B2 (en) | Method of controlling seven-axis articulated robot, control program, and robot control device | |
CN103147577A (zh) | 多关节类机械臂架的控制方法、设备、系统及工程机械 | |
JP5458769B2 (ja) | ロボットの制御装置 | |
US7047107B2 (en) | Robot control apparatus | |
JPH09265313A (ja) | ロボットの速度演算装置、およびロボットの速度演算方法 | |
JPH07180173A (ja) | 作業機械の制御装置 | |
CN110455290B (zh) | 一种智能液压挖掘机的最优轨迹规划方法 | |
CN102393754B (zh) | 臂架动作控制方法、系统及臂架末端直线位移控制方法、系统及混凝土泵车 | |
CN111993414B (zh) | 一种机械臂多关节联动控制方法 | |
CN111015681A (zh) | 信通机房巡检机器人系统 | |
US20180110190A1 (en) | Work vehicle gyroscopic boom control system and method | |
KR100253898B1 (ko) | 한 평면내 다자유도 스카라형 로봇의 궤적 제어장치 및 궤적제어방법 및 한 평면내 다자유도 스카라형 로봇의 궤적 제어프로그램을 기록한 컴퓨터 판독 가능한 기록매체 | |
CN115302509B (zh) | 用于控制工程设备臂架的方法、处理器、装置及工程设备 | |
KR101808295B1 (ko) | 곡블록 협소구간 작업이 가능한 용접로봇 시스템의 제어방법 | |
JP2010076058A (ja) | 多関節型マニピュレータの制御装置及び多関節型マニピュレータの手先動作軌道生成方法 | |
CN110977991A (zh) | 一种飞机清洗机械臂运动控制方法 | |
JPWO2020161910A1 (ja) | 制御装置、制御方法、プログラム | |
US5241249A (en) | Process for controlling a robot arm by defining substitution paths | |
CN203882196U (zh) | 多节机械臂的控制系统 | |
CN111872927A (zh) | 一种冗余机械臂以及控制冗余机械臂的系统 | |
CN115305980B (zh) | 用于控制折叠臂式臂架的方法、处理器、装置及工程设备 | |
JP2020171989A (ja) | ロボット教示システム | |
CN110539315A (zh) | 基于虚拟现实控制的建筑机器人 | |
CN115305979B (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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: 410010 No. 701 Xulong South Road, Xiangjiang New District, Changsha City, Hunan Province Applicant after: Hunan Zoomlion intelligent aerial work machinery Co.,Ltd. Address before: 410010 room 4110, 4th floor, office building, 677 Lugu Avenue, high tech Development Zone, Changsha City, Hunan Province Applicant before: Hunan Zoomlion intelligent aerial work machinery Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |