CN111319416A - 一种主动悬架式星球车抬轮行走控制方法及*** - Google Patents
一种主动悬架式星球车抬轮行走控制方法及*** Download PDFInfo
- Publication number
- CN111319416A CN111319416A CN202010167835.1A CN202010167835A CN111319416A CN 111319416 A CN111319416 A CN 111319416A CN 202010167835 A CN202010167835 A CN 202010167835A CN 111319416 A CN111319416 A CN 111319416A
- Authority
- CN
- China
- Prior art keywords
- wheel
- included angle
- rocker arm
- lifting
- adjusting mechanism
- 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
- 239000000725 suspension Substances 0.000 title claims abstract description 64
- 238000000034 method Methods 0.000 title claims abstract description 38
- 230000007246 mechanism Effects 0.000 claims abstract description 198
- 230000001960 triggered effect Effects 0.000 claims description 9
- 241001347978 Major minor Species 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 5
- 238000001514 detection method Methods 0.000 description 2
- 239000000203 mixture Substances 0.000 description 2
- 230000002035 prolonged effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 239000002689 soil Substances 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/16—Extraterrestrial cars
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G21/00—Interconnection systems for two or more resiliently-suspended wheels, e.g. for stabilising a vehicle body with respect to acceleration, deceleration or centrifugal forces
- B60G21/02—Interconnection systems for two or more resiliently-suspended wheels, e.g. for stabilising a vehicle body with respect to acceleration, deceleration or centrifugal forces permanently interconnected
- B60G21/04—Interconnection systems for two or more resiliently-suspended wheels, e.g. for stabilising a vehicle body with respect to acceleration, deceleration or centrifugal forces permanently interconnected mechanically
- B60G21/045—Interconnection systems for two or more resiliently-suspended wheels, e.g. for stabilising a vehicle body with respect to acceleration, deceleration or centrifugal forces permanently interconnected mechanically between wheels on different axles on the same side of the vehicle, i.e. the left or the right side
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2204/00—Indexing codes related to suspensions per se or to auxiliary parts
- B60G2204/80—Interactive suspensions; arrangement affecting more than one suspension unit
- B60G2204/81—Interactive suspensions; arrangement affecting more than one suspension unit front and rear unit
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2204/00—Indexing codes related to suspensions per se or to auxiliary parts
- B60G2204/80—Interactive suspensions; arrangement affecting more than one suspension unit
- B60G2204/83—Type of interconnection
- B60G2204/8302—Mechanical
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Vehicle Body Suspensions (AREA)
Abstract
一种主动悬架式星球车抬轮行走控制方法及***,首先,需要控制夹角调整机构运动,对星球车***质心位置进行合理调整,以保证星球车能抬起目标车轮并且抬轮后整车稳定;其次,通过离合器机构将星球车主副摇臂锁死,使主副摇臂间无法相对转动;再次,控制夹角调整机构运动,实现目标车轮抬升,而夹角调整机构的相对运动角度由车轮抬升高度决定;最后,控制星球车其余未抬起车轮驱动机构运动,则可实现星球车抬轮后的行走。
Description
技术领域
本发明涉及一种主动悬架式星球车抬轮行走控制方法及***,属于移动机器人技术领域,用于星球车在轨车轮沉陷或故障情况下进行抬轮行走的控制。
背景技术
能自主移动且搭载有效载荷的星球车是实现火星巡视探测的主要手段,火星表面存在风和尘暴,表面地形转换很快,部分沙地表面有一层硬的砂石壳,内部是软沙土,易造成星球车车轮无征兆的大量沉陷。美国的机遇号和勇气号星球车均由于发生沉陷无法脱离而导致任务失败,沉陷和脱困一直是困扰星球车的技术难点。
传统的星球车均采用被动悬架式移动***,星球车不具备构型调整和抬轮脱陷能力,中国正在开展火星探测任务研制,星球车将采用全新的主动悬架式移动***,通过悬架的主动变形,可实现车体高度调整、抬轮行走等扩展功能,有效提升星球车沉陷脱困能力和障碍通过性能,如图1所示,专利“主动悬架式星球车移动机构”(CN105235468B)中对主动悬架式移动***具体组成及总体功能进行了较详细介绍,“主动悬架式火星车主摇臂长短段张角调节机构”(CN105150789B)中对夹角调节机构组成及原理进行了介绍,但针对各功能实现的具体算法没有说明,本申请将在其基础上主要针对主动悬架式移动***抬轮行走的具体控制算法进行说明,对星球车抬轮行走控制实现至关重要,现有文献均未见有相关内容。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供了一种主动悬架式星球车抬轮行走控制方法,应用于新型主动悬架式星球车抬轮行走控制,解决星球车车轮沉陷无法脱困以及车轮故障后影响正常运动的问题。
本发明的技术解决方案是:
一种主动悬架式星球车抬轮行走控制方法,主动悬架式星球车包括六套车轮驱动机构、六套车轮转向机构、两套夹角调整机构、两套离合器机构以及组成悬架的主副摇臂,其中车轮驱动机构和转向机构实现主动悬架式星球车的行走与转向,通过夹角调整机构和离合器机构配合实现抬轮行走功能;
抬轮行走控制方法包括如下步骤:
(1)对主动悬架式星球车进行抬升前轮行走控制;
(2)对主动悬架式星球车进行抬升中轮行走控制;
(3)对主动悬架式星球车进行抬升后轮行走控制。
其中,α为主摇臂前段和主摇臂后段间夹角,H为车厢底面距地高度,h1为夹角调整机构中心轴线距车厢底面高度,R为车轮半径,h2为主副摇臂铰接点与车轮轴线竖直距离,L1为主摇臂前段长度,L2为主摇臂后段长度。
进一步的,所述对主动悬架式星球车进行抬升前轮行走控制,具体为:
步骤101,将星球车***质心调整至两中轮与地面接触点连线的后方;
根据星球车构型关系,车体离地高度增加,***质心向后方运动,星球车车体离地最大高度为Hmax,则可求取夹角调整机构对应角度αmax,控制夹角调整机构运动,目标角度αmax;
步骤102,控制离合器啮合运动,使得主副摇臂锁死;
离合器初始为啮开状态,主副摇臂间可自由转动,抬***作前,控制离合器进行啮合运动,离合器中配置有到位开关,当到位开关触发后离合器自动停止运动,主副摇臂间锁死,不能相对转动;
步骤103,控制夹角调整机构运动,使得车体高度降低,前轮抬升;
控制夹角调整机构运动,使车体距地高度降低,随着车体高度降低,前轮逐渐抬起,直至前车轮抬升到目标高度,夹角调整机构停止运动;
步骤104,控制非抬升车轮驱动机构工作,实现前轮抬升行走。
进一步的,步骤103中,夹角调整机构运动目标角度α1,根据抬轮前车体高度Hmax以及目标抬轮高度hqtai计算求取;
星球车前轮抬升高度与夹角调整机构角度间关系通过下面方程组确定:
hqtai=W11H11=AH11-O1C (1-1)
AH11=O1W3·sin∠O1W3D (1-2)
O1C=O1W11·sin∠O1W11C (1-6)
∠O1W11C=π-α1-∠O2O1B (1-7)
将式(1-3)至(1-5)代入式(1-2)中得到AH11,将式(1-7)、(1-8)代入式(1-6)中得到O1C,将式(1-2)和式(1-6)结果代入式(1-1),获得前轮抬升高度hqtai,同时,在已知W11H11和γ1时,可以反求α1;
其中,W11H11为前轮抬升高度,AH11为夹角调整机构轴线与前轮抬升前车轮轴线间竖直距离,O1C为夹角调整机构轴线与前轮抬升后车轮轴线间竖直距离,O1W3为夹角调整机构中心与后轮中心间距离,∠O1W3D为夹角调整机构中心和后轮中心连线与水平地面间夹角,O1O2为主摇臂后段长度,O2W3为副摇臂长度,γ1为主摇臂后段与副摇臂前段间夹角,为副摇臂前段与后段间夹角,∠O1W3O2为夹角调整机构中心和后轮中心连线与副摇臂后段间夹角,O1W11为主摇臂前段长度,∠O1W11C为主摇臂前段与水平地面间夹角,α1为前轮抬升后夹角调整机构前段和后段间夹角,∠O2O1B为主摇臂后段与水平地面间夹角。
进一步的,所述对主动悬架式星球车进行抬升中轮行走控制,具体为:
步骤201,调整星球车车体高度,使得车体离地高度低于预设阈值,以保证中轮抬升过程星球车不会由于高度过高产生危险;
根据星球车构型关系,抬升中轮前将星球车车体离地高度调整为Hmin,则求取夹角调整机构对应角度αmin,控制夹角调整机构运动,目标角度αmin;
步骤202,控制离合器啮合运动,使得主副摇臂锁死;
离合器初始为啮开状态,主副摇臂间可自由转动,抬***作前,控制离合器进行啮合运动,离合器中配置有到位开关,当到位开关触发后离合器自动停止运动,主副摇臂间锁死,不能相对转动;
步骤203,控制夹角调整机构运动,使得车体高度增加,中轮抬升;
控制夹角调整机构运动,使车体距地高度增加,随着车体高度增加,中轮逐渐抬起,直至车轮抬升到目标高度,夹角调整机构停止运动;夹角调整机构运动目标角度α3,可根据抬轮前车体高度Hmin以及目标抬轮高度hztai计算求取;
步骤204,控制非抬升车轮驱动机构以一定速度运动,实现前轮抬升行走。
进一步的,步骤203中,夹角调整机构运动目标角度α3,根据抬轮前车体高度Hmin以及目标抬轮高度hztai计算求取;
星球车中轮抬升高度与夹角调整机构角度间关系通过下面方程组确定:
hztai=W21H21=W1W21·sin∠W21W1H21 (2-1)
∠W1O1W21=α3-∠O2O1W21 (2-4)
∠W21W1H21=∠O1W1W3-∠O1W1W21 (2-6)
∠W1O1W3=α3-∠W3O1O2 (2-10)
将式(2-2)至(2-12)代入式(2-1),得到中轮抬升高度W21H21;同时,在已知W21H21和γ3时,可以反求α3;
其中,W21H21为中轮抬升高度,W1W21为前轮中心与中轮中心间距离,∠W21W1H21为前中轮中心连线与水平地面间夹角,O1W1为主摇臂前段长度,O1W21为夹角调整机构中心与中轮中心间距离,∠W1O1W21为主摇臂前段和夹角调整机构中心与中轮中心间连线间夹角,O1O2为主摇臂后段长度,O2W21为主副摇臂铰接点与中轮中心间距离,γ3为主摇臂后段与副摇臂前段间夹角,α3为中轮抬升后主摇臂前段与后段间夹角,∠O2O1W21为主摇臂后段和夹角调整机构中心与中轮中心间连线间夹角,O2W21为副摇臂前段长度,∠W21W1H21为前中轮中心连线与水平地面间夹角,∠O1W1W3为主摇臂前段与水平地面间夹角,∠O1W1W21为主摇臂前段和前中轮中心连线间夹角,∠W1O1W3为夹角调整机构中心和前轮中心连线与夹角调整机构中心和后轮中心连线间夹角,O1W为夹角调整机构中心和后轮中心间距离,W1W3为前后轮中心间距离,O1W3为夹角调整机构中心和后轮中心间距离,O2W3为副摇臂后段长度,为副摇臂前段与后段间夹角,∠W3O1O2为主摇臂后段和夹角调整机构中心与后轮中心连线间夹角。
进一步的,所述对主动悬架式星球车进行抬升后轮行走控制,具体为:
步骤301,将星球车***质心调整至两中轮与地面接触点连线的前方;
根据星球车构型关系,车体离地高度减小,***质心向前方运动,抬升后轮前将星球车车体离地高度调整为Hmid,则求取夹角调整机构对应角度αmid,控制夹角调整机构运动,目标角度αmid;
步骤302,控制离合器啮合运动,使得主副摇臂锁死;
离合器初始为啮开状态,主副摇臂间可自由转动,抬***作前,控制离合器进行啮合运动,离合器中配置有到位开关,当啮合开关触发后离合器自动停止运动,主副摇臂间锁死,不能相对转动;
步骤303,控制夹角调整机构运动,使得车体高度降低,后轮抬升;
控制夹角调整机构运动,使车体距地高度降低,随着车体高度降低,后轮逐渐抬起,直至后车轮抬升到目标高度,夹角调整机构停止运动;夹角调整机构运动目标角度α2,可根据抬轮前车体高度Hmid以及目标抬轮高度hhtai计算求取;
步骤304,控制非抬升车轮驱动机构以一定速度运动,实现后轮抬升行走。
进一步的,步骤303中,夹角调整机构运动目标角度α2,根据抬轮前车体高度Hmid以及目标抬轮高度hhtai计算求取;
星球车后轮抬升高度与夹角调整机构角度间关系通过下面方程组确定:
hhtai=W31H31=W2W31·sin∠W31W2H31 (3-1)
∠W31W2H31=π-∠W1W2O1-∠O1W2O2-∠O2W2W31 (3-3)
∠W1O1W2=α2-∠W2O1O2 (3-9)
将式(3-2)至(3-10)代入式(3-1),得到后轮抬升高度W31H31。同时,在已知W31H31和γ2时,可以反求α2;
其中,W31H31为后轮抬升高度,W2W31为中后轮中心间距离,∠W31W2H31为中后轮中心间连线与水平地面间夹角,O2W2为副摇臂前段长度,为副摇臂前段和后段间夹角,∠W1W2O1为夹角调整机构中心和中轮轮心连线与水平地面间夹角,∠O1W2O2为夹角调整机构中心和中轮轮心连线与副摇臂前段间夹角,∠O2W2W31为中后轮轮心连线与副摇臂前段间夹角,O1W2为夹角调整机构中心和中轮轮心间距离,O1O2为主摇臂后段长度,γ2为主摇臂后段与副摇臂前段间夹角,W1W2为前中轮轮间距离,O1W1为主摇臂前段长度,∠W1O1W2为夹角调整机构中心和中轮轮心间连线与主摇臂前段间夹角,α2为主摇臂前段和主摇臂后段间夹角,∠W2O1O2为夹角调整机构中心和中轮轮心间连线与主摇臂后段间夹角。
进一步的,本发明还提出一种星球车抬轮行走控制***,包括:
前轮控制模块:对主动悬架式星球车进行抬升前轮行走控制;
中轮控制模块:对主动悬架式星球车进行抬升中轮行走控制;
后轮控制模块:对主动悬架式星球车进行抬升后轮行走控制。
主动悬架式星球车包括六套车轮驱动机构、六套车轮转向机构、两套夹角调整机构、两套离合器机构以及组成悬架的主副摇臂,其中车轮驱动机构和转向机构实现主动悬架式星球车的行走与转向,通过夹角调整机构和离合器机构配合实现抬轮行走功能。
本发明与现有技术相比的有益效果是:
(1)本发明设计的控制方法,通过夹角调整机构和离合器机构配合可实现主动悬架式星球车抬轮行走控制功能;
(2)本发明通过抬轮控制使故障车轮抬离地面,有效增强星球车故障容错能力,提高星球车使用寿命;
(3)本发明通过抬轮控制实现火星车蠕动行走或压实路面,提升火星车松软地形下沉陷脱困与通过性能。
附图说明
图1主动悬架式星球车构型组成示意图;
图2主动悬架式星球车悬架几何参数示意图;
图3抬升前轮星球车形态示意图;
图4抬升前轮悬架几何关系示意图;
图5抬升中轮星球车形态示意图;
图6抬升中轮悬架几何关系示意图;
图7抬升后轮星球车形态示意图;
图8抬升后轮悬架几何关系示意图。
具体实施方式
下面结合附图对本发明的具体实施方式进行进一步的详细描述。
主动悬架式星球车配置有1.车轮驱动机构(6套);2.车轮转向机构(6套);3.夹角调整机构(2套);4.离合器机构(2套),以及组成悬架的主副摇臂,详见图1,其中车轮驱动机构和转向机构的功能与传统被动悬架式星球车相同,主要实现星球车的行走与转向,而抬轮行走功能则是通过夹角调整机构和离合器机构配合实现。
星球车抬轮行走控制方案如下:首先,需要控制夹角调整机构运动,对星球车***质心位置进行合理调整,以保证星球车能抬起目标车轮并且抬轮后整车稳定;其次,通过离合器机构将星球车主副摇臂锁死,使主副摇臂间无法相对转动;再次,控制夹角调整机构运动,实现目标车轮抬升,而夹角调整机构的相对运动角度由车轮抬升高度决定;最后,控制星球车其余未抬起车轮驱动机构运动,则可实现星球车抬轮后的行走。
下面分别对星球车抬升前轮行走、抬升中轮行走、抬升后轮行走的具体控制方法及原理进行说明,星球车悬架***的几何参数详见图2。
主动悬架式星球车可通过夹角调整机构进行车体离地高度调整,结合图2,根据夹角调整机构中角度测量器件位置旋变所测量角度值,可确定星球车车体高度,夹角调整机构转角α与车体离地高度H之间关系为下文中涉及车体高度调整均运用此公式计算。
其中,α为主摇臂前段和主摇臂后段间夹角,H为车厢底面距地高度,h1为夹角调整机构中心轴线距车厢底面高度,R为车轮半径,h2为主副摇臂铰接点与车轮轴线竖直距离,L1为主摇臂前段长度,L2为主摇臂后段长度。
(1)抬升前轮行走
结合图3、图4,给出根据本申请的星球车抬升前轮行走控制的一个实施示例流程100,包括以下步骤:
步骤101,将星球车***质心调整至两中轮与地面接触点连线的后方。
在本实施示例中,根据星球车构型关系,车体离地高度增加,***质心向后方运动,假设星球车车体离地最大高度为Hmax,则可根据公式(0-1)求取夹角调整机构对应角度αmax,控制夹角调整机构运动,目标角度αmax。
步骤102,控制离合器啮合运动,使得主副摇臂锁死。
离合器初始为啮开状态,主副摇臂间可自由转动,抬***作前,控制离合器进行啮合运动,离合器中配置有到位开关,当啮合开关触发后离合器自动停止运动,主副摇臂间锁死,不能相对转动。
步骤103,控制夹角调整机构运动,使得车体高度降低,前轮抬升。
控制夹角调整机构运动,使车体距地高度降低,随着车体高度降低,前轮逐渐抬起,直至车轮抬升到目标高度,夹角调整机构停止运动。夹角调整机构运动目标角度α1,可根据抬轮前车体高度Hmax以及目标抬轮高度hqtai计算求取。
参考图4定义,星球车前轮抬升高度与夹角调整机构角度间关系可通过下面方程组确定。
W11H11=AH11-O1C (1-1)
AH11=O1D=O1W3·sin∠O1W3D (1-2)
O1C=O1W11·sin∠O1W11C (1-6)
∠O1W11C=π-α1-∠O2O1B (1-7)
将式(1-3)至(1-5)代入式(1-2)中得到AH11,将式(1-7)、(1-8)代入式(1-6)中得到O1C,将式(1-2)和式(1-6)结果代入式(1-1),获得前轮抬升高度W11H11。同时,在已知W11H11和γ1时,可以反求α1。
其中,W11H11为前轮抬升高度,AH11为夹角调整机构轴线与前轮抬升前车轮轴线间竖直距离,O1C为夹角调整机构轴线与前轮抬升后车轮轴线间竖直距离,O1W3为夹角调整机构中心与后轮中心间距离,∠O1W3D为夹角调整机构中心和后轮中心连线与水平地面间夹角,O1O2为主摇臂后段长度,O2W3为副摇臂长度,γ1为主摇臂后段与副摇臂前段间夹角,为副摇臂前段与后段间夹角,∠O1W3O2为夹角调整机构中心和后轮中心连线与副摇臂后段间夹角,O1W11为主摇臂前段长度,∠O1W11C为主摇臂前段与水平地面间夹角,α1为前轮抬升后夹角调整机构前段和后段间夹角,∠O2O1B为主摇臂后段与水平地面间夹角。
步骤104,控制非抬升车轮驱动机构以一定速度运动,实现前轮抬升行走。
(2)抬升中轮行走
结合图5、图6,给出根据本申请的星球车抬升中轮行走控制的一个实施示例流程200,包括以下步骤:
步骤201,调整星球车车体高度,使得车体离地高度较低,以保证中轮抬升过程星球车不会由于高度过高产生危险。
在本实施示例中,根据星球车构型关系,假设抬升中轮前将星球车车体离地高度调整为Hmin,则可根据公式(0-1)求取夹角调整机构对应角度αmin,控制夹角调整机构运动,目标角度αmin。
步骤202,控制离合器啮合运动,使得主副摇臂锁死。
离合器初始为啮开状态,主副摇臂间可自由转动,抬***作前,控制离合器进行啮合运动,离合器中配置有到位开关,当啮合开关触发后离合器自动停止运动,主副摇臂间锁死,不能相对转动。
步骤203,控制夹角调整机构运动,使得车体高度增加,中轮抬升。
控制夹角调整机构运动,使车体距地高度增加,随着车体高度增加,中轮逐渐抬起,直至车轮抬升到目标高度,夹角调整机构停止运动。夹角调整机构运动目标角度α3,可根据抬轮前车体高度Hmin以及目标抬轮高度hztai计算求取。
参考图6定义,星球车中轮抬升高度与夹角调整机构角度间关系可通过下面方程组确定。
W21H21=W1W21·sin∠W21W1H21 (2-1)
∠W1O1W21=α3-∠O2O1W21 (2-4)
∠W21W1H21=∠O1W1W3-∠O1W1W21 (2-6)
∠W1O1W3=α3-∠W3O1O2 (2-10)
将式(2-2)至(2-12)代入式(2-1),得到中轮抬升高度W21H21。同时,在已知W21H21和γ3时,可以反求α3
其中,W21H21为中轮抬升高度,W1W21为前轮中心与中轮中心间距离,∠W21W1H21为前中轮中心连线与水平地面间夹角,O1W1为主摇臂前段长度,O1W21为夹角调整机构中心与中轮中心间距离,∠W1O1W21为主摇臂前段和夹角调整机构中心与中轮中心间连线间夹角,O1O2为主摇臂后段长度,O2W21为主副摇臂铰接点与中轮中心间距离,γ3为主摇臂后段与副摇臂前段间夹角,α3为中轮抬升后主摇臂前段与后段间夹角,∠O2O1W21为主摇臂后段和夹角调整机构中心与中轮中心间连线间夹角,O2W21为副摇臂前段长度,∠W21W1H21为前中轮中心连线与水平地面间夹角,∠O1W1W3为主摇臂前段与水平地面间夹角,∠O1W1W21为主摇臂前段和前中轮中心连线间夹角,∠W1O1W3为夹角调整机构中心和前轮中心连线与夹角调整机构中心和后轮中心连线间夹角,O1W为夹角调整机构中心和后轮中心间距离,W1W3为前后轮中心间距离,O1W3为夹角调整机构中心和后轮中心间距离,O2W3为副摇臂后段长度,为副摇臂前段与后段间夹角,∠W3O1O2为主摇臂后段和夹角调整机构中心与后轮中心连线间夹角。
步骤204,控制非抬升车轮驱动机构以一定速度运动,实现前轮抬升行走。
(3)抬升后轮行走
结合图7、图8,给出根据本申请的星球车抬升后轮行走控制的一个实施示例流程300,包括以下步骤:
步骤301,将星球车***质心调整至两中轮与地面接触点连线的前方。
在本实施示例中,根据星球车构型关系,车体离地高度减小,***质心向前方运动,假设抬升后轮前将星球车车体离地高度调整为Hmid,则可根据公式(0-1)求取夹角调整机构对应角度αmid,控制夹角调整机构运动,目标角度αmid。
步骤302,控制离合器啮合运动,使得主副摇臂锁死。
离合器初始为啮开状态,主副摇臂间可自由转动,抬***作前,控制离合器进行啮合运动,离合器中配置有到位开关,当啮合开关触发后离合器自动停止运动,主副摇臂间锁死,不能相对转动。
步骤303,控制夹角调整机构运动,使得车体高度降低,后轮抬升。
控制夹角调整机构运动,使车体距地高度降低,随着车体高度降低,后轮逐渐抬起,直至车轮抬升到目标高度,夹角调整机构停止运动。夹角调整机构运动目标角度α2,可根据抬轮前车体高度Hmid以及目标抬轮高度hhtai计算求取。
参考图8定义,星球车后轮抬升高度与夹角调整机构角度间关系可通过下面方程组确定。
W31H31=W2W31·sin∠W31W2H31 (3-1)
∠W31W2H31=π-∠W1W2O1-∠O1W2O2-∠O2W2W31 (3-3)
∠W1O1W2=α2-∠W2O1O2 (3-9)
将式(3-2)至(3-10)代入式(3-1),得到后轮抬升高度W31H31。同时,在已知W31H31和γ2时,可以反求α2。
其中,W31H31为后轮抬升高度,W2W31为中后轮中心间距离,∠W31W2H31为中后轮中心间连线与水平地面间夹角,O2W2为副摇臂前段长度,为副摇臂前段和后段间夹角,∠W1W2O1为夹角调整机构中心和中轮轮心连线与水平地面间夹角,∠O1W2O2为夹角调整机构中心和中轮轮心连线与副摇臂前段间夹角,∠O2W2W31为中后轮轮心连线与副摇臂前段间夹角,O1W2为夹角调整机构中心和中轮轮心间距离,O1O2为主摇臂后段长度,γ2为主摇臂后段与副摇臂前段间夹角,W1W2为前中轮轮间距离,O1W1为主摇臂前段长度,∠W1O1W2为夹角调整机构中心和中轮轮心间连线与主摇臂前段间夹角,α2为主摇臂前段和主摇臂后段间夹角,∠W2O1O2为夹角调整机构中心和中轮轮心间连线与主摇臂后段间夹角。
步骤304,控制非抬升车轮驱动机构以一定速度运动,实现后轮抬升行走。
本发明实现了主动悬架式星球车抬轮行走控制,解决星球车车轮沉陷无法脱困以及车轮故障后影响正常运动的问题。通过夹角调整机构和离合器机构配合可实现主动悬架式星球车抬轮行走控制功能;通过抬轮控制使故障车轮抬离地面,有效增强星球车故障容错能力,提高星球车使用寿命;通过抬轮控制实现火星车蠕动行走或压实路面,提升火星车松软地形下沉陷脱困与通过性能。
本发明说明书中未作详细描述的内容属于本领域的公知技术。
Claims (10)
1.一种主动悬架式星球车抬轮行走控制方法,其特征在于:主动悬架式星球车包括六套车轮驱动机构、六套车轮转向机构、两套夹角调整机构、两套离合器机构以及组成悬架的主副摇臂,其中车轮驱动机构和转向机构实现主动悬架式星球车的行走与转向,通过夹角调整机构和离合器机构配合实现抬轮行走功能;
抬轮行走控制方法包括如下步骤:
(1)对主动悬架式星球车进行抬升前轮行走控制;
(2)对主动悬架式星球车进行抬升中轮行走控制;
(3)对主动悬架式星球车进行抬升后轮行走控制。
3.根据权利要求2所述的一种主动悬架式星球车抬轮行走控制方法,其特征在于:所述对主动悬架式星球车进行抬升前轮行走控制,具体为:
步骤101,将星球车***质心调整至两中轮与地面接触点连线的后方;
根据星球车构型关系,车体离地高度增加,***质心向后方运动,星球车车体离地最大高度为Hmax,则可求取夹角调整机构对应角度αmax,控制夹角调整机构运动,目标角度αmax;
步骤102,控制离合器啮合运动,使得主副摇臂锁死;
离合器初始为啮开状态,主副摇臂间可自由转动,抬***作前,控制离合器进行啮合运动,离合器中配置有到位开关,当到位开关触发后离合器自动停止运动,主副摇臂间锁死,不能相对转动;
步骤103,控制夹角调整机构运动,使得车体高度降低,前轮抬升;
控制夹角调整机构运动,使车体距地高度降低,随着车体高度降低,前轮逐渐抬起,直至前车轮抬升到目标高度,夹角调整机构停止运动;
步骤104,控制非抬升车轮驱动机构工作,实现前轮抬升行走。
4.根据权利要求3所述的一种主动悬架式星球车抬轮行走控制方法,其特征在于:步骤103中,夹角调整机构运动目标角度α1,根据抬轮前车体高度Hmax以及目标抬轮高度hqtai计算求取;
星球车前轮抬升高度与夹角调整机构角度间关系通过下面方程组确定:
hqtai=W11H11=AH11-O1C (1-1)
AH11=O1W3·sin∠O1W3D (1-2)
O1C=O1W11·sin∠O1W11C (1-6)
∠O1W11C=π-α1-∠O2O1B (1-7)
将式(1-3)至(1-5)代入式(1-2)中得到AH11,将式(1-7)、(1-8)代入式(1-6)中得到O1C,将式(1-2)和式(1-6)结果代入式(1-1),获得前轮抬升高度hqtai,同时,在已知W11H11和γ1时,可以反求α1;
5.根据权利要求2所述的一种主动悬架式星球车抬轮行走控制方法,其特征在于:所述对主动悬架式星球车进行抬升中轮行走控制,具体为:
步骤201,调整星球车车体高度,使得车体离地高度低于预设阈值,以保证中轮抬升过程星球车不会由于高度过高产生危险;
根据星球车构型关系,抬升中轮前将星球车车体离地高度调整为Hmin,则求取夹角调整机构对应角度αmin,控制夹角调整机构运动,目标角度αmin;
步骤202,控制离合器啮合运动,使得主副摇臂锁死;
离合器初始为啮开状态,主副摇臂间可自由转动,抬***作前,控制离合器进行啮合运动,离合器中配置有到位开关,当到位开关触发后离合器自动停止运动,主副摇臂间锁死,不能相对转动;
步骤203,控制夹角调整机构运动,使得车体高度增加,中轮抬升;
控制夹角调整机构运动,使车体距地高度增加,随着车体高度增加,中轮逐渐抬起,直至车轮抬升到目标高度,夹角调整机构停止运动;夹角调整机构运动目标角度α3,可根据抬轮前车体高度Hmin以及目标抬轮高度hztai计算求取;
步骤204,控制非抬升车轮驱动机构以一定速度运动,实现前轮抬升行走。
6.根据权利要求5所述的一种主动悬架式星球车抬轮行走控制方法,其特征在于:步骤203中,夹角调整机构运动目标角度α3,根据抬轮前车体高度Hmin以及目标抬轮高度hztai计算求取;
星球车中轮抬升高度与夹角调整机构角度间关系通过下面方程组确定:
hztai=W21H21=W1W21·sin∠W21W1H21 (2-1)
∠W1O1W21=α3-∠O2O1W21 (2-4)
∠W21W1H21=∠O1W1W3-∠O1W1W21 (2-6)
∠W1O1W3=α3-∠W3O1O2 (2-10)
将式(2-2)至(2-12)代入式(2-1),得到中轮抬升高度W21H21;同时,在已知W21H21和γ3时,可以反求α3;
其中,W21H21为中轮抬升高度,W1W21为前轮中心与中轮中心间距离,∠W21W1H21为前中轮中心连线与水平地面间夹角,O1W1为主摇臂前段长度,O1W21为夹角调整机构中心与中轮中心间距离,∠W1O1W21为主摇臂前段和夹角调整机构中心与中轮中心间连线间夹角,O1O2为主摇臂后段长度,O2W21为主副摇臂铰接点与中轮中心间距离,γ3为主摇臂后段与副摇臂前段间夹角,α3为中轮抬升后主摇臂前段与后段间夹角,∠O2O1W21为主摇臂后段和夹角调整机构中心与中轮中心间连线间夹角,O2W21为副摇臂前段长度,∠W21W1H21为前中轮中心连线与水平地面间夹角,∠O1W1W3为主摇臂前段与水平地面间夹角,∠O1W1W21为主摇臂前段和前中轮中心连线间夹角,∠W1O1W3为夹角调整机构中心和前轮中心连线与夹角调整机构中心和后轮中心连线间夹角,O1W为夹角调整机构中心和后轮中心间距离,W1W3为前后轮中心间距离,O1W3为夹角调整机构中心和后轮中心间距离,O2W3为副摇臂后段长度,为副摇臂前段与后段间夹角,∠W3O1O2为主摇臂后段和夹角调整机构中心与后轮中心连线间夹角。
7.根据权利要求2所述的一种主动悬架式星球车抬轮行走控制方法,其特征在于:所述对主动悬架式星球车进行抬升后轮行走控制,具体为:
步骤301,将星球车***质心调整至两中轮与地面接触点连线的前方;
根据星球车构型关系,车体离地高度减小,***质心向前方运动,抬升后轮前将星球车车体离地高度调整为Hmid,则求取夹角调整机构对应角度αmid,控制夹角调整机构运动,目标角度αmid;
步骤302,控制离合器啮合运动,使得主副摇臂锁死;
离合器初始为啮开状态,主副摇臂间可自由转动,抬***作前,控制离合器进行啮合运动,离合器中配置有到位开关,当啮合开关触发后离合器自动停止运动,主副摇臂间锁死,不能相对转动;
步骤303,控制夹角调整机构运动,使得车体高度降低,后轮抬升;
控制夹角调整机构运动,使车体距地高度降低,随着车体高度降低,后轮逐渐抬起,直至后车轮抬升到目标高度,夹角调整机构停止运动;夹角调整机构运动目标角度α2,可根据抬轮前车体高度Hmid以及目标抬轮高度hhtai计算求取;
步骤304,控制非抬升车轮驱动机构以一定速度运动,实现后轮抬升行走。
8.根据权利要求7所述的一种主动悬架式星球车抬轮行走控制方法,其特征在于:步骤303中,夹角调整机构运动目标角度α2,根据抬轮前车体高度Hmid以及目标抬轮高度hhtai计算求取;
星球车后轮抬升高度与夹角调整机构角度间关系通过下面方程组确定:
hhtai=W31H31=W2W31·sin∠W31W2H31 (3-1)
∠W31W2H31=π-∠W1W2O1-∠O1W2O2-∠O2W2W31 (3-3)
∠W1O1W2=α2-∠W2O1O2 (3-9)
将式(3-2)至(3-10)代入式(3-1),得到后轮抬升高度W31H31。同时,在已知W31H31和γ2时,可以反求α2;
其中,W31H31为后轮抬升高度,W2W31为中后轮中心间距离,∠W31W2H31为中后轮中心间连线与水平地面间夹角,O2W2为副摇臂前段长度,为副摇臂前段和后段间夹角,∠W1W2O1为夹角调整机构中心和中轮轮心连线与水平地面间夹角,
∠O1W2O2为夹角调整机构中心和中轮轮心连线与副摇臂前段间夹角,∠O2W2W31为中后轮轮心连线与副摇臂前段间夹角,O1W2为夹角调整机构中心和中轮轮心间距离,O1O2为主摇臂后段长度,γ2为主摇臂后段与副摇臂前段间夹角,W1W2为前中轮轮间距离,O1W1为主摇臂前段长度,∠W1O1W2为夹角调整机构中心和中轮轮心间连线与主摇臂前段间夹角,α2为主摇臂前段和主摇臂后段间夹角,∠W2O1O2为夹角调整机构中心和中轮轮心间连线与主摇臂后段间夹角。
9.一种根据权利要求1所述的主动悬架式星球车抬轮行走控制方法实现的星球车抬轮行走控制***,其特征在于包括:
前轮控制模块:对主动悬架式星球车进行抬升前轮行走控制;
中轮控制模块:对主动悬架式星球车进行抬升中轮行走控制;
后轮控制模块:对主动悬架式星球车进行抬升后轮行走控制。
10.根据权利要求9所述的星球车抬轮行走控制***,其特征在于:主动悬架式星球车包括六套车轮驱动机构、六套车轮转向机构、两套夹角调整机构、两套离合器机构以及组成悬架的主副摇臂,其中车轮驱动机构和转向机构实现主动悬架式星球车的行走与转向,通过夹角调整机构和离合器机构配合实现抬轮行走功能;
主动悬架式星球车通过夹角调整机构进行车体离地高度调整,根据夹角调整机构中角度测量器件位置旋变所测量角度值,确定星球车车体高度,夹角调整机构转角α与车体离地高度H之间关系为
其中,α为主摇臂前段和主摇臂后段间夹角,H为车厢底面距地高度,h1为夹角调整机构中心轴线距车厢底面高度,R为车轮半径,h2为主副摇臂铰接点与车轮轴线竖直距离,L1为主摇臂前段长度,L2为主摇臂后段长度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010167835.1A CN111319416B (zh) | 2020-03-11 | 2020-03-11 | 一种主动悬架式星球车抬轮行走控制方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010167835.1A CN111319416B (zh) | 2020-03-11 | 2020-03-11 | 一种主动悬架式星球车抬轮行走控制方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111319416A true CN111319416A (zh) | 2020-06-23 |
CN111319416B CN111319416B (zh) | 2021-08-10 |
Family
ID=71164634
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010167835.1A Active CN111319416B (zh) | 2020-03-11 | 2020-03-11 | 一种主动悬架式星球车抬轮行走控制方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111319416B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113086047A (zh) * | 2021-04-06 | 2021-07-09 | 哈尔滨工业大学 | 一种多地形探测车 |
CN113086050A (zh) * | 2021-04-30 | 2021-07-09 | 深圳市普渡科技有限公司 | 悬架装置、具有该悬架装置的底盘、机器人 |
CN113460335A (zh) * | 2021-08-13 | 2021-10-01 | 吉林大学 | 一种主动悬架式星球车爬坡方法 |
CN113525717A (zh) * | 2021-07-27 | 2021-10-22 | 哈尔滨理工大学 | 一种轮腿式移动机器人蠕动的控制***及其控制方法 |
CN113602529A (zh) * | 2021-08-31 | 2021-11-05 | 吉林大学 | 一种主动悬架式星球车移动***构型优化设计方法 |
CN113776861A (zh) * | 2021-08-31 | 2021-12-10 | 吉林大学 | 一种主动悬架稳定性寿命验证装置 |
CN114004926A (zh) * | 2021-09-28 | 2022-02-01 | 哈尔滨工业大学 | 基于障碍物几何信息的星球车运动模式选择方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105015294A (zh) * | 2015-07-16 | 2015-11-04 | 北京空间飞行器总体设计部 | 一种主动悬架机构及控制方法 |
CN108357698A (zh) * | 2018-04-10 | 2018-08-03 | 上海海洋大学 | 一种新型的火星车 |
-
2020
- 2020-03-11 CN CN202010167835.1A patent/CN111319416B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105015294A (zh) * | 2015-07-16 | 2015-11-04 | 北京空间飞行器总体设计部 | 一种主动悬架机构及控制方法 |
CN108357698A (zh) * | 2018-04-10 | 2018-08-03 | 上海海洋大学 | 一种新型的火星车 |
Non-Patent Citations (2)
Title |
---|
侯绪研: "基于越障性能的六轮摇臂式月球探测车悬架尺寸优化设计", 《宇航学报》 * |
陶灼: "火星车主动悬架的几何参数优化", 《航天器工程》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113086047A (zh) * | 2021-04-06 | 2021-07-09 | 哈尔滨工业大学 | 一种多地形探测车 |
CN113086050A (zh) * | 2021-04-30 | 2021-07-09 | 深圳市普渡科技有限公司 | 悬架装置、具有该悬架装置的底盘、机器人 |
CN113525717A (zh) * | 2021-07-27 | 2021-10-22 | 哈尔滨理工大学 | 一种轮腿式移动机器人蠕动的控制***及其控制方法 |
CN113460335A (zh) * | 2021-08-13 | 2021-10-01 | 吉林大学 | 一种主动悬架式星球车爬坡方法 |
CN113602529A (zh) * | 2021-08-31 | 2021-11-05 | 吉林大学 | 一种主动悬架式星球车移动***构型优化设计方法 |
CN113776861A (zh) * | 2021-08-31 | 2021-12-10 | 吉林大学 | 一种主动悬架稳定性寿命验证装置 |
CN113602529B (zh) * | 2021-08-31 | 2023-11-10 | 吉林大学 | 一种主动悬架式星球车移动***构型优化设计方法 |
CN114004926A (zh) * | 2021-09-28 | 2022-02-01 | 哈尔滨工业大学 | 基于障碍物几何信息的星球车运动模式选择方法 |
CN114004926B (zh) * | 2021-09-28 | 2023-08-22 | 哈尔滨工业大学 | 基于障碍物几何信息的星球车运动模式选择方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111319416B (zh) | 2021-08-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111319416B (zh) | 一种主动悬架式星球车抬轮行走控制方法及*** | |
CN105292300A (zh) | 一种轮式行走机构 | |
CN107902006B (zh) | 轮腿式全地形主/被动姿态调整机器人 | |
CN111619296B (zh) | 一种轮系运动装置用悬挂***、汽车 | |
US11220175B2 (en) | Low-unsprung-mass near-wheel IPASS system | |
RU122070U1 (ru) | Транспортное средство с винтовым движителем | |
CN201161630Y (zh) | 主动摇臂式可变菱形四轮月球车移动*** | |
CN108297636B (zh) | 一种具有可摆臂伸缩式轮足结构的多轴全地形轮式车 | |
CN109911055A (zh) | 无人越障车 | |
US20170291652A1 (en) | Track system for attachment to a vehicle | |
CN100418832C (zh) | 机械增力行走*** | |
JPH08133141A (ja) | おにぎり機構を有するフレキシブルクローラ | |
CN111409866A (zh) | 轮履复合式高通过性月球车 | |
CN107472385A (zh) | 一种可快速转换形态的轮履复合式机器人 | |
CN110588812A (zh) | 履带底盘组件及机器人 | |
CN104228915A (zh) | 一种具有爬楼功能的车辆 | |
CN106739911B (zh) | 一种前轮可升降汽车底盘 | |
CN207274798U (zh) | 一种可快速转换形态的轮履复合式机器人 | |
US20230234397A1 (en) | Vehicle suspension system with active adjustment of wheel caster angle and ride height | |
CN209870097U (zh) | 电动汽车 | |
CN210083396U (zh) | 一种无人越障车 | |
CN209738803U (zh) | 一种车轮内置四轮驱动式山地攀爬运输车 | |
CN113386509B (zh) | 一种车辆主动悬架*** | |
CN212738337U (zh) | 一种农业机械的可变式履带底盘 | |
CN114408035A (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 |