CN111497548B - 一种主动减振式消防机器人底座装置及控制方法 - Google Patents
一种主动减振式消防机器人底座装置及控制方法 Download PDFInfo
- Publication number
- CN111497548B CN111497548B CN202010341236.7A CN202010341236A CN111497548B CN 111497548 B CN111497548 B CN 111497548B CN 202010341236 A CN202010341236 A CN 202010341236A CN 111497548 B CN111497548 B CN 111497548B
- Authority
- CN
- China
- Prior art keywords
- shock absorber
- assembly
- flow valve
- road surface
- control system
- 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 18
- 230000009467 reduction Effects 0.000 title claims abstract description 6
- 239000006096 absorbing agent Substances 0.000 claims abstract description 72
- 230000035939 shock Effects 0.000 claims abstract description 60
- 239000000725 suspension Substances 0.000 claims abstract description 60
- 238000013016 damping Methods 0.000 claims abstract description 52
- 230000007246 mechanism Effects 0.000 claims abstract description 37
- 230000005540 biological transmission Effects 0.000 claims abstract description 13
- 239000003638 chemical reducing agent Substances 0.000 claims abstract description 10
- 230000000712 assembly Effects 0.000 claims abstract description 8
- 238000000429 assembly Methods 0.000 claims abstract description 8
- 230000008569 process Effects 0.000 claims description 7
- 239000010720 hydraulic oil Substances 0.000 claims description 6
- 230000009471 action Effects 0.000 claims description 5
- 238000001514 detection method Methods 0.000 claims description 5
- 239000003921 oil Substances 0.000 claims description 4
- 238000012544 monitoring process Methods 0.000 claims description 3
- 238000010521 absorption reaction Methods 0.000 claims 2
- 230000036544 posture Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 2
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000008602 contraction Effects 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 239000002360 explosive Substances 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 229910052744 lithium Inorganic materials 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000000779 smoke Substances 0.000 description 1
- 231100000331 toxic Toxicity 0.000 description 1
- 230000002588 toxic effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load
- B60G17/015—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements
- B60G17/016—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by their responsiveness, when the vehicle is travelling, to specific motion, a specific condition, or driver input
- B60G17/0165—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by their responsiveness, when the vehicle is travelling, to specific motion, a specific condition, or driver input to an external condition, e.g. rough road surface, side wind
-
- A—HUMAN NECESSITIES
- A62—LIFE-SAVING; FIRE-FIGHTING
- A62C—FIRE-FIGHTING
- A62C27/00—Fire-fighting land vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D55/00—Endless track vehicles
- B62D55/08—Endless track units; Parts thereof
- B62D55/104—Suspension devices for wheels, rollers, bogies or frames
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2300/00—Indexing codes relating to the type of vehicle
- B60G2300/32—Track vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/05—Attitude
- B60G2400/051—Angle
- B60G2400/0511—Roll angle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/20—Speed
- B60G2400/204—Vehicle speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/80—Exterior conditions
- B60G2400/82—Ground surface
-
- 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
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/70—Energy storage systems for electromobility, e.g. batteries
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Health & Medical Sciences (AREA)
- Public Health (AREA)
- Business, Economics & Management (AREA)
- Emergency Management (AREA)
- Vehicle Body Suspensions (AREA)
Abstract
本发明涉及一种主动减振式消防机器人底座装置及控制方法,底座包括右行走机构、车体和左行走机构;行走机构包括驱动机构、张紧轮组件、导向轮、悬挂支撑组件和履带;车体包括控制组件、电池、测距传感器、车载陀螺仪和车速传感器;驱动机构包括驱动轮、传动杆、减速器和驱动电机,驱动电机将动力经传动杆传动到驱动轮上;张紧轮组件包括张紧轮、弹簧和支撑架;导向轮设置在履带的左上角;悬挂支撑组件包括叶片式减振器、减振器电机、承重轮连杆、承重轮、连杆、扭杆和扭杆支撑座,每组悬挂支撑组件是由控制***分别控制的,通过控制减振器电机对叶片式减振器阻尼力进行主动控制,以外界控制力的方式抑制路面对车身产生的冲击和车身的倾斜。
Description
技术领域
本发明涉及消防机器人领域,具体涉及一种主动减振式消防机器人底座装置及控制方法。
背景技术
消防机器人作为特种机器人的一种,在由各种危险品引起的泄漏***、火灾等灾害中发挥举足轻重的作用,可代替消防救援人员进入易燃易爆、有毒、缺氧、浓烟等危险环境进行探测、搜救和灭火,有效解决消防人员面临的人身安全,现场数据信息采集不足和传输不及时等问题。
消防机器人普遍采用履带式底座,履带式底座与地面接触面积大,可以穿越不平地形和攀登障碍。中国专利文献CN106515885A公开了一种双履带减振底盘,由两个履带装置,锂电池组,驱动器,控制器,电机和减速机组成,利用独立式弹簧减振机构实现整车的平稳运行。中国专利文献CN10879066A公开了一种基于线性电机的主动悬挂结构,利用线性电机的活动端伸缩带动连接件的下部以连接件与车身的铰接点为中心旋转,连接件给支撑杆一个向下或者向上的力,从而能够主动地驱使车轮上下运动,调节车身的姿态,主动缓冲由不平路面传给车身的冲击力。
现有技术的不足在于:被动式悬挂,其悬挂参数不能随路面状况,车辆运动状态发生改变,当路面条件较为复杂,无法满足较高的行驶平顺性和操作稳定性要求;基于弹簧的被动式悬挂,其使用寿命不长,需要经常更换;基于线性电机的主动悬挂,悬挂结构为整体式铰接件,加工难度大,不易于安装维修;基于线性电机的主动悬挂,杆状结构无法满足较大负载的履带式底座,使得消防机器人搭载的智能化设备受限。
发明内容
本发明的技术解决问题:克服现有技术的不足,提供一种主动减振式消防机器人底座装置及控制方法,以解决传统机器人底座行驶不平顺,操作不稳定,无法承载较大的负载以及悬挂结构使用寿命不长,难加工,不易于安装维修的问题。
本发明所采用的技术解决方案为:
本发明的一种主动减振式消防机器人底座装置,包括右行走机构(1)、车体(2)和左行走机构(3);所述右行走机构(1)和所述左行走机构(3)用于消防机器人的运转行进,所述车体(2)用于承载电气设备和探测灭火装置。
所述右行走机构(1)包括驱动机构(4)、张紧轮组件(5)、导向轮(7)、悬挂支撑组件(8)和履带(9);所述左行走机构(3)包括驱动机构(4)、张紧轮组件(5)、导向轮(7)、悬挂支撑组件(8)和履带(9);所述车体(2)包括控制组件(201)、电池(202)、测距传感器(6)、车载陀螺仪(203)和车速传感器(204);所述测距传感器(6)设置在车体(2)上方,测距传感器可以是激光雷达,也可以是红外传感器或者超声波测距传感器,可实现水平方向(360°),垂直方向(±70°)范围内路面信息探测,包含但不限定于路面凸起的高度,凹坑的深度及所述装置与所述路面凸起或所述路面凹坑的距离信息;所述车载陀螺仪(203)设置在车体(2)内部,用于探测所述装置的侧倾角信息;所述车速传感器(204)设置在车体(2)内部,用于探测所述装置的速度信息;
所述控制组件(201)分为上层控制***和下层控制***,上层控制***用于接收测距传感器(6)、车载陀螺仪(203)和车速传感器(204)分别所探测的所述装置的路面信息、倾侧角信息与速递信息,并结合探测的数据信息进行数据计算,下层控制***用于发送指令控制驱动电机(404),减振器电机(806),比例流量阀(811)的电磁铁。
所述驱动机构(4)包括驱动轮(401)、传动杆(402)、减速器(403)和驱动电机(404),驱动电机(404)和减速器(403)通过螺栓固定在车体(2)内部,驱动轮(401)通过轴承与传动杆(402)连接;驱动电机(404)经减速器(403)减速后将动力经传动杆(402)传动到驱动轮(401)上,驱动电机(404),控制组件(201),测距传感器(6)、车载陀螺仪(203)和车速传感器(204)以及减振器电机(806)均由电池(202)进行供电;所述的张紧轮组件(5)包括张紧轮(501)、弹簧(502)和支撑架(503),通过支撑架(503)固定在车体(2)的侧边,当履带(9)发生形变,在弹簧(502)作用下,张紧轮(501)可实现上下移动,始终保持履带(9)的张紧;所述的导向轮(6)设置在履带(9)的左上角,履带(9)的轮廓超出车体,确保履带式底座在行进过程中履带结构先接触障碍物,保护箱体不被撞击。
所述的悬挂支撑组件(8),所述装置两侧各设置有若干组,依据履带实际的长度和机器人底座的实际负载,所述的悬挂支撑组件(8)也可以设置为二,三,四,五组或者其他数量。每组所述悬挂支撑组件(8)包括叶片式减振器(805)、减振器电机(806)、承重轮连杆(804)、承重轮(803)、连杆(802)、扭杆(801)和扭杆支撑座(205),其中,所述扭杆(801)的一端固定在扭杆支撑座(205)上,所述扭杆支撑座(205)通过螺栓固定在车体(2)内部,所述扭杆(801)的另一端与连杆(802)连接;所述承重轮连杆(804)的一端与承重轮(803)连接,所述承重轮连杆(804)的另一端与叶片减振器(805)的转动式叶片(809)连接;
所述叶片式减振器(805)包括减振器底壳(807)、固定式叶片(808)、转动式叶片(809),比例流量阀(811)和减振器外壳(812),所述叶片式减振器(805)通过螺栓固定在车体(2)的侧边;所述转动式叶片(809)与减振器电机(806)轴连接,所述固定式叶片(808)上设有常通阻尼孔(810),所述固定式叶片(808)和转动式叶片(809)将叶片式减振器(805)内部分成四个腔体,这四个腔体与减振器外壳(812)形成密闭空间,密闭空间内注有液压油,液压油通过所述常通阻尼孔(810)和比例流量阀(811)在四个腔体内来回流动,使四个腔体形成高低压油腔,产生阻尼力;所述比例流量阀(811)固定于转动式叶片(809)上,所述比例流量阀(811)包括电磁铁与流量阀,通过电磁铁驱动控制流量阀阀门的开合大小,实现阻尼力的实时调节。
其中,所述控制组件(201)的上层控制***结合路面信息,侧倾角信息和速度信息计算每组所述悬挂支撑组件(8)需要调整的姿态和叶片式减振器(805)的最优阻尼力,经过数据处理后得到所述减振器电机(806)需要转动的方向和角度及比例流量阀(811)的流量阀阀门开合大小;
所述控制组件(201)对所述悬挂支撑组件(8)的姿态和叶片式减振器(805)的阻尼力进行主动控制的实现过程包括:
步骤1:所述控制组件(201)的下层控制***分别发送信号控制减振器电机(806),驱动转动式叶片(809)顺时针或逆时针转动需要的角度,承重轮连杆(804)在转动式叶片(809)的作用下带动承重轮(803)发生向上或向下运动,实现所述悬挂支撑组件(8)的姿态调整;
步骤2:所述控制组件(201)的下层控制***分别发送信号调节八个比例流量阀(811)上的电磁铁驱动电流,控制比例流量阀(811)的流量阀阀门开合的大小,从而调节叶片式减振器(805)内部的节流特性,实现叶片式减振器(805)的最优阻尼力。
本发明的一种本发明所述装置进行主动减振控制的方法,包括以下步骤:
步骤1),所述装置的车体(2)上的测距传感器(6),在所述装置行驶过程中始终处于探测状态,探测所述装置水平方向(360°),垂直方向(±70°)范围内路面信息探测,包含但不限定于路面凸起的高度,凹坑的深度及所述装置与所述路面凸起或所述路面凹坑的距离信息,形成所述装置行驶轨迹前的连续路面信息,将路面信息实时传输给控制组件(201)的上层控制***作为数据库进行存储,且不断更新数据库;
步骤2),所述控制组件(201)的上层控制***结合路面信息计算所述悬挂支撑组件(8)需要预设的姿态和叶片式减振器(805)的最优阻尼力,由下层控制***发送信号控制减振器电机(806)需要转动的方向和角度及比例流量阀(811)的流量阀阀门的开合大小,使得所述悬挂支撑组件(8)预先调整好姿态,所述叶片式减振器(805)产生最优阻尼力;
步骤3),所述装置的车载陀螺仪(203)和车速传感器(204)实时处于监测状态,所述车载陀螺仪(203)进行所述装置侧倾角的探测,所述车速传感器(204)进行所述装置速度信息的探测,并反馈侧倾角信息和速度信息发送至控制组件(201)的上层控制***;
步骤4),控制组件(201)的上层控制***结合路面信息,侧倾角信息和速度信息对所述悬挂支撑组件(8)的姿态和叶片式减振器(805)的最优阻尼力进行计算校正,,由下层控制***再次发送校正信号调整减振器电机(806)需要转动的方向和角度及比例流量阀(811)的流量阀阀门的开合大小,使得所述悬挂支撑组件(8)的姿态完美匹配路面状况,所述叶片式减振器(805)产生最优阻尼力实现所述装置的主动减振;
步骤5),继续重复步骤1~4,直至所述装置到达指定地点。
本发明相对于现有技术的技术优点是:
(1)本发明提供的主动减振式消防机器人底座装置及控制方法,通过控制组件的上层控制***对悬挂支撑组件的姿态及叶片式减振器的阻尼力进行主动控制,以外界控制力的方式抑制路面对车身产生的冲击和车身的倾斜,提高机器人在复杂路面的行驶平顺性和操作稳定性;
(2)本发明利用测距传感器进行路面信息探测,车载陀螺仪和车速传感器实时传输机器人状态,提高机器人悬挂***动态调整的响应速度,进一步提高机器人的行驶平顺性和操作稳定性;
(3)本发明使用叶片式减振器代替弹簧,使得消防机器人底座能均匀负载且承载大,提高消防机器人探测装置的负载需求;
(4)本发明使用的叶片式减振器,使用寿命长,有效提高悬挂***的耐久性;
(5)本发明的悬挂支撑组件结构简单,通用性强,易于拆装维修。
附图说明
图1为本发明消防机器人底座整体结构示意图;
图2为本发明消防机器人底座行驶越障示意图;
图3为本发明消防机器人底座内部结构示意图;
图4为本发明消防机器人底座的悬挂支撑组件示意图;
图5为本发明消防机器人底座的叶片式减振器内部示意图;
图6为本发明消防机器人底座的主动式减振控制方法。
图中:右行走机构1、车体2、左行走机构3、驱动机构4、张紧轮组件5、测距传感器6、导向轮7、悬挂支撑组件8、履带9;
张紧轮组件5、张紧轮501、弹簧502、支撑架503;
控制组件201、电池202、车载陀螺仪203、车速传感器204、扭杆支撑座205、驱动轮401、传动杆402、减速器403、驱动电机404;
扭杆801、连杆802、承重轮803、承重轮连杆804、叶片式减振器805、减振器电机806;
叶片式减振器805、减振器电机806、减振器底壳807、固定式叶片808、转动式叶片809、常通阻尼孔810、比例流量阀811、减振器外壳812。
具体实施方式
下面结合附图以及具体实施方式进一步说明本发明。
如图1所示,本发明的一种主动减振式消防机器人底座装置包括:右行走机构1、车体2和左行走机构3;其中,右行走机构1和左行走机构3均包括驱动机构4、张紧轮组件5、导向轮7、悬挂支撑组件8和履带9;车体2上方安装有测距传感器6,其中,测距传感器可以是激光雷达,也可以是红外传感器或者超声波测距传感器。
如图3所示,一种主动减振式消防机器人底座装置的车体2内部包括控制组件201、电池202、车载陀螺仪203和车速传感器204,均通过螺栓固定在车体2内部。
驱动机构4包括驱动轮401、传动杆402、减速器403和驱动电机404,驱动电机404经减速器403减速后将动力经传动杆402传动到驱动轮401上,驱动电机404和减速器403通过螺栓固定在车体2内部,驱动轮401通过轴承与传动杆402连接;驱动电机404,控制组件201,测距传感器6、车载陀螺仪203和车速传感器204以及减振器电机806均由电池202进行供电。
如图2所示,张紧轮组件5包括张紧轮501、弹簧502和支撑架503,通过支撑架503固定在车体2的侧边,当机器人底座遇到不同路面状况时,悬挂支撑组件8需要调整不同姿态,履带9发生松弛,在弹簧502作用下,张紧轮501可实现上下移动,使得履带9在行进过程中始终保持张紧;
导向轮7设置在履带9的左上角,履带9的轮廓超出车体,确保履带式底座在行进过程中履带结构先接触障碍物,保护箱体不被撞击。
如图4所示,右行走机构1和左行走机构3各设置有若干组悬挂支撑组件8,依据履带实际的长度和机器人底座的实际负载,所述的悬挂支撑组件8也可以设置为二,三,四,五组或者其他数量。每组悬挂支撑组件8包括叶片式减振器805、减振器电机806、承重轮连杆804、承重轮803、连杆802、扭杆801和扭杆支撑座205,其中,扭杆801的一端固定在扭杆支撑座205上,扭杆支撑座205通过螺栓固定在车体2内部,另一端与连杆802连接,当承重轮803发生相对运动,扭杆801跟随连杆802发生转动;承重轮连杆804一端与承重轮803连接,另一端与叶片减振器805的转动式叶片809连接,转动式叶片809与减振器电机806轴连接;
如图5所示,叶片式减振器805包括减振器底壳807、固定式叶片808、转动式叶片809、比例流量阀811和减振器外壳812;其中,叶片式减振器805通过螺栓固定在车体2的侧边;固定式叶片808上设有常通阻尼孔810,所述固定式叶片808和转动式叶片809将叶片式减振器805内部分成四个腔体,这四个腔体与减振器外壳812形成密闭空间,密闭空间内注有液压油,液压油通过所述常通阻尼孔810和比例流量阀811在四个腔体内来回流动,使四个腔体形成高低压油腔,产生阻尼力;比例流量阀811设于转动式叶片809上,所述比例流量阀811包括电磁铁与流量阀,通过电磁铁驱动控制流量阀阀门的开合大小,实现阻尼力的实时调节;
所述控制组件201的上层控制***结合路面信息,侧倾角信息和速度信息计算每组所述悬挂支撑组件8需要调整的姿态和叶片式减振器805的最优阻尼力,经过数据处理后得到所述减振器电机806需要转动的方向和角度及比例流量阀811的流量阀阀门的开合大小;
所述控制组件201的下层控制***分别发送信号控制八个减振器电机806,驱动转动式叶片809顺时针或逆时针转动需要的角度,承重轮连杆804在转动式叶片809的作用下带动承重轮803发生向上或向下运动,实现所述悬挂支撑组件8的姿态调整;所述控制组件201的下层控制***分别发送信号调节八个比例流量阀811上的电磁铁驱动电流,控制比例流量阀811的流量阀阀门开合的大小,从而调节叶片式减振器805内部的节流特性,实现叶片式减振器805的最优阻尼力。
如图6所示,本发明的主动减振式消防机器人底座装置实现主动式减振的方法为:
步骤1:所述装置的车体2上的测距传感器6,在所述装置行驶过程中始终处于探测状态,探测所述装置水平方向(360°),垂直方向(±70°)范围内路面信息探测,包含但不限定于路面凸起的高度,凹坑的深度及所述装置与所述路面凸起或所述路面凹坑的距离信息,形成所述装置行驶轨迹前的连续路面信息,将路面信息实时传输给控制组件201的上层控制***作为数据库进行存储,且不断更新数据库;
步骤2:所述控制组件201的上层控制***结合路面信息计算所述悬挂支撑组件8需要预设的姿态和叶片式减振器805的最优阻尼力,由下层控制***发送信号控制减振器电机806需要转动的方向和角度及比例流量阀811的流量阀阀门开合大小,使得所述悬挂支撑组件8预先调整好姿态,所述叶片式减振器805产生最优阻尼力;
步骤3:所述装置的车载陀螺仪203和车速传感器204实时处于监测状态,所述车载陀螺仪203进行所述装置侧倾角的探测,所述车速传感器204进行所述装置速度信息的探测,并反馈侧倾角信息和速度信息发送至控制组件201的上层控制***;
步骤4:控制组件201的上层控制***结合路面信息,侧倾角信息和速度信息对所述悬挂支撑组件8的姿态和叶片式减振器805的最优阻尼力进行计算校正,由下层控制***再次发送校正信号调整减振器电机806需要转动的方向和角度及比例流量阀811的流量阀阀门开合大小,使得所述悬挂支撑组件8的姿态完美匹配路面状况,所述叶片式减振器805产生最优阻尼力实现所述装置的主动减振;
步骤5:继续重复步骤1~4,完成了整个控制工作。
Claims (4)
1.一种主动减振式消防机器人底座装置,其特征在于:
所述装置包括右行走机构(1)、车体(2)和左行走机构(3);
所述右行走机构(1)和所述左行走机构(3)用于消防机器人的运转行进;
所述车体(2)用于承载电气设备和探测灭火装置;
所述右行走机构(1)包括驱动机构(4)、张紧轮组件(5)、导向轮(7)、悬挂支撑组件(8)和履带(9);
所述左行走机构(3)包括驱动机构(4)、张紧轮组件(5)、导向轮(7)、悬挂支撑组件(8)和履带(9);
所述车体(2)包括控制组件(201)、电池(202)、测距传感器(6)、车载陀螺仪(203)和车速传感器(204);
所述驱动机构(4)包括驱动轮(401)、传动杆(402)、减速器(403)和驱动电机(404);
所述驱动电机(404)和所述减速器(403)固定在车体(2)内部;
所述驱动轮(401)通过轴承与所述传动杆(402)连接;
所述驱动电机(404)经所述减速器(403)减速后将动力经所述传动杆(402)传动到所述驱动轮(401)上;
所述驱动电机(404)、控制组件(201)、测距传感器(6)、车载陀螺仪(203)与车速传感器(204)均由所述电池(202)供电;
所述张紧轮组件(5)通过支撑架(503)固定在车体的侧边;
所述导向轮(7)设置在所述履带(9)的左上角;
所述测距传感器(6)设置在所述车体(2)上方,用于探测所述装置的路面信息,并将所述路面信息发送至所述控制组件(201);
所述车载陀螺仪(203)设置在所述车体(2)内部,用于探测所述装置的侧倾角信息,并将所述侧倾角信息发送至所述控制组件(201);
所述车速传感器(204)设置在所述车体(2)内部,用于探测所述装置的速度信息,并将所述速度信息发送至所述控制组件(201);
所述控制组件(201)分为上层控制***和下层控制***,所述上层控制***用于结合所接收的所述装置的路面信息、侧倾角 信息与速度信息进行数据计算并产生指令,所述下层控制***用于发送指令主动控制所述驱动电机(404)与所述悬挂支撑组件(8),以实现主动减振;
所述装置的所述左行走机构(3)和所述右行走机构(1)各设有若干组悬挂支撑组件(8);
每组所述悬挂支撑组件(8)包括叶片式减振器(805)、减振器电机(806)、承重轮连杆(804)、承重轮(803)、连杆(802)、扭杆(801)和扭杆支撑座(205);
所述扭杆(801)的一端固定在扭杆支撑座(205)上,所述扭杆支撑座固定在车体(2)内部,所述扭杆(801)的另一端与连杆(802)连接;
所述承重轮连杆(804)的一端与承重轮(803)连接,所述承重轮连杆(804)的另一端与叶片式减振器(805)的转动式叶片(809)连接;
所述减振器电机(806)由所述电池(202)供电;
所述叶片式减振器(805)包括减振器底壳(807)、固定式叶片(808)、转动式叶片(809),比例流量阀(811)和减振器外壳(812),所述叶片式减振器固定在车体(2)的侧边;
所述转动式叶片(809)与减振器电机(806)轴连接,所述固定式叶片(808)上设有常通阻尼孔(810),所述固定式叶片(808)和转动式叶片(809)将叶片式减振器(805)内部分成四个腔体,所述四个腔体与减振器外壳(812)形成密闭空间,密闭空间内注有液压油,液压油通过所述常通阻尼孔(810)和比例流量阀(811)在四个腔体内来回流动,使四个腔体形成高低压油腔,产生阻尼力;
所述比例流量阀(811)固定于转动式叶片(809)上,所述比例流量阀(811)包括电磁铁与流量阀,通过电磁铁驱动控制流量阀阀门的开合大小,实现阻尼力的实时调节;
所述控制组件(201)的下层控制***用于发送指令主动控制所述悬挂支撑组件(8)中所述减振器电机(806)的转动方向和角度,进而主动控制所述悬挂支撑组件(8)的姿态,以实现主动减振;
所述控制组件(201)的下层控制***用于发送指令主动控制所述悬挂支撑组件(8)中所述比例流量阀(811)的流量阀阀门的开合大小,进而主动控制所述叶片式减振器(805)的阻尼力,以实现主动减振。
2.根据权利要求1所述的一种主动减振式消防机器人底座装置,其特征在于:
所述测距传感器(6)用于探测水平方向上0~360°,垂直方向上-70°~+70°范围内所述装置的路面信息,所述路面信息包括但不限定于路面凸起的高度、路面凹坑的深度及所述装置与所述路面凸起或所述路面凹坑的距离信息,并将所述路面信息发送至所述控制组件(201)的上层控制***,所述上层控制***结合所述路面信息计算所述悬挂支撑组件(8)所需的预设姿态和叶片式减振器(805)所需的最优阻尼力,进而计算得到减振器电机(806)所需的转动方向和角度及比例流量阀(811)的流量阀阀门所需的开合大小并产生指令,由所述下层控制***发送指令主动控制所述减振器电机(806)的转动方向和角度,控制所述比例流量阀(811)的流量阀阀门的开合大小,使得所述悬挂支撑组件(8)预先调整好所需的预设姿态,所述叶片式减振器(805)预先产生所需的最优阻尼力;
所述控制组件(201)的上层控制***进一步结合所接收的所述装置的侧倾角信息与速度信息对所述悬挂支撑组件(8)的姿态和所述叶片式减振器(805)的最优阻尼力进行校正,由所述控制组件(201)的下层控制***再次发送指令主动调整所述减振器电机(806)的转动方向和角度以及所述比例流量阀(811)的流量阀阀门的开合大小,使得所述悬挂支撑组件(8)调整姿态,所述叶片式减振器(805)调整阻尼力,进而保持所述装置的主动减振与平稳行驶。
3.根据权利要求1或2所述的一种主动减振式消防机器人底座装置,其特征在于:
所述控制组件(201)的下层控制***用于发送指令主动控制所述悬挂支撑组件(8)中所述减振器电机(806)的转动方向和角度,进而主动控制所述悬挂支撑组件(8)的姿态的实现为,
所述控制组件(201)的下层控制***分别发送信号控制所述悬挂支撑组件(8)的减振器电机(806),驱动转动式叶片(809)顺时针或逆时针转动一定的角度,承重轮连杆(804)在转动式叶片(809)的作用下带动承重轮(803)发生一定的向上或向下运动,进而主动控制所述悬挂支撑组件(8)的姿态;
所述控制组件(201)的下层控制***用于发送指令主动控制所述悬挂支撑组件(8)中所述比例流量阀(811)的流量阀阀门的开合大小,进而主动控制所述叶片式减振器(805)的阻尼力的实现为,
所述控制组件(201)的下层控制***分别发送信号调节所述悬挂支撑组件(8)的比例流量阀(811)上的电磁铁驱动电流,控制比例流量阀(811)的流量阀阀门的开合大小,从而调节叶片式减振器(805)内部油液的节流特性,进而主动控制所述叶片式减振器(805)的阻尼力。
4.一种权利要求1~3中任意一种所述装置的控制方法,其特征在于:所述方法包括:
步骤1),所述装置的测距传感器(6),在所述装置行驶过程中始终处于探测状态,探测水平方向上0~360°,垂直方向上-70°~+70°范围内所述装置的路面信息,所述路面信息包括但不限定于路面凸起的高度、路面凹坑的深度及所述装置与所述路面凸起或所述路面凹坑的距离信息,形成所述装置行驶轨迹前的路面信息,将所述路面信息实时传输给所述控制组件(201)的上层控制***作为数据库进行存储,且不断更新数据库;
步骤2),所述控制组件(201)的上层控制***结合所述路面信息计算所述悬挂支撑组件(8)所需的预设姿态和叶片式减振器(805)所需的最优阻尼力,由所述控制组件(201)的下层控制***发送信号控制减振器电机(806)所需的转动方向和角度及比例流量阀(811)的流量阀阀门所需的开合大小,使得所述悬挂支撑组件(8)预先调整好所需的预设姿态,所述叶片式减振器(805)预先产生所需的最优阻尼力;
步骤3),所述装置的车载陀螺仪(203)和车速传感器(204)实时处于监测状态,所述车载陀螺仪(203)进行所述装置的侧倾角信息的探测,所述车速传感器(204)进行所述装置的速度信息的探测,并将所述装置的侧倾角信息和速度信息发送至所述控制组件(201)的上层控制***;
步骤4),所述控制组件(201)的上层控制***进一步结合所述装置的侧倾角信息和速度信息对所述悬挂支撑组件(8)的姿态和叶片式减振器(805)的最优阻尼力进行计算校正,由所述控制组件(201)的下层控制***再次发送指令调整减振器电机(806)的转动方向和角度及比例流量阀(811)的流量阀阀门的开合大小,使得所述悬挂支撑组件(8)调整姿态,所述叶片式减振器(805)调整阻尼力,进而保证所述装置保持稳定;
步骤5),继续重复步骤1~4,直至所述装置到达指定地点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010341236.7A CN111497548B (zh) | 2020-04-27 | 2020-04-27 | 一种主动减振式消防机器人底座装置及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010341236.7A CN111497548B (zh) | 2020-04-27 | 2020-04-27 | 一种主动减振式消防机器人底座装置及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111497548A CN111497548A (zh) | 2020-08-07 |
CN111497548B true CN111497548B (zh) | 2023-02-03 |
Family
ID=71874755
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010341236.7A Active CN111497548B (zh) | 2020-04-27 | 2020-04-27 | 一种主动减振式消防机器人底座装置及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111497548B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112519904A (zh) * | 2020-12-16 | 2021-03-19 | 北方工业大学 | 一种仿生可伸缩有源钩刺式履带攀附机构 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN205198758U (zh) * | 2015-11-05 | 2016-05-04 | 安徽大学 | 一种履带式消防机器人 |
CN106167056A (zh) * | 2016-08-16 | 2016-11-30 | 中国矿业大学 | 消防探测快速移动机器人平台 |
CN206679109U (zh) * | 2017-04-22 | 2017-11-28 | 中信重工开诚智能装备有限公司 | 一种履带式机器人独立悬挂减震结构 |
CN107628136A (zh) * | 2016-07-18 | 2018-01-26 | 西北农林科技大学 | 一种基于平行四杆悬架机构的履带拖拉机横向调平装置 |
CN108248711A (zh) * | 2018-02-11 | 2018-07-06 | 吉林大学 | 一种可穿戴履带式雪地行驶装置及其减振控制方法 |
CN109303994A (zh) * | 2018-09-28 | 2019-02-05 | 山东阿图机器人科技有限公司 | 一种消防侦察灭火机器人及其工作方法 |
CN109303993A (zh) * | 2018-09-07 | 2019-02-05 | 武汉科技大学 | 履带式消防机器人 |
CN110316268A (zh) * | 2019-06-21 | 2019-10-11 | 青岛澳西智能科技有限公司 | 一种消防机器人的减震行走机构 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102013011288A1 (de) * | 2013-07-08 | 2015-01-08 | Rheinmetall Landsysteme Gmbh | Adaptives Hydrop-Laufwerk für Kettenfahrzeuge |
US10035551B2 (en) * | 2015-06-19 | 2018-07-31 | Delve Equipment, LLC | Tracked vehicle suspension systems and methods |
CN106184438B (zh) * | 2016-08-16 | 2019-05-10 | 中国矿业大学 | 丝杠驱动变形的减震行走部及具有其的消防移动平台 |
CN110466633B (zh) * | 2019-08-28 | 2023-11-03 | 山东国兴智能科技股份有限公司 | 适用于恶劣环境的悬挂高度自适应特种机器人及作业方法 |
-
2020
- 2020-04-27 CN CN202010341236.7A patent/CN111497548B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN205198758U (zh) * | 2015-11-05 | 2016-05-04 | 安徽大学 | 一种履带式消防机器人 |
CN107628136A (zh) * | 2016-07-18 | 2018-01-26 | 西北农林科技大学 | 一种基于平行四杆悬架机构的履带拖拉机横向调平装置 |
CN106167056A (zh) * | 2016-08-16 | 2016-11-30 | 中国矿业大学 | 消防探测快速移动机器人平台 |
CN206679109U (zh) * | 2017-04-22 | 2017-11-28 | 中信重工开诚智能装备有限公司 | 一种履带式机器人独立悬挂减震结构 |
CN108248711A (zh) * | 2018-02-11 | 2018-07-06 | 吉林大学 | 一种可穿戴履带式雪地行驶装置及其减振控制方法 |
CN109303993A (zh) * | 2018-09-07 | 2019-02-05 | 武汉科技大学 | 履带式消防机器人 |
CN109303994A (zh) * | 2018-09-28 | 2019-02-05 | 山东阿图机器人科技有限公司 | 一种消防侦察灭火机器人及其工作方法 |
CN110316268A (zh) * | 2019-06-21 | 2019-10-11 | 青岛澳西智能科技有限公司 | 一种消防机器人的减震行走机构 |
Also Published As
Publication number | Publication date |
---|---|
CN111497548A (zh) | 2020-08-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8540040B2 (en) | Multi-purpose ground vehicle | |
CN104176145B (zh) | 一种非对称轮腿式全向移动底盘 | |
RU2652515C2 (ru) | Устройство для обеспечения поворотного движения между тандемным или гусеничным мостом и корпусом транспортного средства, а также соответствующий способ | |
US8316972B2 (en) | Reconfigurable balancing robot and method for moving over large obstacles | |
CN108454718B (zh) | 一种履带式被动自适应机器人 | |
CN104890752B (zh) | 一种行星轮式越障机器人 | |
CN111497548B (zh) | 一种主动减振式消防机器人底座装置及控制方法 | |
CN205479977U (zh) | 管道检测机器人 | |
CN107511813A (zh) | 一种越障机器人 | |
CN103608234A (zh) | 铁路车辆用减震装置 | |
KR20220102645A (ko) | 서스펜션 장치, 서스펜션 댐핑 장치 및 6륜 바이오닉 섀시 | |
US7669679B2 (en) | Wheel assembly for decelerating and/or controlling a vehicle | |
CN106629482A (zh) | 一种可翻转的多功能全方位移动平台车 | |
CN206086485U (zh) | 消防指挥综合作业车 | |
CN106627309A (zh) | 一种消防指挥综合作业车 | |
CN106628231A (zh) | 无杆飞机牵引车抱轮顶升机构 | |
CN112373594A (zh) | 一种轮腿混合驱动式矿用变胞机器人 | |
CN110282042B (zh) | 一种高性能自适应履带底盘装置及工作方法 | |
CN210258605U (zh) | 一种高性能自适应履带底盘装置 | |
CN206569285U (zh) | 无杆飞机牵引车抱轮顶升机构 | |
US11427271B2 (en) | Suspension system with damping and buffering property and track-type mobile platform | |
CN205854314U (zh) | 一种承重轮复合互压式履带底盘机构 | |
CN113518695A (zh) | 履带式消防机器人及其控制方法 | |
CN104727360A (zh) | 清障车 | |
CN103274028B (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 |