CN104909314A - 一种云梯消防车转台及其调平控制方法 - Google Patents
一种云梯消防车转台及其调平控制方法 Download PDFInfo
- Publication number
- CN104909314A CN104909314A CN201510234820.1A CN201510234820A CN104909314A CN 104909314 A CN104909314 A CN 104909314A CN 201510234820 A CN201510234820 A CN 201510234820A CN 104909314 A CN104909314 A CN 104909314A
- Authority
- CN
- China
- Prior art keywords
- turntable
- error
- leveling
- controller
- rotary table
- 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.)
- Granted
Links
Classifications
-
- 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
- F15B9/00—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member
- F15B9/16—Systems essentially having two or more interacting servomotors, e.g. multi-stage
- F15B9/17—Systems essentially having two or more interacting servomotors, e.g. multi-stage with electrical control means
-
- A—HUMAN NECESSITIES
- A62—LIFE-SAVING; FIRE-FIGHTING
- A62C—FIRE-FIGHTING
- A62C27/00—Fire-fighting land vehicles
-
- E—FIXED CONSTRUCTIONS
- E06—DOORS, WINDOWS, SHUTTERS, OR ROLLER BLINDS IN GENERAL; LADDERS
- E06C—LADDERS
- E06C5/00—Ladders characterised by being mounted on undercarriages or vehicles Securing ladders on vehicles
- E06C5/32—Accessories, e.g. brakes on ladders
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- Public Health (AREA)
- Business, Economics & Management (AREA)
- Emergency Management (AREA)
- Physics & Mathematics (AREA)
- Fluid Mechanics (AREA)
- General Engineering & Computer Science (AREA)
- Fire-Extinguishing By Fire Departments, And Fire-Extinguishing Equipment And Control Thereof (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明公开一种云梯消防车转台及其调平控制方法,比例阀与调平油缸连接,两个倾角传感器安装在转台上,两个倾角传感器、比例阀均与控制器电连接;通过倾角传感器信号的对比消除单个倾角传感器信号跳动引起的输出误差;控制器实时监控比例阀电流反馈,对比例阀的开口大小实施闭环控制;通过把转台运动的角速度和比例阀专家PID自动调平系统相结合,实现转台自动调平。本发明的适应性强,能够根据转台的角速度,快速进行转台调平的自动调节;采用了双倾角传感器进行检测,通过倾角传感器信号的对比可以消除单个倾角传感器信号跳动引起的输出误差,提高了安全等级;反馈电流的闭环控制能够消除由于比例阀电阻发热引起的比例阀电流发生变化。
Description
技术领域
本发明涉及一种转台,具体涉及一种云梯消防车转台及其调平控制方法。
背景技术
大多数云梯消防车的转台调平是通过调节支腿来实现的,通过控制四个垂直支腿伸出量,实现转台的水平。通过支腿调平的方式,调节的角度范围较小,而转台自动调平能够有效提高整车场地坡度适应能力,通过转台调平技术实现上车调平的技术在消防车上越来越多地得到了应用。云梯消防车在进行救援时,通过转台带动梯架旋转,为了工作平台中的操作人员以及车辆的安全,必须保证转台底面与地面始终保持水平,并且不能出现抖动,保证救援任务的顺利完成。
目前云梯消防车转台的自动调平系统如图1所示,主要是根据转台安装的倾角传感器实时检测转台倾角,同时控制器接收到传感器信号后实时调节比例阀输出电流的大小。采用比例控制输出的方式控制电液比例阀,驱动转台调平油缸,实现转台调平,当转台倾角较大时,控制输出较大,当转台倾角较小时,控制输出较小。但是即使相对固定的参数,在转台运行速度变化时调平的效果也会有很大差异;并且当转台抖动时,倾角传感器的输出也会产生抖动,从而带动控制器的输出信号波动,导致整个液压系统会出现较大压力波动,因此需要设计具有转台自动调平能力良好的控制系统。
发明内容
针对上述现有技术存在的问题,本发明提供一种云梯消防车转台及其调平控制方法,实现转台角度的实时调平,保证云梯消防车能够安全作业。
为了实现上述目的,本发明采用的技术方案是:一种云梯消防车转台,包括底盘、副车架、回转支承、转台托架和转台,副车架设置在底盘上,副车架通过回转支承与转台托架连接,转台底面中部与转台托架铰接,转台侧面通过调平油缸与转台托架连接,其特征在于,还包括比例阀、控制器和两个倾角传感器,比例阀与调平油缸连接,两个倾角传感器安装在转台上,两个倾角传感器、比例阀均与控制器电连接。
进一步的,调平油缸由左调平油缸和右调平油缸组成,转台两侧分别通过左调平油缸、右调平油缸与转台托架连接。
一种云梯消防车转台调平控制方法,通过倾角传感器信号的对比消除单个倾角传感器信号跳动引起的输出误差;控制器实时监控比例阀电流反馈,对比例阀的开口大小实施闭环控制;通过把转台运动的角速度和专家PID自动调平系统相结合,实现转台自动调平的自适应控制。
进一步的,专家PID参数(kp,ki,kd)利用专家经验来设计,
令e(k)表示离散化的当前采样时刻的误差值,e(k-1),e(k-2)分别表示前一个和前两个采样时刻的误差值,则有
△e(k)=e(k)-e(k-1)
△e(k-1)=e(k-1)-e(k-2)
设M1和M2为系统误差临界值,根据误差及其变化,对误差曲线进行定性分析:
a.当∣e(k)∣﹥M1时,说明误差的绝对值已经很大,不论误差变化趋势如何,控制器按一定值输出;
b.当e(k)△e(k)﹥0或△e(k)=0时,说明误差在朝误差绝对值增大的方向变化,或误差为某一常值,未发生变化,
如果∣e(k)∣≥M2,说明误差较大,由控制器实施控制;
如果∣e(k)∣﹤M2,说明尽管误差朝绝对值增大的方向变化,但误差绝对值本身并不是很大,由控制器实施控制;
c.当e(k)△e(k)<0,△e(k)△e(k-1)<0时,说明误差处于极值状态,如果此时误差的绝对值较大,即∣e(k)∣≥M2,由控制器实施控制;
d.当e(k)△e(k)<0,△e(k)△e(k-1)>0时,说明误差朝绝对值减小的方向变化,采用减小到一定值时,保持控制器一定值输出值不变。
与现有技术相比,本发明的适应性强,能够根据转台的角速度,快速进行转台调平的自动调节;冗余保护,本发明采用了双倾角传感器进行检测,通过倾角传感器信号的对比可以消除单个倾角传感器信号跳动引起的输出误差,同时双倾角传感器检测提高了控制系统的安全等级;反馈电流的闭环控制能够消除由于比例阀电阻发热引起的比例阀电流发生变化。
附图说明
图1为背景技术中目前转台调平原理图;
图2为本发明云梯消防车转台示意图;
图3为本发明转台调平原理图;
图中:1、底盘,2、副车架,3、回转支承,4、转台托架,5、左调平油缸,6、右调平油缸,7、转台。
具体实施方式
下面结合附图对本发明作进一步说明。
如图2和图3所示,本云梯消防车转台,包括底盘1、副车架2、回转支承3、转台托架4和转台7,副车架2设置在底盘1上,副车架2通过回转支承3与转台托架4连接,转台7底面中部与转台托架4铰接,转台7侧面通过调平油缸与转台托架4连接,还包括比例阀、控制器和两个倾角传感器,比例阀与调平油缸连接,两个倾角传感器安装在转台7上,两个倾角传感器、比例阀均与控制器电连接;调平油缸由左调平油缸5和右调平油缸6组成,转台7两侧分别通过左调平油缸5、右调平油缸6与转台托架4连接。
云梯消防车转台调平控制方法,转台调平系统包括两个倾角传感器,通过倾角传感器信号的对比消除单个倾角传感器信号跳动引起的输出误差;控制器实时监控比例阀电流反馈,对比例阀的开口大小实施闭环控制,消除由于比例阀运行一段时间后,比例阀温度升高引起的电阻变化对比例阀开口大小的影响;通过把转台7运动的角速度和专家PID自动调平系统相结合,实现转台7自动调平的自适应控制;
专家PID控制的实质是:基于受控对象和控制规律的各种知识,无须知道被控对象的精确模型,专家PID参数(kp,ki,kd)利用专家经验来设计,
令e(k)表示离散化的当前采样时刻的误差值,e(k-1),e(k-2)分别表示前一个和前两个采样时刻的误差值,则有
△e(k)=e(k)-e(k-1)
△e(k-1)=e(k-1)-e(k-2)
设M1和M2为系统误差临界值,根据误差及其变化,对误差曲线进行定性分析:
a.当∣e(k)∣﹥M1时,说明误差的绝对值已经很大,不论误差变化趋势如何,都应考虑控制器的输出按定值K1毫安输出,以达到迅速调整误差,使误差绝对值以最大速度减小,同时避免超调;
b.当e(k)△e(k)﹥0或△e(k)=0时,说明误差在朝误差绝对值增大的方向变化,或误差为某一常值,未发生变化,
如果∣e(k)∣≥M2,说明误差较大,可考虑由控制器实施较强的控制作用,即控制器输出增加为K2乘以PID的调节量,使误差绝对值朝减小的方向变化,迅速减小误差的绝对值,
控制器输出为u(k)=u(k-1)+k1{kp[e(k)- e(k-1)]+kie(k)+kd[e(k)-2e(k-1)+e(k-2)]};
如果∣e(k)∣﹤M2,说明尽管误差朝绝对值增大的方向变化,但误差绝对值本身并不是很大,可考虑实施一般的控制作用,即控制器输出增加为K3乘以PID的调节量,扭转误差的变化趋势,使其朝误差绝对值减小方向变化,
控制器输出为u(k)=u(k-1)+kp[e(k)-e(k-1)]+kie(k)+kd[e(k)-2e(k-1)+e(k-2)];
c.当e(k)△e(k)<0,△e(k)△e(k-1)<0时,说明误差处于极值状态,如果此时误差的绝对值较大,即∣e(k)∣≥M2,可考虑实施较强的控制作用,即控制器输出增加为K4乘以PID的调节量,控制器输出为u(k)=u(k-1)+k1kpe(k);
d.当e(k)△e(k)<0,△e(k)△e(k-1)>0时,说明误差朝绝对值减小的方向变化,可采用减小到一定值时,保持控制器一定值输出值不变,即保持控制器前周期运行时的输出K5毫安不变。
Claims (4)
1.一种云梯消防车转台,包括底盘(1)、副车架(2)、回转支承(3)、转台托架(4)和转台(7),副车架(2)设置在底盘(1)上,副车架(2)通过回转支承(3)与转台托架(4)连接,转台(7)底面中部与转台托架(4)铰接,转台(7)侧面通过调平油缸与转台托架(4)连接,其特征在于,还包括比例阀、控制器和两个倾角传感器,比例阀与调平油缸连接,两个倾角传感器安装在转台(7)上,两个倾角传感器、比例阀均与控制器电连接。
2.根据权利要求1所述的一种云梯消防车转台,其特征在于,所述的调平油缸由左调平油缸(5)和右调平油缸(6)组成,转台(7)两侧分别通过左调平油缸(5)、右调平油缸(6)与转台托架(4)连接。
3.如权利要求1所述的一种云梯消防车转台调平控制方法,其特征在于,通过倾角传感器信号的对比消除单个倾角传感器信号跳动引起的输出误差;控制器实时监控比例阀电流反馈,对比例阀的开口大小实施闭环控制;通过把转台(7)运动的角速度和专家PID自动调平系统相结合,实现转台(7)自动调平的自适应控制。
4.根据权利要求3所述的一种云梯消防车转台调平控制方法,其特征在于,所述的专家PID参数(kp,ki,kd)利用专家经验来设计,
令e(k)表示离散化的当前采样时刻的误差值,e(k-1),e(k-2)分别表示前一个和前两个采样时刻的误差值,则有
△e(k)=e(k)-e(k-1)
△e(k-1)=e(k-1)-e(k-2)
设M1和M2为系统误差临界值,根据误差及其变化,对误差曲线进行定性分析:
a.当∣e(k)∣﹥M1时,说明误差的绝对值已经很大,不论误差变化趋势如何,控制器按一定值输出;
b.当e(k)△e(k)﹥0或△e(k)=0时,说明误差在朝误差绝对值增大的方向变化,或误差为某一常值,未发生变化,
如果∣e(k)∣≥M2,说明误差较大,由控制器实施控制;
如果∣e(k)∣﹤M2,说明尽管误差朝绝对值增大的方向变化,但误差绝对值本身并不是很大,由控制器实施控制;
c.当e(k)△e(k)<0,△e(k)△e(k-1)<0时,说明误差处于极值状态,如果此时误差的绝对值较大,即∣e(k)∣≥M2,由控制器实施控制;
d.当e(k)△e(k)<0,△e(k)△e(k-1)>0时,说明误差朝绝对值减小的方向变化,采用减小到一定值时,保持控制器一定值输出值不变。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510234820.1A CN104909314B (zh) | 2015-05-11 | 2015-05-11 | 一种云梯消防车转台及其调平控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510234820.1A CN104909314B (zh) | 2015-05-11 | 2015-05-11 | 一种云梯消防车转台及其调平控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104909314A true CN104909314A (zh) | 2015-09-16 |
CN104909314B CN104909314B (zh) | 2018-03-06 |
Family
ID=54078831
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510234820.1A Active CN104909314B (zh) | 2015-05-11 | 2015-05-11 | 一种云梯消防车转台及其调平控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104909314B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105365904A (zh) * | 2015-12-08 | 2016-03-02 | 济南大学 | 新型防侧翻式玉米收割机底盘 |
CN108635865A (zh) * | 2018-06-06 | 2018-10-12 | 中山市金马科技娱乐设备股份有限公司 | 一种通过双闭环控制系统保持座舱水平的游乐设施 |
CN108744533A (zh) * | 2018-06-06 | 2018-11-06 | 中山市金马科技娱乐设备股份有限公司 | 一种摩天轮回转轿厢的多开关表决水平控制方法 |
CN110764522A (zh) * | 2019-10-30 | 2020-02-07 | 贵州航天特种车有限责任公司 | 一种基于倾角补偿的调平控制系统及其方法 |
CN110968104A (zh) * | 2019-12-30 | 2020-04-07 | 农业农村部南京农业机械化研究所 | 一种果园采收平台智能调平控制系统及其方法 |
WO2021253782A1 (zh) * | 2020-06-16 | 2021-12-23 | 苏州大学 | 一种油气泵电机控制方法和装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6811161B1 (en) * | 2001-08-23 | 2004-11-02 | Sutphen Corporation | Fire engine having extension ladder and lateral stabilizers |
CN102530786A (zh) * | 2011-12-31 | 2012-07-04 | 长沙中联消防机械有限公司 | 作业平台自动调平控制方法、控制装置及控制系统 |
CN103463768A (zh) * | 2013-09-22 | 2013-12-25 | 徐州重型机械有限公司 | 调平装置、转台调平系统以及消防车 |
CN103693595A (zh) * | 2013-12-13 | 2014-04-02 | 中联重科股份有限公司 | 工作台调平的控制方法、装置、系统及工程机械 |
CN204038998U (zh) * | 2014-08-07 | 2014-12-24 | 徐州重型机械有限公司 | 一种工程车辆及其转台调平装置 |
-
2015
- 2015-05-11 CN CN201510234820.1A patent/CN104909314B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6811161B1 (en) * | 2001-08-23 | 2004-11-02 | Sutphen Corporation | Fire engine having extension ladder and lateral stabilizers |
CN102530786A (zh) * | 2011-12-31 | 2012-07-04 | 长沙中联消防机械有限公司 | 作业平台自动调平控制方法、控制装置及控制系统 |
CN103463768A (zh) * | 2013-09-22 | 2013-12-25 | 徐州重型机械有限公司 | 调平装置、转台调平系统以及消防车 |
CN103693595A (zh) * | 2013-12-13 | 2014-04-02 | 中联重科股份有限公司 | 工作台调平的控制方法、装置、系统及工程机械 |
CN204038998U (zh) * | 2014-08-07 | 2014-12-24 | 徐州重型机械有限公司 | 一种工程车辆及其转台调平装置 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105365904A (zh) * | 2015-12-08 | 2016-03-02 | 济南大学 | 新型防侧翻式玉米收割机底盘 |
CN108635865A (zh) * | 2018-06-06 | 2018-10-12 | 中山市金马科技娱乐设备股份有限公司 | 一种通过双闭环控制系统保持座舱水平的游乐设施 |
CN108744533A (zh) * | 2018-06-06 | 2018-11-06 | 中山市金马科技娱乐设备股份有限公司 | 一种摩天轮回转轿厢的多开关表决水平控制方法 |
CN108744533B (zh) * | 2018-06-06 | 2024-02-23 | 广东金马游乐股份有限公司 | 一种摩天轮回转轿厢的多开关表决水平控制方法 |
CN110764522A (zh) * | 2019-10-30 | 2020-02-07 | 贵州航天特种车有限责任公司 | 一种基于倾角补偿的调平控制系统及其方法 |
CN110968104A (zh) * | 2019-12-30 | 2020-04-07 | 农业农村部南京农业机械化研究所 | 一种果园采收平台智能调平控制系统及其方法 |
CN110968104B (zh) * | 2019-12-30 | 2024-06-07 | 农业农村部南京农业机械化研究所 | 一种果园采收平台智能调平控制系统及其方法 |
WO2021253782A1 (zh) * | 2020-06-16 | 2021-12-23 | 苏州大学 | 一种油气泵电机控制方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN104909314B (zh) | 2018-03-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104909314A (zh) | 一种云梯消防车转台及其调平控制方法 | |
US10443289B2 (en) | Vehicle with power swinging door and position-based torque compensation method | |
US11208082B1 (en) | Vehicle leveling assembly with mobile device | |
US9868445B2 (en) | Diagnostic supervisor to determine if a traction system is in a fault condition | |
US9878885B2 (en) | Crane controller | |
US20160075311A1 (en) | Vehicle leveling assembly with digital sensor | |
RU2014149141A (ru) | Стабилизация лесозаготовительной машины | |
ES2895639T3 (es) | Sistema de dirección por cable con regulación adaptativa de la posición de una cremallera | |
EP3019743B1 (en) | A method for controlling a wind turbine during safety operation | |
JP5825953B2 (ja) | 電気機械フライトアクチュエーションシステムの多重速度コントローラのための統合型アップサンプラー及びフィルタリング | |
US20130158819A1 (en) | Implement control system for a machine | |
BR102015026423B1 (pt) | Método para controlar de modo automático a operação de um conjunto de elevação de um veículo de trabalho | |
JP2016525737A (ja) | インテリジェントな調整器アセンブリ内の圧力を安定化させるための方法及び装置 | |
CN107835899B (zh) | 预测及控制风力涡轮机上负载的方法及其风力涡轮机 | |
CN102259809A (zh) | 一种叉车门架的控制系统及控制方法 | |
GB2435462A (en) | Electro-mechanical actuator efficiency monitor | |
US11198585B2 (en) | Systems and methods for controlling working fluid in hydraulic elevators | |
WO2016060816A1 (en) | Steady state differential roll moment control with automated differential lateral control | |
CN111645479A (zh) | 调整车辆的悬架的方法 | |
CN117549839A (zh) | 吸顶屏控制方法、系统、电子设备及介质 | |
CN102530786B (zh) | 作业平台自动调平控制方法、控制装置及控制系统 | |
US9541908B2 (en) | Servo motor controller and control method therefor | |
KR102093995B1 (ko) | 드론의 제어방법, 장치 및 시스템 | |
CA3005535A1 (en) | Method, system, and medium for controlling rate of penetration of a drill bit | |
EP2711332A1 (en) | Vehicle with solicited carriage descent |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C41 | Transfer of patent application or patent right or utility model | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20170213 Address after: 221004 Jiangsu Province, Xuzhou City Yunlong District No. 165 Applicant after: Xugong fire safety equipment Co. Ltd. Address before: 221004 Xuzhou, Zhejiang Province, Jiangsu Road No. 165 Applicant before: Xuzhou Heavy Machinery Co., Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |