CN109250632B - 一种直线运动机构及其控制方法 - Google Patents
一种直线运动机构及其控制方法 Download PDFInfo
- Publication number
- CN109250632B CN109250632B CN201811352708.8A CN201811352708A CN109250632B CN 109250632 B CN109250632 B CN 109250632B CN 201811352708 A CN201811352708 A CN 201811352708A CN 109250632 B CN109250632 B CN 109250632B
- Authority
- CN
- China
- Prior art keywords
- linear motion
- telescopic arm
- assembly
- telescopic
- small
- 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
- 230000007246 mechanism Effects 0.000 title claims abstract description 74
- 230000033001 locomotion Effects 0.000 title claims abstract description 54
- 238000000034 method Methods 0.000 title claims abstract description 21
- 238000005202 decontamination Methods 0.000 claims abstract description 16
- 230000003588 decontaminative effect Effects 0.000 claims abstract description 16
- 230000009471 action Effects 0.000 claims abstract description 11
- 150000001875 compounds Chemical class 0.000 claims abstract description 8
- 230000008569 process Effects 0.000 claims description 8
- 230000008602 contraction Effects 0.000 claims description 4
- 230000004069 differentiation Effects 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 230000002045 lasting effect Effects 0.000 claims description 3
- 230000009977 dual effect Effects 0.000 claims 2
- 230000000712 assembly Effects 0.000 claims 1
- 238000000429 assembly Methods 0.000 claims 1
- 238000005516 engineering process Methods 0.000 abstract description 7
- 238000001514 detection method Methods 0.000 abstract description 4
- 238000011084 recovery Methods 0.000 abstract description 4
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 239000010720 hydraulic oil Substances 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C23/00—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
- B66C23/62—Constructional features or details
- B66C23/64—Jibs
- B66C23/70—Jibs constructed of sections adapted to be assembled to form jibs or various lengths
- B66C23/701—Jibs constructed of sections adapted to be assembled to form jibs or various lengths telescopic
- B66C23/705—Jibs constructed of sections adapted to be assembled to form jibs or various lengths telescopic telescoped by hydraulic jacks
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C23/00—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
- B66C23/62—Constructional features or details
- B66C23/82—Luffing gear
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C23/00—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
- B66C23/62—Constructional features or details
- B66C23/84—Slewing gear
- B66C23/86—Slewing gear hydraulically actuated
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B21/00—Common features of fluid actuator systems; Fluid-pressure actuator systems or details thereof, not covered by any other group of this subclass
- F15B21/02—Servomotor systems with programme control derived from a store or timing device; Control devices therefor
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Physics & Mathematics (AREA)
- Fluid Mechanics (AREA)
- General Engineering & Computer Science (AREA)
- Jib Cranes (AREA)
- Forklifts And Lifting Vehicles (AREA)
Abstract
本发明公开了一种直线运动机构,包括依次连接的大回转平台总成、下臂总成、伸缩臂总成、小回转平台总成、门架机构,所述大回转平台总成和下臂总成之间通过下臂连杆机构和下臂变幅机构连接,所述下臂总成和伸缩臂总成之间通过伸缩臂连杆机构和伸缩臂变幅机构连接。本发明还公开了一种直线运动机构的控制方法。通过控制“回转‑伸缩‑回转‑变幅”四个复合动作,完成门架机构的直线运动,实现洗消展车、空行程检测、洗消作业、恢复、悬臂展车、悬臂作业、自动收车等作业功能;采用自动调平控制技术和直线运动控制技术实现洗消作业所需的直线运动轨迹与精度。
Description
技术领域
本发明涉及一种直线运动机构及其控制方法。
背景技术
目前,复合运动控制技术最多控制两个动作,控制程序简单。不能够实现三个以上的多自由度复合运动控制。
发明内容
本发明所要解决的技术问题是克服现有技术的缺陷,提供一种直线运动机构及其控制方法,通过控制“回转-伸缩-回转-变幅”四个复合动作,完成门架机构的直线运动,实现洗消展车、空行程检测、洗消作业、恢复、悬臂展车、悬臂作业、自动收车等作业功能;实现洗消作业所需的直线运动轨迹与精度。
为解决上述技术问题,本发明提供一种直线运动机构,其特征是,包括依次连接的大回转平台总成、下臂总成、伸缩臂总成、小回转平台总成、门架机构,所述大回转平台总成和下臂总成之间通过下臂连杆机构和下臂变幅机构连接,所述下臂总成和伸缩臂总成之间通过伸缩臂连杆机构和伸缩臂变幅机构连接。
进一步地,所述大回转平台总成和小回转平台总成的回转方向相反。
进一步地,所述门架机构包括安装框架、设置在安装框架两端的左右立柱以及设置在两立柱之间的横梁。
进一步地,所述下臂连杆机构为双连杆机构,所述伸缩臂连杆机构为三连杆机构。
进一步地,所述下臂变幅机构为双变幅机构,所述伸缩臂变幅机构为双变幅机构。
进一步地,所述小回转平台总成与门架机构之间通过回转支撑相连接。
进一步地,所述门架机构在工作时通过“回转—伸缩—回转—变幅”四个复合动作的叠加走直线运动。
本发明还提供一种直线运动机构的控制方法,其特征是,包括以下步骤:
根据大小回转的中心距及洗消长度,计算出大回转角度、小回转角度、伸缩臂长度的运动范围;
估计大回转角度,计算出以1º为单位的大回转、小回转、伸缩臂伸缩这三者在直线运动中的速度比;
根据直线运动速度,限定三个机构的最大/最小动作速度;
打开比例电磁阀,给定一个大回转、伸缩臂伸缩、小回转的速度;
根据大小回转的中心距及实时大回转角度、小回转角度,计算出伸缩臂的当前理想位置;
在直线运动轨迹上,实际测量位置与理论计算位置,比较修正;
以理论计算的正确位置为基准,计算出实际位置与理论正确位置的偏差,采用PID调节,使实际位置与理论正确位置的偏差逐渐减小。
进一步地,还包括:
偏差过程补偿调节,即在空行程直线运动过程中,如果偏差为负值,那么就修正以大回转角度为控制基准,每一度给定一个伸缩臂伸缩、小回转的速度,即比例电磁阀的开口度或者电流值的百分比。
进一步地,还包括:伸缩臂自动调平,具体方法为:
当直线运动缩臂洗消时,伸缩臂向下调平;当直线运动伸臂洗消时,伸缩臂向上调平;
当调平角度>0.1º或<-0.1º时,启动调平功能;
比较计算偏差;
给定提前调节系统,持续100个控制器周期;
采用PID调节,打开比例电磁阀,伸缩臂变幅机构运动;
对伸缩臂调平角度进行滤波去抖动处理。
本发明所达到的有益效果:通过控制“回转-伸缩-回转-变幅”四个复合动作,完成门架机构的直线运动,实现洗消展车、空行程检测、洗消作业、恢复、悬臂展车、悬臂作业、自动收车等作业功能;采用自动调平控制技术和直线运动控制技术实现洗消作业所需的直线运动轨迹与精度。
附图说明
图1是本发明的结构示意图。
具体实施方式
下面结合附图对本发明作进一步描述。以下实施例仅用于更加清楚地说明本发明的技术方案,而不能以此来限制本发明的保护范围。
如图1所示,一种直线运动机构,包括依次连接的大回转平台总成1、下臂总成3、伸缩臂总成7、小回转平台总成8、门架机构9,所述大回转平台总成1和下臂总成3之间通过下臂连杆机构2和下臂变幅机构4连接,所述下臂连杆机构2为双连杆机构,所述下臂变幅机构4为双变幅机构。所述下臂总成3和伸缩臂总成7之间通过伸缩臂连杆机构6和伸缩臂变幅机构5连接,所述伸缩臂连杆机构6为三连杆机构,所述伸缩臂变幅机构6为双变幅机构。所述小回转平台总成8与门架机构9之间通过回转支撑相连接。该直线运动机构由液压系统驱动,并由控制系统控制。所述液压系统由比例多路阀、液压油缸、液压马达、液压平衡阀、液压管路等组成,所述控制系统由控制器、传感器、电气线缆、程序软件等组成。所述大回转平台总成1和小回转平台总成8的回转方向相反。所述门架机构9包括安装框架91、设置在安装框架91两端的左右立柱93以及设置在左右立柱93之间的横梁92。所述门架机构在工作时通过“回转—伸缩—回转—变幅”四个复合动作的叠加走直线运动。
本发明还提供一种直线运动机构的控制方法,包括以下步骤:
根据大小回转的中心距及洗消长度,计算出大回转角度、小回转角度、伸缩臂长度的运动范围;
估计大回转角度,计算出以1º为单位的大回转、小回转、伸缩臂伸缩这三者在直线运动中的速度比;
根据直线运动速度,限定三个机构的最大/最小动作速度;
打开比例电磁阀,给定一个大回转、伸缩臂伸缩、小回转的速度;
根据大小回转的中心距及实时大回转角度、小回转角度,计算出伸缩臂的当前理想位置;
在直线运动轨迹上,实际测量位置与理论计算位置,比较修正;
以理论计算的正确位置为基准,计算出实际位置与理论正确位置的偏差,采用PID调节,使实际位置与理论正确位置的偏差逐渐减小。
在程序中,还加入了偏差过程补偿调节,即在空行程直线运动过程中,如果偏差为负值,那么就修正以大回转角度为控制基准,每一度给定一个伸缩臂伸缩、小回转的速度,即比例电磁阀的开口度或者电流值的百分比。
由于门架机构在直线运行中,伸缩臂的挠度不断发生变化,影响立柱的垂直度和龙门的洗消高度,需要加入伸缩臂自动调平功能。同时,由于伸缩臂在直线运动过程中的挠度变化具有固有规律特性,所以简化了调平逻辑,当缩臂洗消时,伸缩臂只做变幅向下运动;当伸臂洗消时,伸缩臂只做变幅向上运动。由于回转过程中,伸缩臂挠度变化缓慢,采用慢速PID调节+前馈预调节就可以实现自动调平。
伸缩臂自动调平的具体方法为:
当直线运动缩臂洗消时,伸缩臂向下调平;当直线运动伸臂洗消时,伸缩臂向上调平;
当调平角度>0.1º或<-0.1º时,启动调平功能;
比较计算偏差;
给定提前调节系统,持续100个控制器周期;
采用PID调节,打开比例电磁阀,伸缩臂变幅机构运动;
对伸缩臂调平角度进行滤波去抖动处理。
本发明通过控制“回转-伸缩-回转-变幅”四个复合动作,完成门架机构的直线运动,实现洗消展车、空行程检测、洗消作业、恢复、悬臂展车、悬臂作业、自动收车等作业功能;采用自动调平控制技术和直线运动控制技术实现洗消作业所需的直线运动轨迹与精度。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。
Claims (8)
1.一种直线运动机构,其特征是,包括依次连接的大回转平台总成、下臂总成、伸缩臂总成、小回转平台总成、门架机构,所述大回转平台总成和下臂总成之间通过下臂连杆机构和下臂变幅机构连接,所述下臂总成和伸缩臂总成之间通过伸缩臂连杆机构和伸缩臂变幅机构连接;
控制方法,包括以下步骤:
根据大小回转的中心距及洗消长度,计算出大回转角度、小回转角度、伸缩臂长度的运动范围;
估计大回转角度,计算出以1°为单位的大回转、小回转、伸缩臂伸缩这三者在直线运动中的速度比;
根据直线运动速度,限定三个机构的最大/最小动作速度;
打开比例电磁阀,给定一个大回转、伸缩臂伸缩、小回转的速度;
根据大小回转的中心距及实时大回转角度、小回转角度,计算出伸缩臂的当前理想位置;
在直线运动轨迹上,实际测量位置与理论计算位置,比较修正;
以理论计算的正确位置为基准,计算出实际位置与理论正确位置的偏差,采用PID调节,使实际位置与理论正确位置的偏差逐渐减小;
偏差过程补偿调节,即在空行程直线运动过程中,如果偏差为负值,那么就修正以大回转角度为控制基准,每一度给定一个伸缩臂伸缩、小回转的速度,即比例电磁阀的开口度或者电流值的百分比。
2.根据权利要求1所述的一种直线运动机构,其特征是,所述大回转平台总成和小回转平台总成的回转方向相反。
3.根据权利要求1所述的一种直线运动机构,其特征是,所述门架机构包括安装框架、设置在安装框架两端的立柱以及设置在两立柱之间的横梁。
4.根据权利要求1所述的一种直线运动机构,其特征是,所述下臂连杆机构为双连杆机构,所述伸缩臂连杆机构为三连杆机构。
5.根据权利要求1所述的一种直线运动机构,其特征是,所述下臂变幅机构为双变幅机构,所述伸缩臂变幅机构为双变幅机构。
6.根据权利要求1所述的一种直线运动机构,其特征是,所述小回转平台总成与门架机构之间通过回转支撑相连接。
7.根据权利要求1所述的一种直线运动机构,其特征是,所述门架机构在工作时通过“回转—伸缩—回转—变幅”四个复合动作的叠加走直线运动。
8.根据权利要求1所述的一种直线运动机构,其特征是,还包括:伸缩臂自动调平,具体方法为:
当直线运动缩臂洗消时,伸缩臂向下调平;当直线运动伸臂洗消时,伸缩臂向上调平;
当调平角度>0.1°或<-0.1°时,启动调平功能;
比较计算偏差;
给定提前调节系统,持续100个控制器周期;
采用PID调节,打开比例电磁阀,伸缩臂变幅机构运动;
对伸缩臂调平角度进行滤波去抖动处理。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811352708.8A CN109250632B (zh) | 2018-11-14 | 2018-11-14 | 一种直线运动机构及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811352708.8A CN109250632B (zh) | 2018-11-14 | 2018-11-14 | 一种直线运动机构及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109250632A CN109250632A (zh) | 2019-01-22 |
CN109250632B true CN109250632B (zh) | 2024-04-09 |
Family
ID=65042974
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811352708.8A Active CN109250632B (zh) | 2018-11-14 | 2018-11-14 | 一种直线运动机构及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109250632B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110921585B (zh) * | 2019-11-07 | 2021-07-02 | 长沙中联消防机械有限公司 | 工作斗调平装置及高空作业车 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103693595A (zh) * | 2013-12-13 | 2014-04-02 | 中联重科股份有限公司 | 工作台调平的控制方法、装置、系统及工程机械 |
CN205769198U (zh) * | 2016-05-26 | 2016-12-07 | 重庆军通汽车有限责任公司 | 一种车辆自动龙门洗消装置 |
CN108556808A (zh) * | 2018-04-20 | 2018-09-21 | 重庆军通汽车有限责任公司 | 一种洗消车 |
CN108554891A (zh) * | 2018-04-20 | 2018-09-21 | 重庆军通汽车有限责任公司 | 一种洗消车的控制臂 |
CN208898402U (zh) * | 2018-11-14 | 2019-05-24 | 徐州徐工随车起重机有限公司 | 一种直线运动机构 |
-
2018
- 2018-11-14 CN CN201811352708.8A patent/CN109250632B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103693595A (zh) * | 2013-12-13 | 2014-04-02 | 中联重科股份有限公司 | 工作台调平的控制方法、装置、系统及工程机械 |
CN205769198U (zh) * | 2016-05-26 | 2016-12-07 | 重庆军通汽车有限责任公司 | 一种车辆自动龙门洗消装置 |
CN108556808A (zh) * | 2018-04-20 | 2018-09-21 | 重庆军通汽车有限责任公司 | 一种洗消车 |
CN108554891A (zh) * | 2018-04-20 | 2018-09-21 | 重庆军通汽车有限责任公司 | 一种洗消车的控制臂 |
CN208898402U (zh) * | 2018-11-14 | 2019-05-24 | 徐州徐工随车起重机有限公司 | 一种直线运动机构 |
Also Published As
Publication number | Publication date |
---|---|
CN109250632A (zh) | 2019-01-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3259221B1 (de) | Positionsregelung einer mastspitze | |
EP1975114B1 (de) | Schwingungskompensation am Hubgerüst eines Flurförderzeugs | |
CN104728566B (zh) | 回转举升调平机构 | |
CN103934823B (zh) | 一种具有自标定功能的6-ptrt型并联机器人 | |
CN102707730A (zh) | 高空作业车操作平台轨迹控制装置 | |
CN102345390A (zh) | 一种混凝土泵车臂架变形量的补偿方法 | |
CN109250632B (zh) | 一种直线运动机构及其控制方法 | |
CN106041902A (zh) | 一种四自由度十杆可控机构式码垛机器人 | |
CN208898402U (zh) | 一种直线运动机构 | |
CN116353875A (zh) | 基于三自由度电控调平的无人机起降平台及调平方法 | |
US10350754B2 (en) | Control device for robot | |
CN209296303U (zh) | 一种门锁耐久度测试装置 | |
CN110258425B (zh) | 抑尘车用臂架系统及其控制方法和控制系统、抑尘车 | |
CN210825309U (zh) | 能够水平直线轨迹移位的工作平台 | |
CN114439805B (zh) | 调平系统、调平方法及工程机械 | |
CN106826805B (zh) | 一种多角度精确控制的机器人手臂 | |
CN114439804B (zh) | 调平系统、调平方法及工程机械 | |
CN106272363A (zh) | 摆动气缸驱动的三自由度柔性并联机构控制装置及方法 | |
CN109109014A (zh) | 一种可变臂长工业机器人的控制系统及方法 | |
CN112850593B (zh) | 一种高空作业平台调平控制系统及方法 | |
CN209394663U (zh) | 一种能够升降及转动的平面关节型机器人 | |
CN204534020U (zh) | 回转举升调平机构 | |
CN1244435C (zh) | 一种与位置机构运动解耦的机器人姿态调节手腕机构 | |
CN116237953A (zh) | 一种臂架环形轨迹运动控制系统及其控制方法 | |
CN112900878A (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 |