CN103787200B - 履带起重机及其行走姿态控制方法和控制*** - Google Patents
履带起重机及其行走姿态控制方法和控制*** Download PDFInfo
- Publication number
- CN103787200B CN103787200B CN201310670604.2A CN201310670604A CN103787200B CN 103787200 B CN103787200 B CN 103787200B CN 201310670604 A CN201310670604 A CN 201310670604A CN 103787200 B CN103787200 B CN 103787200B
- Authority
- CN
- China
- Prior art keywords
- max
- left crawler
- speed
- hand track
- track chiain
- 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
- 230000008878 coupling Effects 0.000 claims description 5
- 238000010168 coupling process Methods 0.000 claims description 5
- 238000005859 coupling reaction Methods 0.000 claims description 5
- 238000001514 detection method Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
Landscapes
- Control And Safety Of Cranes (AREA)
Abstract
本发明公开了一种履带起重机的行走姿态控制方法,包括:在履带起重机的控制台的铰接点上铰接地连接有控制手柄,使控制手柄能够以铰接点为中心在竖直面和水平面上旋转,以使控制手柄的操纵端在水平面上的投影A能够在水平面上运动到并保持在以铰接点为圆心以Rmax为半径的圆周及其内部的任意位置;检测控制手柄的位置;根据控制手柄的位置控制履带起重机的左履带和右履带的行走方向和行走速度。还公开了行走姿态控制装置和履带起重机。通过上述技术方案,能够避免现有技术中依靠增加踏板来分别控制履带起重机的左履带和右履带的行走,只需要一个控制手柄就能控制履带起重机的行走,降低了成本和操作的复杂度,避免了误操作情况的发生,提高了安全性。
Description
技术领域
本发明涉及工程机械领域,具体地,涉及一种履带起重机的行走姿态控制方法、行走姿态控制***和履带起重机。
背景技术
目前,在履带起重机上,电控***的应用越来越广泛,技术也越来越成熟可靠。但是履带式起重机行走通常都需要两个操作杆或操作手柄控制,当行走需要和上车实现同时动作时,有左右行走和上车的起升或其它动作控制。当需要对三个以上动作进行控制时,操作者的双手难以应付,所以部分厂家通过增加脚踏板来控制履带的行走,用手柄操作上车的卷扬的升降、回转等动作。不但增加了起重机的结构的复杂性,提高成本,而且增加操作者的操作复杂性,需要操作者能够熟练地手脚配合,因此对操作者的主观经验要求较高,否则很容易出现误操作的情况,造成安全问题。
发明内容
本发明的目的是提供一种履带起重机的行走姿态控制方法,该行走姿态控制方法能够降低操作的复杂度。
为了实现上述目的,本发明提供一种履带起重机的行走姿态控制方法,其中,该行走姿态控制方法包括:
在所述履带起重机的控制台的铰接点上铰接地连接有控制手柄,使所述控制手柄能够以所述铰接点为中心在竖直面和水平面上旋转,以使所述控制手柄的操纵端在水平面上的投影A能够在水平面上运动到并保持在以所述铰接点为圆心以Rmax为半径的圆周及其内部的任意位置;
检测所述控制手柄的位置;
根据所述控制手柄的位置控制所述履带起重机的左履带和右履带的行走方向和行走速度。
优选地,以所述铰接点为原点O在水平面上建立直角坐标系,以所述履带起重机直线向前行驶的行驶方向为Y轴的正方向,以垂直于该行驶方向向右的方向为X轴的正方向,
检测所述控制手柄的操纵端在该直角坐标系中的投影A的坐标(x,y);
根据所述坐标控制所述履带起重机的左履带和右履带的行走方向和行走速度。
优选地,当y>0时,所述左履带和所述右履带的速度方向均向前;
当y<0时,所述左履带和所述右履带的速度方向均向后;
当x>0时,所述左履带速度V1大于所述右履带速度V2;
当x<0时,所述左履带速度V1小于所述右履带速度V2。
优选地,当y=0且x>0时,所述左履带速度V1不为0,所述右履带速度V2为0;
当y=0且x<0时,所述左履带速度V1为0,所述右履带速度V2不为0;
当x=0且y>0时,所述左履带和所述右履带的速度方向均向前且大小相等;
当x=0且y<0时,所述左履带和所述右履带的速度方向均向后且大小相等。
优选地,当检测到所述控制手柄的操纵端在该直角坐标系中的投影A的坐标0≤|x|≤x0,0≤|y|≤y0时,所述履带起重机的左履带和右履带的行走速度为0,
其中,0<x0<Rmax,0<y<Rmax,x2+y2<R2 max。
优选地,当检测到所述坐标满足|x|>x0,|y|>y0,且
当0<|x/y|≤a,y>0时,控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向前;
当b≤|x/y|<+∞,且x<0时,控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向后、所述右履带速度V2的方向向前;
当0<|x/y|≤a,且y<0时,控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向后;
当b≤|x/y|<+∞,且x>0时,控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向前、所述右履带速度V2的方向向后,
其中,a和b的值由操作人员人工地输入。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
优选地,当检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,a和b的值由操作人员人工地输入,Vmax为所述左履带和右履带的最大行驶速度。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
优选地,当检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,a和b的值由操作人员人工地输入,Vmax为所述左履带和右履带的最大行驶速度。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
本发明的另一个目的是一种履带起重机的行走姿态控制***,其中,该行走姿态控制***包括控制手柄、检测器、处理器和执行器,其中,
所述控制手柄的连接端铰接地连接在该履带起重机的控制台的铰接点上,所述控制手柄能够以所述铰接点为中心在竖直面和水平面上旋转,以使所述控制手柄的操纵端在水平面上的投影A能够在水平面上运动到并保持在以所述铰接点为圆心以Rmax为半径的圆周及其内部的任意位置;
所述检测器用于检测所述控制手柄的位置,并且将该位置传送到所述处理器;
所述处理器用于根据所述位置产生用于控制所述履带起重机的左履带和右履带的控制信号;
所述执行器用于根据所述控制信号控制所述左履带和右履带的行走方向和行走速度。
优选地,所述控制手柄能够在相对于竖直方向0-30度的范围内旋转。
优选地,以所述铰接点为原点O在水平面上建立直角坐标系,以所述履带起重机直线向前行驶的行驶方向为Y轴的正方向,以垂直于该行驶方向向右的方向为X轴的正方向,
所述检测器用于检测所述控制手柄的操纵端在该直角坐标系中的投影A的坐标(x,y),并将该坐标传送到所述处理器;
所述处理器用于根据所述坐标产生用于控制所述履带起重机的左履带和右履带的控制信号。
优选地,当所述检测器检测到所述坐标满足
当y>0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向前;
当y<0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向后;
当x>0时,所述处理器产生的控制信号控制所述左履带速度V1大于所述右履带速度V2;
当x<0时,所述处理器产生的控制信号控制所述左履带速度V1小于所述右履带速度V2。
优选地,当所述检测器检测到所述坐标满足
当y=0且x>0时,所述处理器产生的控制信号控制所述左履带速度V1 不为0,所述右履带速度V2为0;
当y=0且x<0时,所述处理器产生的控制信号控制所述左履带速度V1为0,所述右履带速度V2不为0;
当x=0且y>0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向前且大小相等;
当x=0且y<0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向后且大小相等。
优选地,当所述检测器检测到所述控制手柄的操纵端在该直角坐标系中的投影A的坐标0≤|x|≤x0,0≤|y|≤y0时,所述处理器产生控制所述履带起重机的左履带和右履带的行走速度为0的控制信号,
其中,0<x0<Rmax,0<y<Rmax,x2+y2<R2 max。
优选地,当所述检测器检测到所述坐标满足|x|>x0,|y|>y0,且
当0<|x/y|≤a,且y>0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向前;
当b≤|x/y|<+∞,且x<0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向后、所述右履带速度V2的方向向前;
当0<|x/y|≤a,且y<0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向后;
当b≤|x/y|<+∞,且x>0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向前、所述右履带速度V2的方向向后,
其中,所述检测器还用于接收由操作人员人工地输入的a和b的值。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
优选地,当所述检测器检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b, 且
当x<0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,所述检测器还用于接收由操作人员人工地输入的a和b的值,Vmax为所述左履带和右履带的最大行驶速度。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
优选地,当检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|, |y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,所述检测器还用于接收由操作人员人工地输入的a和b的值,Vmax为所述左履带和右履带的最大行驶速度。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
优选地,arctan(a)+arctan(b)=90度。
本发明还提供一种履带起重机,其中,该履带起重机包括本发明所述的行走姿态控制***。
通过上述技术方案,本发明的行走姿态控制方法通过对控制手柄的位置的检测来判断对履带起重机的左履带和右履带的行走速度和行走方向的控制,从而能够避免现有技术中依靠增加踏板来分别控制履带起重机的左履带和右履带的行走,只需要一个控制手柄就能控制履带起重机的行走,降低了成本和操作的复杂度,避免了误操作情况的发生,提高了安全性。
本发明的其他特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本发明的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本发明,但并不构成对本发明的限制。在附图中:
图1是根据本发明优选实施方式的履带起重机的底盘的左履带和右履带的简化示意图;
图2是根据本发明优选实施方式的履带起重机的控制手柄在水平面上的投影A的示意图。
附图标记说明
1左履带 2右履带
A控制手柄在水平面上的投影
x控制手柄在水平面上的投影的横坐标
y控制手柄在水平面上的投影的纵坐标
具体实施方式
以下结合附图对本发明的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明,并不用于限制本发明。
在本发明中,在未作相反说明的情况下,使用的方位词如应当根据附图以及实际工作状态,并结合上下文的具体内容进行适当的理解。
本发明提供一种履带起重机的行走姿态控制方法,其中,该行走姿态控制方法包括:
在所述履带起重机的控制台的铰接点上铰接地连接有控制手柄,使所述控制手柄能够以所述铰接点为中心在竖直面和水平面上旋转,以使所述控制手柄的操纵端在水平面上的投影A能够在水平面上运动到并保持在以所述铰接点为圆心以Rmax为半径的圆周及其内部的任意位置;
检测所述控制手柄的位置;
根据所述控制手柄的位置控制所述履带起重机的左履带1和右履带2的行走方向和行走速度。
本发明的行走姿态控制方法主要用于控制履带起重机的行走姿态。首先,需要在履带起重机的控制台的铰接点上铰接地连接控制手柄,该控制手柄能够以铰接点为中心在竖直面和水平面上旋转,也就是控制手柄能够绕铰接点在竖直方向的平面内旋转,也能绕铰接点在水平方向的平面内旋转,从 而使得控制手柄的操纵端在水平面上的投影A能够运动到以所述铰接点为圆心以Rmax为半径的圆周及其内部的任意位置并保持在该位置,也就是说,当控制手柄在水平面的360度的各个方向上,绕铰接点在竖直面上旋转到最大行程处时,控制手柄的操纵端在水平面上的投影A为以所述铰接点为圆心以Rmax为半径的圆周,因此,控制手柄在整个行程范围内运动时,
根据本发明的行走姿态控制方法,首先在起重机的控制台上设置控制手柄,该控制手柄铰接地连接在控制台上,并且该控制手柄能够绕控制手柄与控制台的铰接点旋转,具体地,该控制手柄能够在竖直面上绕该铰接点旋转,也能在水平面上绕该铰接点旋转。通常地,该控制手柄能够在水平面上的的360度范围内以一定半径的圆周绕铰接点旋转,而在竖直面上以一定的角度绕铰接点在扇形范围内旋转。并且,该控制手柄在水平面上的旋转的半径由控制手柄在竖直面上的相对于竖直方向的倾斜角度确定。
本发明的行走姿态控制方法通过对控制手柄的位置来控制履带起重机的左右履带2的行走方向和行走速度,具体的控制策略可以由本领域技术人员根据实际需要而进行适应性的设计,并发明对此并不加以限定。例如,可以根据控制手柄在竖直面上相对于竖直方向的倾斜角度来控制履带起重机的左右履带2的行走速度,根据控制手柄在水平面的圆周上的运动位置来控制左右履带2的行走方向,从而控制履带起重机的运动方向和运动速度。
通过上述技术方案,本发明的行走姿态控制方法通过对控制手柄的位置的检测来判断对履带起重机的左履带1和右履带2的行走速度和行走方向的控制,从而能够避免现有技术中依靠增加踏板来分别控制履带起重机的左履带1和右履带2的行走,只需要一个控制手柄就能控制履带起重机的行走,降低了成本和操作的复杂度,避免了误操作情况的发生,提高了安全性。
优选地,以所述铰接点为原点O在水平面上建立直角坐标系,以所述履带起重机直线向前行驶的行驶方向为Y轴的正方向,以垂直于该行驶方向向 右的方向为X轴的正方向,
检测所述控制手柄的操纵端在该直角坐标系中的投影A的坐标(x,y);
根据所述坐标控制所述履带起重机的左履带1和右履带2的行走方向和行走速度。
在本优选实施方式中,按照上述方法建立直角坐标系。其中,Y轴的正方向为履带起重机直线向前行驶的方向,以垂直于该行驶方向并相对于该行驶方向向右的方向为X轴的正方向,检测控制手柄的操纵端(即控制手柄相对于铰接点的最远的末端)在该直角坐标系中投影A的坐标,并根据该坐标对履带起重机的左履带1和右履带2的行走方向和行走速度进行控制。
优选地,当y>0时,所述左履带和所述右履带的速度方向均向前;
当y<0时,所述左履带和所述右履带的速度方向均向后;
当x>0时,所述左履带速度V1大于所述右履带速度V2;
当x<0时,所述左履带速度V1小于所述右履带速度V2。
也就是说,将y轴的正方向看做是履带起重机的前进方向,将y轴的负方向看做是相反的方向,将x轴的正方向看做是履带起重机的前进方向的右方,将x轴负方向看做是履带起重机的前进方向的左方。
投影A在坐标系中的位置就相应地决定了左右履带的速度和方向。
优选地,当y=0且x>0时,所述左履带速度V1不为0,所述右履带速度V2为0;
当y=0且x<0时,所述左履带速度V1为0,所述右履带速度V2不为0;
当x=0且y>0时,所述左履带和所述右履带的速度方向均向前且大小相等;
当x=0且y<0时,所述左履带和所述右履带的速度方向均向后且大小相等。
优选地,当检测到所述控制手柄的操纵端在该直角坐标系中的投影A的 坐标0≤|x|≤x0,0≤|y|≤y0时,所述履带起重机的左履带1和右履带2的行走速度为0,
其中,0<x0<Rmax,0<y<Rmax,x2+y2<R2 max。
在本优选实施方式中,通常地,该x0和y0的值都较小,其目的是在控制手柄相对于竖直方向偏移幅度较小时不起作用,即在控制手柄的运动范围内形成一个控制死区,当控制手柄在该控制死区的范围内运动时不会产生对履带起重机的左履带1和右履带2的控制作用,以防止发生误操作,提高安全性。
优选地,当检测到所述坐标满足|x|>x0,|y|>y0,且
当0<|x/y|≤a,y>0时,控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向前;
当b≤|x/y|<+∞,且x<0时,控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向后、所述右履带速度V2的方向向前;
当0<|x/y|≤a,且y<0时,控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向后;
当b≤|x/y|<+∞,且x>0时,控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向前、所述右履带速度V2的方向向后,
其中,a和b的值由操作人员人工地输入。优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
本优选实施方式提供了当控制手柄位于上述控制死区之外的位置时的一种优选的控制策略。
其中,0<arctan(a)≤5度,85度≤arctan(b)<90度。也就是说,上述四种情况都是指控制手柄的操纵端在直角坐标系中的投影A的坐标位于X 轴和Y轴的附近的区域,即控制手柄在直角坐标系中的投影A与X轴和Y轴的夹角都很小的情况。
当0<|x/y|≤a,y>0时,此时控制手柄的操纵端在坐标系中的投影A的坐标位于Y轴的正半轴附近,即控制手柄在直角坐标系中的投影A与Y轴的正半轴的夹角为小于等于arctan(a),此时控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向前,以控制履带起重机向前行驶。
当b≤|x/y|<+∞,且x<0时,此时控制手柄的操纵端在坐标系中的投影A的坐标位于X轴的负半轴附近,即控制手柄在直角坐标系中的投影A与X轴的负半轴的夹角为小于等于90度且大于等于arctan(b),此时控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向后、所述右履带速度V2的方向向前,控制履带起重机以自身中心为旋转中心向左转向。
当0<|x/y|≤a,且y<0时,此时控制手柄的操纵端在坐标系中的投影A的坐标位于Y轴的负半轴附近,即控制手柄在直角坐标系中的投影A与Y轴的负半轴的夹角为小于等于arctan(a),此时控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向后,以控制履带起重机向后倒退。
当b≤|x/y|<+∞,且x>0时,此时控制手柄的操纵端在坐标系中的投影A的坐标位于X轴的正半轴附近,即控制手柄在直角坐标系中的投影A与X轴的正半轴的夹角为小于等于90度且大于等于arctan(b),此时控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向前、所述右履带速度V2的方向向后,控制履带起重机以自身中心为旋转中心向右转向。
优选地,当检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右 履带速度V2方向相同且都向前;
当x>0,y>0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,a和b的值由操作人员人工地输入,Vmax为所述左履带1和右履带2的最大行驶速度。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
本优选实施方式提供了当控制手柄位于上述控制死区之外的位置时的一种优选的控制策略。
其中,0<arctan(a)≤5度,85度≤arctan(b)<90度,Vmax为所述左履带1和右履带2的最大行驶速度。也就是说,上述四种情况都是指控制手柄的操纵端在直角坐标系中的投影A的坐标位于除了上文的优选实施方式中所述的X轴和Y轴附近的区域之外的区域中,也就是说相对于上文所述的优选实施方式中的情况,位于相对远离X轴和Y轴的区域,即控制手柄在直角坐标系中的投影A与X轴和Y轴的夹角都较大的情况。
当x<0,y>0时,此时控制手柄的操纵端在坐标系中的投影A的坐标位于第二象限,即控制手柄在直角坐标系中的投影A与Y轴的正半轴的夹角为小于arctan(a)且大于arctan(b),此时控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且 左履带速度V1和所述右履带速度V2方向相同且都向前,以控制履带起重机向左前方转向。
当x>0,y>0时,此时控制手柄的操纵端在坐标系中的投影A的坐标位于第一象限,即控制手柄在直角坐标系中的投影A与Y轴的正半轴的夹角为小于arctan(a)且大于arctan(b),此时控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向前,以控制履带起重机向右前方转向。
当x<0,y<0时,此时控制手柄的操纵端在坐标系中的投影A的坐标位于第三象限,即控制手柄在直角坐标系中的投影A与Y轴的负半轴的夹角为小于arctan(a)且大于arctan(b),此时控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后,以控制履带起重机向左后方转向。
当x>0,y<0时,此时控制手柄的操纵端在坐标系中的投影A的坐标位于第四象限,即控制手柄在直角坐标系中的投影A与Y轴的负半轴的夹角为小于arctan(a)且大于arctan(b),此时控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向前,以控制履带起重机向右后方转向。
优选地,当检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax, 所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,a和b的值由操作人员人工地输入,Vmax为所述左履带1和右履带2的最大行驶速度。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
本优选实施方式的控制策略与上一优选实施方式的控制策略基本相同,其区别仅在于,在计算速度较小的履带相对于速度较大的履带的速度时,本实施方式中对90度角进行了修正,从而使得控制手柄的操纵端的位置能够准确地反应对左履带1和右履带2的速度和方向的控制,以使得操纵者能够更加直观地从控制手柄的操纵端的位置判断出履带起重机的行驶速度和行驶方向。
本发明还提供一种履带起重机的行走姿态控制***,其中,该行走姿态控制***包括控制手柄、检测器、处理器和执行器,其中,
所述控制手柄的连接端铰接地连接在该履带起重机的控制台的铰接点上,所述控制手柄能够以所述铰接点为中心在竖直面和水平面上旋转,以使所述控制手柄的操纵端在水平面上的投影A能够在水平面上运动到并保持在以所述铰接点为圆心以Rmax为半径的圆周及其内部的任意位置;
所述检测器用于检测所述控制手柄的位置,并且将该位置传送到所述处理器;
所述处理器用于根据所述位置产生用于控制所述履带起重机的左履带1和右履带2的控制信号;
所述执行器用于根据所述控制信号控制所述左履带1和右履带2的行走方向和行走速度。
在本发明的行走姿态控制***中,首先设置了控制控制手柄、检测器、处理器和执行器。其中,检测器用于检测控制手柄的位置,从而利用上述的本发明的行走姿态控制方法来控制履带起重机的行走。
该控制手柄的连接端铰接地连接在履带起重机的控制台的铰接点上,从而使得控制手柄能够以铰接点为中心在竖直面和水平面上旋转。其中,该控制手柄的连接端可以为相对于操纵端的另一端,也可以设置在控制手柄的中间部分上,主要起到将控制手柄铰接地安装在控制台上的目的,以提供控制手柄的旋转中心。
优选地,所述控制手柄能够在相对于竖直方向0-30度的范围内旋转。
在上述优选实施方式中,在竖直面上,控制手柄能够相对于竖直方向在0-30度的范围内旋转。当然,控制手柄还可以在更大的范围内相对于竖直方向旋转,本发明对此并不加以限制。
优选地,以所述铰接点为原点O在水平面上建立直角坐标系,以所述履带起重机直线向前行驶的行驶方向为Y轴的正方向,以垂直于该行驶方向向右的方向为X轴的正方向,
所述检测器用于检测所述控制手柄的操纵端在该直角坐标系中的投影A的坐标(x,y),并将该坐标传送到所述处理器;
所述处理器用于根据所述坐标产生用于控制所述履带起重机的左履带1和右履带2的控制信号。
在本优选实施方式中,按照上述的行走姿态控制方法建立直角坐标系并储存在处理器中。其中,Y轴的正方向为履带起重机直线向前行驶的方向, 以垂直于该行驶方向并相对于该行驶方向向右的方向为X轴的正方向,检测控制手柄的操纵端(即控制手柄相对于铰接点的最远的末端)在该直角坐标系中投影A的坐标,执行器根据该坐标对履带起重机的左履带1和右履带2的行走方向和行走速度进行控制。
优选地,当所述检测器检测到所述坐标满足
当y>0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向前;
当y<0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向后;
当x>0时,所述处理器产生的控制信号控制所述左履带速度V1大于所述右履带速度V2;
当x<0时,所述处理器产生的控制信号控制所述左履带速度V1小于所述右履带速度V2。
也就是说,将y轴的正方向看做是履带起重机的前进方向,将y轴的负方向看做是相反的方向,将x轴的正方向看做是履带起重机的前进方向的右方,将x轴负方向看做是履带起重机的前进方向的左方。
投影A在坐标系中的位置就相应地决定了左右履带的速度和方向。
优选地,当所述检测器检测到所述坐标满足
当y=0且x>0时,所述处理器产生的控制信号控制所述左履带速度V1不为0,所述右履带速度V2为0;
当y=0且x<0时,所述处理器产生的控制信号控制所述左履带速度V1为0,所述右履带速度V2不为0;
当x=0且y>0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向前且大小相等;
当x=0且y<0时,所述处理器产生的控制信号控制所述左履带和所述 右履带的速度方向均向后且大小相等。
优选地,当所述检测器检测到所述控制手柄的操纵端在该直角坐标系中的投影A的坐标0≤|x|≤x0,0≤|y|≤y0时,所述处理器产生控制所述履带起重机的左履带1和右履带2的行走速度为0的控制信号,
其中,0<x0<Rmax,0<y<Rmax,x2+y2<R2 max。
在本优选实施方式中,通常地,该x0和y0的值储存在处理器中并且都较小,其目的是作为处理器对控制手柄的死区进行判断的参考值,以使得在控制手柄相对于竖直方向偏移幅度较小时不起作用,即在控制手柄的运动范围内形成一个控制死区,当控制手柄在该控制死区的范围内运动时不会产生对履带起重机的左履带1和右履带2的控制作用,以防止发生误操作,提高安全性。
优选地,当所述检测器检测到所述坐标满足|x|>x0,|y|>y0,且
当0<|x/y|≤a,且y>0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向前;
当b≤|x/y|<+∞,且x<0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向后、所述右履带速度V2的方向向前;
当0<|x/y|≤a,且y<0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向后;
当b≤|x/y|<+∞,且x>0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向前、所述右履带速度V2的方向向后,
其中,所述检测器还用于接收由操作人员人工地输入的a和b的值。优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
根据本优选实施方式的行走姿态控制***能够实现上文所述的行走姿 态控制方法。
其中,0<arctan(a)≤5度,85度≤arctan(b)<90度。也就是说,上述四种情况都是指控制手柄的操纵端在直角坐标系中的投影A的坐标位于X轴和Y轴的附近的区域,即控制手柄在直角坐标系中的投影A与X轴和Y轴的夹角都很小的情况。
当0<|x/y|≤a,y>0时,此时检测器检测到控制手柄的操纵端在坐标系中的投影A的坐标位于Y轴的正半轴附近,即控制手柄在直角坐标系中的投影A与Y轴的正半轴的夹角为小于等于arctan(a),此时处理器产生的控制信号能够控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向前,以控制履带起重机向前行驶。
当b≤|x/y|<+∞,且x<0时,此时检测器检测到控制手柄的操纵端在坐标系中的投影A的坐标位于X轴的负半轴附近,即控制手柄在直角坐标系中的投影A与X轴的负半轴的夹角为小于等于90度且大于等于arctan(b),此时处理器产生的控制信号能够控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向后、所述右履带速度V2的方向向前,控制履带起重机以自身中心为旋转中心向左转向。
当0<|x/y|≤a,且y<0时,此时检测器检测到控制手柄的操纵端在坐标系中的投影A的坐标位于Y轴的负半轴附近,即控制手柄在直角坐标系中的投影A与Y轴的负半轴的夹角为小于等于arctan(a),此时处理器产生的控制信号能够控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向后,以控制履带起重机向后倒退。
当b≤|x/y|<+∞,且x>0时,此时检测器检测到控制手柄的操纵端在坐标系中的投影A的坐标位于X轴的正半轴附近,即控制手柄在直角坐标系中的投影A与X轴的正半轴的夹角为小于等于90度且大于等于arctan(b),此时处理器产生的控制信号能够控制所述左履带速度V1和所述右履带速度 V2大小相等,且所述左履带速度V1的方向向前、所述右履带速度V2的方向向后,控制履带起重机以自身中心为旋转中心向右转向。
优选地,当所述检测器检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,所述检测器还用于接收由操作人员人工地输入的a和b的值,Vmax为所述左履带1和右履带2的最大行驶速度。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
根据本优选实施方式的行走姿态控制***能够实现当控制手柄位于上述控制死区之外的位置时的行走姿态控制方法的优选实施方式。
其中,0<arctan(a)≤5度,85度≤arctan(b)<90度,Vmax为所述左履带1和右履带2的最大行驶速度。上述四种情况都是指控制手柄的操纵端在直角坐标系中的投影A的坐标位于除了上文的优选实施方式中所述的X轴和Y轴附近的区域之外的区域中,也就是说相对于上文所述的优选实施方式 中的情况,位于相对远离X轴和Y轴的区域,即控制手柄在直角坐标系中的投影A与X轴和Y轴的夹角都较大的情况。
当x<0,y>0时,此时检测器检测到控制手柄的操纵端在坐标系中的投影A的坐标位于第二象限,即控制手柄在直角坐标系中的投影A与Y轴的正半轴的夹角为小于arctan(a)且大于arctan(b),此时处理器产生的控制信号能够控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前,以控制履带起重机向左前方转向。
当x>0,y>0时,此时检测器检测到控制手柄的操纵端在坐标系中的投影A的坐标位于第一象限,即控制手柄在直角坐标系中的投影A与Y轴的正半轴的夹角为小于arctan(a)且大于arctan(b),此时处理器产生的控制信号能够控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向前,以控制履带起重机向右前方转向。
当x<0,y<0时,此时检测器检测到控制手柄的操纵端在坐标系中的投影A的坐标位于第三象限,即控制手柄在直角坐标系中的投影A与Y轴的负半轴的夹角为小于arctan(a)且大于arctan(b),此时处理器产生的控制信号能够控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后,以控制履带起重机向左后方转向。
当x>0,y<0时,此时检测器检测到控制手柄的操纵端在坐标系中的投影A的坐标位于第四象限,即控制手柄在直角坐标系中的投影A与Y轴的负半轴的夹角为小于arctan(a)且大于arctan(b),此时处理器产生的控制信号能够控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向 相同且都向前,以控制履带起重机向右后方转向。
优选地,当检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,所述检测器还用于接收由操作人员人工地输入的a和b的值,Vmax为所述左履带1和右履带2的最大行驶速度。
优选地,0<arctan(a)≤5度,85度≤arctan(b)<90度。
本优选实施方式的行走姿态控制***与上一优选实施方式的基本相同,其区别仅在于,本优选实施方式的处理器在计算速度较小的履带相对于速度较大的履带的速度时,对90度角进行了修正,从而使得检测器对控制手柄的操纵端的位置的检测能够准确地反应对左履带1和右履带2的速度和方向的控制,以使得操纵者能够更加直观地从控制手柄的操纵端的位置判断出履带起重机的行驶速度和行驶方向。
优选地,arctan(a)+arctan(b)=90度。
在本优选实施方式中,上文所述的arctan(a)和arctan(b)互为余角,从而 使得控制手柄的位置处于使得履带起重机向正前方和正后方行走,或者向左或右转向时,控制手柄所处的操纵位置能够相等且相对于一三象限和二四象限的角平分线对称。
本发明还提供一种履带起重机,其中,该履带起重机包括本发明所述的行走姿态控制***。
以上结合附图详细描述了本发明的优选实施方式,但是,本发明并不限于上述实施方式中的具体细节,在本发明的技术构思范围内,可以对本发明的技术方案进行多种简单变型,这些简单变型均属于本发明的保护范围。
另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合,为了避免不必要的重复,本发明对各种可能的组合方式不再另行说明。
此外,本发明的各种不同的实施方式之间也可以进行任意组合,只要其不违背本发明的思想,其同样应当视为本发明所公开的内容。
Claims (25)
1.一种履带起重机的行走姿态控制方法,其特征在于,该行走姿态控制方法包括:
在所述履带起重机的控制台的铰接点上铰接地连接有控制手柄,使所述控制手柄能够以所述铰接点为中心在竖直面和水平面上旋转,以使所述控制手柄的操纵端在水平面上的投影A能够在水平面上运动到并保持在以所述铰接点为圆心以Rmax为半径的圆周及其内部的任意位置;
检测所述控制手柄的位置;
根据所述控制手柄的位置控制所述履带起重机的左履带(1)和右履带(2)的行走方向和行走速度。
2.根据权利要求1所述的行走姿态控制方法,其特征在于,
以所述铰接点为原点O在水平面上建立直角坐标系,以所述履带起重机直线向前行驶的行驶方向为Y轴的正方向,以垂直于该行驶方向向右的方向为X轴的正方向,
检测所述控制手柄的操纵端在该直角坐标系中的投影A的坐标(x,y);
根据所述坐标控制所述履带起重机的左履带(1)和右履带(2)的行走方向和行走速度。
3.根据权利要求2所述的行走姿态控制方法,其特征在于,
当y>0时,所述左履带和所述右履带的速度方向均向前;
当y<0时,所述左履带和所述右履带的速度方向均向后;
当x>0时,所述左履带速度V1大于所述右履带速度V2;
当x<0时,所述左履带速度V1小于所述右履带速度V2。
4.根据权利要求3所述的行走姿态控制方法,其特征在于,
当y=0且x>0时,所述左履带速度V1不为0,所述右履带速度V2为0;
当y=0且x<0时,所述左履带速度V1为0,所述右履带速度V2不为0;
当x=0且y>0时,所述左履带和所述右履带的速度方向均向前且大小相等;
当x=0且y<0时,所述左履带和所述右履带的速度方向均向后且大小相等。
5.根据权利要求3所述的行走姿态控制方法,其特征在于,
当检测到所述控制手柄的操纵端在该直角坐标系中的投影A的坐标0≤|x|≤x0,0≤|y|≤y0时,所述履带起重机的左履带(1)和右履带(2)的行走速度为0,
其中,0<x0<Rmax,0<y0<Rmax,x2+y2<R2 max。
6.根据权利要求5所述的行走姿态控制***,其特征在于,
当检测到所述坐标满足|x|>x0,|y|>y0,且
当0<|x/y|≤a,y>0时,控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向前;
当b≤|x/y|<+∞,且x<0时,控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向后、所述右履带速度V2的方向向前;
当0<|x/y|≤a,且y<0时,控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向后;
当b≤|x/y|<+∞,且x>0时,控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向前、所述右履带速度V2的方向向后,
其中,a和b的值由操作人员人工地输入。
7.根据权利要求6所述的行走姿态控制***,其特征在于,0<arctan(a)≤5度,85度≤arctan(b)<90度。
8.根据权利要求5所述的行走姿态控制***,其特征在于,
当检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,a和b的值由操作人员人工地输入,Vmax为所述左履带(1)和右履带(2)的最大行驶速度。
9.根据权利要求8所述的行走姿态控制***,其特征在于,0<arctan(a)≤5度,85度≤arctan(b)<90度。
10.根据权利要求5所述的行走姿态控制***,其特征在于,
当检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,a和b的值由操作人员人工地输入,Vmax为所述左履带(1)和右履带(2)的最大行驶速度。
11.根据权利要求10所述的行走姿态控制***,其特征在于,0<arctan(a)≤5度,85度≤arctan(b)<90度。
12.一种履带起重机的行走姿态控制***,其特征在于,该行走姿态控制***包括控制手柄、检测器、处理器和执行器,其中,
所述控制手柄的连接端铰接地连接在该履带起重机的控制台的铰接点上,所述控制手柄能够以所述铰接点为中心在竖直面和水平面上旋转,以使所述控制手柄的操纵端在水平面上的投影A能够在水平面上运动到并保持 在以所述铰接点为圆心以Rmax为半径的圆周及其内部的任意位置;
所述检测器用于检测所述控制手柄的位置,并且将该位置传送到所述处理器;
所述处理器用于根据所述位置产生用于控制所述履带起重机的左履带(1)和右履带(2)的控制信号;
所述执行器用于根据所述控制信号控制所述左履带(1)和右履带(2)的行走方向和行走速度。
13.根据权利要求12所述的行走姿态控制***,其特征在于,所述控制手柄能够在相对于竖直方向0-30度的范围内旋转。
14.根据权利要求12所述的行走姿态控制***,其特征在于,以所述铰接点为原点O在水平面上建立直角坐标系,以所述履带起重机直线向前行驶的行驶方向为Y轴的正方向,以垂直于该行驶方向向右的方向为X轴的正方向,
所述检测器用于检测所述控制手柄的操纵端在该直角坐标系中的投影A的坐标(x,y),并将该坐标传送到所述处理器;
所述处理器用于根据所述坐标产生用于控制所述履带起重机的左履带(1)和右履带(2)的控制信号。
15.根据权利要求14所述的行走姿态控制***,其特征在于,
当所述检测器检测到所述坐标满足
当y>0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向前;
当y<0时,所述处理器产生的控制信号控制所述左履带和所述右履带 的速度方向均向后;
当x>0时,所述处理器产生的控制信号控制所述左履带速度V1大于所述右履带速度V2;
当x<0时,所述处理器产生的控制信号控制所述左履带速度V1小于所述右履带速度V2。
16.根据权利要求15所述的行走姿态控制***,其特征在于,
当所述检测器检测到所述坐标满足
当y=0且x>0时,所述处理器产生的控制信号控制所述左履带速度V1不为0,所述右履带速度V2为0;
当y=0且x<0时,所述处理器产生的控制信号控制所述左履带速度V1为0,所述右履带速度V2不为0;
当x=0且y>0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向前且大小相等;
当x=0且y<0时,所述处理器产生的控制信号控制所述左履带和所述右履带的速度方向均向后且大小相等。
17.根据权利要求14所述的行走姿态控制***,其特征在于,
当所述检测器检测到所述控制手柄的操纵端在该直角坐标系中的投影A的坐标0≤|x|≤x0,0≤|y|≤y0时,所述处理器产生控制所述履带起重机的左履带(1)和右履带(2)的行走速度为0的控制信号,
其中,0<x0<Rmax,0<y<Rmax,x2+y2<R2 max。
18.根据权利要求17所述的行走姿态控制***,其特征在于,
当所述检测器检测到所述坐标满足|x|>x0,|y|>y0,且
当0<|x/y|≤a,且y>0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向前;
当b≤|x/y|<+∞,且x<0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向后、所述右履带速度V2的方向向前;
当0<|x/y|≤a,且y<0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,方向相同且都向后;
当b≤|x/y|<+∞,且x>0时,所述处理器产生的控制信号控制所述左履带速度V1和所述右履带速度V2大小相等,且所述左履带速度V1的方向向前、所述右履带速度V2的方向向后,
其中,所述检测器还用于接收由操作人员人工地输入的a和b的值。
19.根据权利要求18所述的行走姿态控制***,其特征在于,0<arctan(a)≤5度,85度≤arctan(b)<90度。
20.根据权利要求17所述的行走姿态控制***,其特征在于,
当所述检测器检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/90度),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax, 且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/90度),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,所述检测器还用于接收由操作人员人工地输入的a和b的值,Vmax为所述左履带(1)和右履带(2)的最大行驶速度。
21.根据权利要求20所述的行走姿态控制***,其特征在于,0<arctan(a)≤5度,85度≤arctan(b)<90度。
22.根据权利要求17所述的行走姿态控制***,其特征在于,
当检测到所述坐标满足|x|>x0,|y|>y0,a<|x/y|<b,且
当x<0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x>0,y>0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向前;
当x<0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=V2×(1-arctan(|x/y|)/(90度-2arctan(a))),所述右履带速度V2=Vmax×max(|x|,|y|)/Rmax,且左履带速度V1和所述右履带速度V2方向相同且都向后;
当x>0,y<0时,所述处理器产生的控制信号控制所述左履带速度V1=Vmax×max(|x|,|y|)/Rmax,所述右履带速度V2=V1×(1-arctan(|x/y|)/(90度-2arctan(a))),且左履带速度V1和所述右履带速度V2方向相同且都向后;
其中,所述检测器还用于接收由操作人员人工地输入的a和b的值,Vmax 为所述左履带(1)和右履带(2)的最大行驶速度。
23.根据权利要求22所述的行走姿态控制***,其特征在于,0<arctan(a)≤5度,85度≤arctan(b)<90度。
24.根据权利要求12-23中任意一项所述的行走姿态控制***,其特征在于,arctan(a)+arctan(b)=90度。
25.一种履带起重机,其特征在于,该履带起重机包括上述权利要求12-24中任意一项所述的行走姿态控制***。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310670604.2A CN103787200B (zh) | 2013-12-10 | 2013-12-10 | 履带起重机及其行走姿态控制方法和控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310670604.2A CN103787200B (zh) | 2013-12-10 | 2013-12-10 | 履带起重机及其行走姿态控制方法和控制*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103787200A CN103787200A (zh) | 2014-05-14 |
CN103787200B true CN103787200B (zh) | 2015-09-02 |
Family
ID=50663337
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310670604.2A Active CN103787200B (zh) | 2013-12-10 | 2013-12-10 | 履带起重机及其行走姿态控制方法和控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103787200B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109391899A (zh) * | 2017-08-10 | 2019-02-26 | 深圳曼塔智能科技有限公司 | 遥控器摇杆定向方法及终端设备 |
CN109822599B (zh) * | 2019-03-05 | 2021-12-14 | 浙江华消科技有限公司 | 履带式机器人的运动控制方法、装置、***和存储介质 |
CN113292016B (zh) * | 2020-02-21 | 2023-06-16 | 林德(中国)叉车有限公司 | 一种操作手柄控制方法和控制输出装置 |
CN114415687A (zh) * | 2022-01-21 | 2022-04-29 | 北谷电子有限公司 | 一种单手柄控制器的控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1746064A2 (de) * | 2005-07-22 | 2007-01-24 | Liebherr-Werk Ehingen GmbH | Kran, vorzugsweise Raupen- oder Fahrzeugkran |
CN101780921A (zh) * | 2009-06-09 | 2010-07-21 | 上海海事大学 | 一种浮吊起重作业工作姿态安全监测方法 |
CN202729671U (zh) * | 2012-07-24 | 2013-02-13 | 徐工集团工程机械股份有限公司 | 一种履带起重机监测*** |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS52118750A (en) * | 1976-03-31 | 1977-10-05 | Mitsubishi Heavy Ind Ltd | Jib tip position control means for jib crane |
-
2013
- 2013-12-10 CN CN201310670604.2A patent/CN103787200B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1746064A2 (de) * | 2005-07-22 | 2007-01-24 | Liebherr-Werk Ehingen GmbH | Kran, vorzugsweise Raupen- oder Fahrzeugkran |
CN101780921A (zh) * | 2009-06-09 | 2010-07-21 | 上海海事大学 | 一种浮吊起重作业工作姿态安全监测方法 |
CN202729671U (zh) * | 2012-07-24 | 2013-02-13 | 徐工集团工程机械股份有限公司 | 一种履带起重机监测*** |
Also Published As
Publication number | Publication date |
---|---|
CN103787200A (zh) | 2014-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103787200B (zh) | 履带起重机及其行走姿态控制方法和控制*** | |
WO2019237351A1 (zh) | 机器人运动控制方法、装置、存储介质及机器人 | |
CN104881027B (zh) | 轮履复合式变电站巡检机器人自主越障***及控制方法 | |
JP4982407B2 (ja) | 移動体画像追尾装置及び方法 | |
CN106926840A (zh) | 一种无人车辆极限动力学轨迹跟踪控制*** | |
JPH05197423A (ja) | 移動体の制御装置 | |
EP2712840A1 (en) | Crawler type travelling vehicle | |
CN1394771A (zh) | 停车辅助装置 | |
WO2014162605A1 (ja) | 移動体 | |
JP5874717B2 (ja) | 訓練システム、及び訓練方法 | |
JP2015070981A (ja) | 障害物回避先導ロボット | |
JP2016120561A (ja) | 搬送ロボット、及びその制御方法 | |
JP2015016080A (ja) | 障害物回避先導ロボット | |
US20140244076A1 (en) | Stability based taxiing and turning method for aircraft with electric taxi system | |
JPWO2018074117A1 (ja) | 移動装置、および、移動装置管理システム | |
JPH09167018A (ja) | 移動車に任意の並行移動と任意の回転移動を組み合せた運動を実行させるための方法 | |
US20130282237A1 (en) | Inverted pendulum type moving body | |
WO2013117053A1 (zh) | 一种工程机械设备行走方向控制方法及装置 | |
JP2012081577A (ja) | ロボットの移動方向決定方法及びロボットの制御装置 | |
JP2020149508A (ja) | 移動体、制御装置、周囲物体検出器、及び監視装置 | |
CN116009530A (zh) | 一种自适应切向避障的路径规划方法和*** | |
CN114735024A (zh) | 一种车辆控制方法、装置、设备以及存储介质 | |
CN111580537B (zh) | 一种无人机特技飞行控制***及方法 | |
JP2015511900A (ja) | センサーを用いた移動車制御方法 | |
KR101041929B1 (ko) | 자율 이동 차량의 속도 결정 장치, 이를 구비하는 자율 이동 차량 및 자율 이동 차량의 속도 결정 방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C53 | Correction of patent of invention or patent application | ||
CB02 | Change of applicant information |
Address after: 410013 Yuelu District, Hunan, silver basin Road, No. 361, No. Applicant after: ZOOMLION HEAVY INDUSTRY SCIENCE&TECHNOLOGY Co.,Ltd. Address before: 410007 ZOOMLION grand pond Industrial Park, Yuanda Road, Changsha economic and Technological Development Zone, Changsha, Hunan 2, China Applicant before: ZOOMLION HEAVY INDUSTRY SCIENCE&TECHNOLOGY Co.,Ltd. |
|
COR | Change of bibliographic data |
Free format text: CORRECT: ADDRESS; FROM: 410007 CHANGSHA, HUNAN PROVINCE TO: 410013 CHANGSHA, HUNAN PROVINCE |
|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |