CN113715570A - 陆空设备及其控制方法 - Google Patents

陆空设备及其控制方法 Download PDF

Info

Publication number
CN113715570A
CN113715570A CN202111134833.3A CN202111134833A CN113715570A CN 113715570 A CN113715570 A CN 113715570A CN 202111134833 A CN202111134833 A CN 202111134833A CN 113715570 A CN113715570 A CN 113715570A
Authority
CN
China
Prior art keywords
estimation module
rotor
central controller
module
front wheel
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
Application number
CN202111134833.3A
Other languages
English (en)
Other versions
CN113715570B (zh
Inventor
唐寿星
樊伟
徐彬
项昌乐
刘春桃
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Technology BIT
Chongqing Innovation Center of Beijing University of Technology
Original Assignee
Beijing Institute of Technology BIT
Chongqing Innovation Center of Beijing University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Technology BIT, Chongqing Innovation Center of Beijing University of Technology filed Critical Beijing Institute of Technology BIT
Priority to CN202111134833.3A priority Critical patent/CN113715570B/zh
Publication of CN113715570A publication Critical patent/CN113715570A/zh
Application granted granted Critical
Publication of CN113715570B publication Critical patent/CN113715570B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60FVEHICLES FOR USE BOTH ON RAIL AND ON ROAD; AMPHIBIOUS OR LIKE VEHICLES; CONVERTIBLE VEHICLES
    • B60F5/00Other convertible vehicles, i.e. vehicles capable of travelling in or on different media
    • B60F5/02Other convertible vehicles, i.e. vehicles capable of travelling in or on different media convertible into aircraft
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L15/00Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/20Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C19/00Aircraft control not otherwise provided for
    • B64C19/02Conjoint controls
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C27/00Rotorcraft; Rotors peculiar thereto
    • B64C27/04Helicopters
    • B64C27/12Rotor drives
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2220/00Electrical machine types; Structures or applications thereof
    • B60L2220/40Electrical machine applications
    • B60L2220/42Electrical machine applications with use of more than one motor
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2220/00Electrical machine types; Structures or applications thereof
    • B60L2220/40Electrical machine applications
    • B60L2220/46Wheel motors, i.e. motor connected to only one wheel
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
    • Y02T90/10Technologies relating to charging of electric vehicles
    • Y02T90/16Information or communication technologies improving the operation of electric vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Transportation (AREA)
  • Power Engineering (AREA)
  • Tires In General (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

本发明公开了一种陆空设备及其控制方法,涉及陆空设备及其控制方法技术领域,设备包括设备主体和控制其运行的中央控制器,设备主体包括轮胎、旋翼,中央控制器能够同时控制轮胎和旋翼运行;方法包括5个步骤。设备主体在地面行驶产生侧向失稳趋势,即产生侧滑、严重不足或过渡转向、侧翻类运行不稳定的情况时,中央控制器能够控制旋翼运行,辅助设备主体稳定,减小旋翼惯性质量在行驶模式下对设备主体产生的不利影响,增加安全性。控制方法基于设备,达到与设备相同的有益效果。

Description

陆空设备及其控制方法
技术领域
本发明涉及陆空设备及其控制方法技术领域,具体涉及一种陆空设备及其控制方法。
背景技术
陆空设备是具备垂直起降飞行能力和地面行驶能力的新型工具,例如现有的无人机、飞行汽车等。陆空设备具有陆地行驶能力和空中飞行能力,即具备行驶模式和飞行模式,前者由陆空设备内的行驶系统实现,后者由陆空设备内的飞行系统实现。陆空设备根据具体的应用场景在行驶模式和飞行模式之间切换。
现有陆空设备的陆地行驶能力和空中飞行能力是由两个不同控制器独立控制的,为了防止两个控制器互相干扰,行驶模式和飞行模式中的一个模式在运行时,另一个模式需要停止工作。
在陆空设备处于行驶模式时,飞行模式停止工作,此时用于运行飞行模式的主要部件:旋翼,成为陆空设备的额外质量负载,并且增大了陆空设备的质心高度和侧向迎风面积,严重影响陆空设备在行驶模式下的行驶横向操纵稳定性,严重影响行驶安全性。
发明内容
本发明的目的在于:针对上述存在的问题,提供一种具有协同控制行驶模式和飞行模式的中央控制器,并且该中央控制器能够在设备主体产生侧向失稳趋势时,控制旋翼以抵抗侧向失稳的操作运行的陆空设备及其控制方法。
本发明采用的技术方案如下:
一种陆空设备,包括设备主体和中央控制器,设备主体包括轮胎、旋翼,中央控制器与轮胎、旋翼均建立通信并同时控制两者运行;中央控制器能够在设备主体产生侧向失稳趋势时控制旋翼以抵抗侧向失稳的操作运行。
优选的,轮胎包括左前轮和右前轮。
优选的,左前轮和/或右前轮安装有转角传感器,转角传感器与中央控制器建立通信,转角传感器用于检测左前轮和/或右前轮的转向角,并发送至中央控制器。
优选的,陆空设备还包括与中央控制器建立通信的检测单元,检测单元用于检测设备主体的运行参数并发送至中央控制器。
优选的,中央控制器包括转向意图估计模块、稳定性估计模块、侧翻指数估计模块,该三者均与检测单元建立通信,检测单元检测到的设备主体的运行参数发送至转向意图估计模块、稳定性估计模块、侧翻指数估计模块;转向意图估计模块、稳定性估计模块均与转角传感器建立通信,转角传感器检测到的左前轮和/或右前轮的转向角发送至转向意图估计模块、稳定性估计模块。
优选的,中央控制器还包括防侧滑控制模块和防侧翻控制模块,防侧滑控制模块与转向意图估计模块、稳定性估计模块均建立通信,防侧翻控制模块与侧翻指数估计模块建立通信。
优选的,中央控制器还包括旋翼拉力分配模块,其与防侧滑控制模块、防侧翻控制模块均建立通信;旋翼拉力分配模块还与旋翼建立通信,用于控制旋翼运行。
优选的,旋翼至少为两个,旋翼拉力分配模块能够控制不同旋翼进行不同的操作。
所述陆空设备的控制方法,包括以下步骤:
S01、转角传感器检测左前轮和/或右前轮的转向角,并发送至中央控制器;检测单元检测设备主体的运行参数,并发送至中央控制器;
S02、中央控制器根据接收到的左前轮和/或右前轮的转向角、设备主体的运行参数控制旋翼运行。
优选的,步骤S01中转角传感器检测到的左前轮和/或右前轮的转向角,发送至中央控制器的转向意图估计模块和稳定性估计模块;检测单元检测到的设备主体的运行参数,发送至中央控制器的转向意图估计模块、稳定性估计模块和侧翻指数估计模块。
优选的,检测单元检测设备主体的运行参数为纵向车速u、侧向速度v、横摆角速度ω、侧向加速度ay;检测单元发送至转向意图估计模块的运行参数为纵向车速u,发送至稳定性估计模块的运行参数为纵向车速u、侧向速度v、横摆角速度ω、侧向加速度ay,发送至侧翻指数估计模块的运行参数为侧向加速度ay
优选的,步骤S02具体包括以下步骤:
步骤S021:转向意图估计模块根据接收到的参数计算得到期望横摆角速度ωd,并发送至防侧滑控制模块;与此同时,稳定性估计模块根据接收到的参数计算得到实际转向稳定性因数
Figure BDA0003281621060000031
并发送至防侧滑控制模块;与此同时,侧翻指数估计模块根据接收到的参数计算得到侧翻指数R,并发送至防侧翻控制模块;
步骤S022:防侧滑控制模块根据接收到的参数判定旋翼需求升力Fa,与此同时,防侧滑控制模块还根据接收到的参数,决策前后轮轴载荷转移量ΔWx,并将旋翼需求升力Fa和前后轮轴载荷转移量ΔWx发送至旋翼拉力分配模块;与此同时,防侧翻控制模块根据接受到的参数,决策左右轮轴载荷转移量ΔWy,并发送至旋翼拉力分配模块;
步骤S023:旋翼拉力分配模块根据接收到的参数控制旋翼运行。
综上所述,由于采用了上述技术方案,本发明的有益效果是:中央控制器同时控制轮胎和旋翼运行,将原有两个不同控制器分别控制的方式改为一个中央控制器集中控制,不存在两个控制器相互干扰的问题。除此之外,由于中央控制器能够同时控制轮胎和旋翼,设备主体在地面行驶产生侧向失稳趋势,即产生侧滑、严重不足或过渡转向、侧翻类运行不稳定的情况时,中央控制器能够控制旋翼运行,辅助设备主体稳定,减小旋翼惯性质量在行驶模式下对设备主体产生的不利影响,增加安全性。控制方法基于设备,达到与设备相同的有益效果。
附图说明
图1为陆空设备的连接结构示意图。
图2为陆空设备的结构框图。
图3为陆空设备的控制方法的流程图。
图中标记:左前轮-11、左前轮转角传感器-111、右前轮-12、右前轮转角传感器-121、左后轮-13、右后轮-14、旋翼-2、旋翼电机-21、旋翼电机控制器-22、中央控制器-3、转向意图估计模块-31、稳定性估计模块-32、防侧滑控制模块-33、旋翼拉力分配模块-34、侧翻指数估计模块-35、防侧翻控制模块-36、检测单元-4。
具体实施方式
下面结合附图,对本发明作详细的说明。
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
请参看图1至图2,一种陆空设备,包括设备主体和控制其运行的中央控制器3,设备主体包括轮胎、旋翼2,中央控制器3能够同时控制轮胎和旋翼2运行;在设备主体产生侧向失稳趋势时,中央控制器3控制旋翼2以抵抗侧向失稳的操作运行,稳定设备主体。轮胎包括四个,分别为左前轮11、右前轮12、左后轮13、右后轮14,左前轮11和右前轮12分别设置有左前轮转角传感器111、右前轮转角传感器121,用于分别检测左前轮11的转向角度δl和右前轮12的转向角度δr;旋翼2包括四个,每个旋翼2由一个旋翼电机21驱动,每个旋翼电机21由一个旋翼电机控制器22控制。
陆空设备还包括安装在设备主体质心位置的检测单元4,检测单元4为IMU惯性导航系统,其融合GPS、轮速,用于测量设备主体的纵向车速u、侧向速度v、横摆角速度ω、侧向加速度ay
中央控制器3采用两路CAN总线与其他部件建立通信,其中,第一路CAN总线电性连接左前轮转角传感器111和右前轮转角传感器121,第二路CAN总线电性连接四个旋翼电机控制器22以及检测单元4。中央控制器3通过第一路CAN总线接收左前轮转角传感器111和右前轮转角传感器121检测到的左前轮11的转向角度δl和右前轮12的转向角度δr,通过第二路CAN总线将运行信号发送至四个旋翼电机控制器22,由四个旋翼电机控制器22控制旋翼电机21运行,进而控制旋翼2运行,还通过第二路CAN总线将设备主体的状态发送至检测单元4。两路CAN总线的设计使得设备主体的陆地行驶能力和空中飞行能力能够独立运行,提高了中央控制器3的可靠性和维护性。
中央控制器3包括转向意图估计模块31、稳定性估计模块32、防侧滑控制模块33、旋翼拉力分配模块34、侧翻指数估计模块35、防侧翻控制模块36;左前轮转角传感器111、右前轮转角传感器121、检测单元4均与转向意图估计模块31、稳定性估计模块32建立通信,转向意图估计模块31、稳定性估计模块32均与防侧滑控制模块33建立通信,防侧滑控制模块33还与旋翼拉力分配模块34建立通信,检测单元4、侧翻指数估计模块35、防侧翻控制模块36、旋翼拉力分配模块34依次建立通信。
左前轮转角传感器111和右前轮转角传感器121将分别检测到的左前轮11的转向角度δl和右前轮12的转向角度δr发送至转向意图估计模块31,检测单元4将检测到的纵向车速u发送至转向意图估计模块31,转向意图估计模块31根据接收到的左前轮11的转向角度δl、右前轮12的转向角度δr和纵向车速u,通过公式一计算得到期望横摆角度ωd,并将期望横摆角度ωd发送至防侧滑控制模块33;
公式一:
Figure BDA0003281621060000061
式中,L为设备主体轴距;δ为前轮转角,通过公式二计算所得;K为固有转向稳定性因数;
公式二:
Figure BDA0003281621060000062
左前轮转角传感器111和右前轮转角传感器121将分别检测到的左前轮11的转向角度δl和右前轮12的转向角度δr发送至稳定性估计模块32,检测单元4将检测到的纵向车速u、侧向速度v、横摆角速度ω、侧向加速度ay发送至稳定性估计模块32,稳定性估计模块32根据接收到的左前轮11的转向角度δl和右前轮12的转向角度δr通过公式二计算得到前轮转角δ,通过公式三计算得到实际转向稳定性因数
Figure BDA0003281621060000071
并将实际转向稳定性因数
Figure BDA0003281621060000072
发送至防侧滑控制模块33;
公式三:
Figure BDA0003281621060000073
式中,αf为前轮轴侧偏角,通过公式四计算所得;αr为后轮轴侧偏角,通过公式五计算所得;
公式四:
Figure BDA0003281621060000074
式中,β为质心侧偏角;a为前轴到质心距离;
公式五:
Figure BDA0003281621060000075
式中,b为后轴到质心距离。
防侧滑控制模块33根据接收到的期望横摆角度ωd,计算需求垂向载荷,进而通过公式六判定得到旋翼2需求升力Fa;根据接收到的实际转向稳定性因数
Figure BDA0003281621060000076
判断设备主体稳定性状态,通过公式七决策前后轮轴载荷转移量ΔWx;将需求升力Fa和前后轮轴载荷转移量ΔWx发送至旋翼拉力分配模块34;
公式六:
Figure BDA0003281621060000077
式中,m为整机质量;g为重力加速度;cz为轮轴载荷储备系数cz≥1;μ为地面附着系数;
公式七:
Figure BDA0003281621060000081
式中,ckf为载荷向前轴转移增益,ckr为载荷向后轴转移增益。
检测单元4将检测到的侧向加速度ay发送至侧翻指数估计模块35,侧翻指数估计模块35根据接收到的侧向加速度ay,通过公式八计算得到侧翻指数R,并将侧翻指数R发送至防侧翻控制模块36;
公式八:
Figure BDA0003281621060000082
式中,hR为质心距侧倾中心高度;lw为左右车轮轮距;g为重力加速度。
防侧翻控制模块36根据接收到的侧翻指数R与内部预存的侧翻指数临界值R0比较,通过公式九决策左右轮轴载荷转移量ΔWy,并将左右轮轴载荷转移量ΔWy发送至旋翼拉力分配模块34;
公式九:
Figure BDA0003281621060000083
旋翼拉力分配模块34根据接收到需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa,通过公式十的分配方法将需求前后轮轴载荷转移量ΔWx进行分配,通过公式十一的分配方法将需求左右轮轴载荷转移量ΔWy进行分配,通过公式十二的分配方法将需求总升力Fa进行分配;
再将分配好的需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa通过分配方法分配至四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr,分别转换四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr为四个需求转速ωflfrrlrr,并将四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr或四个需求转速ωflfrrlrr分别发送至四个旋翼电机控制器22;
所述分配方法有基于优化的分配方法和基于规则的分配方法;若使用基于优化的分配方法,则通过公式十三将分配好的需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa分配至四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr;若使用基于规则的分配方法,则通过公式十四将分配好的需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa分配至四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr
公式十:
ΔWf_x=-max(0,ΔWx)
ΔWr_x=min(0,ΔWx)
公式十一:
ΔWl_y=min(0,ΔWy)
ΔWr_y=-max(0,ΔWy)
公式十二:
ΔWz=min(Fa,-|ΔWx|,-|ΔWy|)
公式十三:
Figure BDA0003281621060000101
公式十四:
当|ΔWx|≥|ΔWy|时,以前后轴载荷转移为主:
Figure BDA0003281621060000102
Figure BDA0003281621060000103
Figure BDA0003281621060000104
Figure BDA0003281621060000105
当|ΔWx|<|ΔWy|时,以左右载荷转移为主:
Figure BDA0003281621060000106
Figure BDA0003281621060000107
Figure BDA0003281621060000108
Figure BDA0003281621060000109
当ΔWz≤Fa时,四旋翼2需求升力只满足载荷转移需求:
ΔWfl=ΔWfl_xy
ΔWfr=ΔWfr_xy
ΔWrl=ΔWrl_xy
ΔWrr=ΔWrr_xy
当ΔWz>Fa时,四旋翼2需求升力需要满足需求总升力:
Figure BDA0003281621060000111
Figure BDA0003281621060000112
Figure BDA0003281621060000113
Figure BDA0003281621060000114
旋翼2需求升力ΔWij与转速ωij对应关系为公式十五所示,也可以采用查表插值获得;
公式十五:
Figure BDA0003281621060000115
式中,CT为拉力系数,旋翼2反转时为负值;ρ为飞行环境空气密度;D为旋翼2直径。
中央控制器3通过CAN总线获取左前轮11转向角度δl和右前轮12转向角度δr、检测单元4测量的设备主体状态,解析设备主体的转向意图,评估设备主体的侧向稳定性和侧翻指数,经过一系列计算与分配得到四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr,通过CAN总线分别发送给对应的旋翼电机控制器22。
本陆空设备利用旋翼2反转产生的反向拉力,增加轮胎垂向载荷,提高车轮侧偏刚度,进而改善车辆行驶操控稳定性,即实现了行驶模式下旋翼2的协同控制方法,利用旋翼2负升力辅助增稳控制设备主体,提高了设备主体的操纵稳定性,并实现了在行驶模式下的防侧滑、防侧翻增稳控制,有效提升设备主体的行驶安全性。
本陆空设备能够广泛应用于所有陆空两栖类设备,比如多旋翼2飞行汽车、涵道式飞行汽车、多旋翼2飞行器、无人机、陆空两栖侦查机器人。
请参看图3,所述陆空设备的控制方法,该陆空设备包括设备主体,其包括轮胎和旋翼2,轮胎包括四个,分别为左前轮11、右前轮12、左后轮13、右后轮14;旋翼2包括四个,分别靠近四个轮胎设置,每个旋翼2由一个旋翼电机21驱动,每个旋翼电机21由一个旋翼电机控制器22控制。
陆空设备的控制方法包括以下步骤:
S01:左前轮转角传感器111和右前轮转角传感器121将分别检测到的左前轮11的转向角度δl和右前轮12的转向角度δr发送至转向意图估计模块31和稳定性估计模块32;检测单元4将检测到的纵向车速u发送至转向意图估计模块31,将检测到的纵向车速u、侧向速度v、横摆角速度ω、侧向加速度ay发送至稳定性估计模块32,将检测到的侧向加速度ay发送至侧翻指数估计模块35;
S021:转向意图估计模块31根据接收到的左前轮11的转向角度δl、右前轮12的转向角度δr和纵向车速u,通过公式(2.1)计算得到期望横摆角度ωd,并将期望横摆角度ωd发送至防侧滑控制模块33;
公式(2.1):
Figure BDA0003281621060000121
式中,L为设备主体轴距;δ为前轮转角,通过公式(2.2)计算所得;K为固有转向稳定性因数;
公式(2.2):
Figure BDA0003281621060000131
S022:稳定性估计模块32根据接收到的左前轮11的转向角度δl和右前轮12的转向角度δr通过公式(2.2)计算得到前轮转角δ,通过公式(2.3)计算得到实际转向稳定性因数
Figure BDA0003281621060000132
并将实际转向稳定性因数
Figure BDA0003281621060000133
发送至防侧滑控制模块33;公式(2.3):
Figure BDA0003281621060000134
式中,αf为前轮轴侧偏角,通过公式(2.4)计算所得;αr为后轮轴侧偏角,通过公式(2.5)计算所得;
公式(2.4):
Figure BDA0003281621060000135
式中,β为质心侧偏角;a为前轴到质心距离;
公式(2.5):
Figure BDA0003281621060000136
式中,b为后轴到质心距离。
S023:侧翻指数估计模块35根据接收到的侧向加速度ay,通过公式(2.6)计算得到侧翻指数R,并将侧翻指数R发送至防侧翻控制模块36;
公式(2.6):
Figure BDA0003281621060000137
式中,hR为质心距侧倾中心高度;lw为左右车轮轮距;g为重力加速度。
S031:防侧滑控制模块33根据接收到的期望横摆角度ωd,计算需求垂向载荷,进而通过公式(3.1)判定得到旋翼2需求升力Fa;根据接收到的实际转向稳定性因数
Figure BDA0003281621060000144
判断设备主体稳定性状态,通过公式(3.2)决策前后轮轴载荷转移量ΔWx;将需求升力Fa和前后轮轴载荷转移量ΔWx发送至旋翼拉力分配模块34;前后轮轴中的前轮轴为左前轮和右前轮的轮轴,后轮轴为左后轮和右后轮的轮轴;
公式(3.1):
Figure BDA0003281621060000141
式中,m为整机质量;g为重力加速度;cz为轮轴载荷储备系数cz≥1;μ为地面附着系数;
公式(3.2):
Figure BDA0003281621060000142
式中,ckf为载荷向前轴转移增益,ckr为载荷向后轴转移增益。
S032:防侧翻控制模块36根据接收到的侧翻指数R与内部预存的侧翻指数临界值R0比较,通过公式(3.3)决策左右轮轴载荷转移量ΔWy,并将左右轮轴载荷转移量ΔWy发送至旋翼拉力分配模块34;
公式(3.3):
Figure BDA0003281621060000143
S04:旋翼拉力分配模块34根据接收到需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa,通过公式(4.1)的分配方法将需求前后轮轴载荷转移量ΔWx进行分配,通过公式(4.2)的分配方法将需求左右轮轴载荷转移量ΔWy进行分配,通过公式(4.3)的分配方法将需求总升力Fa进行分配;
公式(4.1):
ΔWf_x=-max(0,ΔWx)
ΔWr_x=min(0,ΔWx)
公式(4.2):
ΔWl_y=min(0,ΔWy)
ΔWr_y=-max(0,ΔWy)
公式(4.3):
ΔWz=min(Fa,-|ΔWx|,-|ΔWy|)
旋翼拉力分配模块34再将分配好的需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa通过分配方法分配至四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr,分别转换四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr为四个需求转速ωflfrrlrr,并将四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr或四个需求转速ωflfrrlrr分别发送至四个旋翼电机控制器22;
所述分配方法有基于优化的分配方法和基于规则的分配方法;若使用基于优化的分配方法,则进行步骤S041;若使用基于规则的分配方法,则进行步骤S042;
S041:通过公式(4.4)将分配好的需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa分配至四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr
公式(4.4):
Figure BDA0003281621060000161
S042:若使用基于规则的分配方法,则判断需求前后轮轴载荷转移量ΔWx和需求左右轮轴载荷转移量ΔWy的大小关系,以及ΔWz和旋翼2需求升力Fa的大小关系;
当|ΔWx|≥|ΔWy|时,以前后轴载荷转移为主,通过公式(4.5)将分配好的需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa分配至四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr;当|ΔWx|<|ΔWy|时,以左右载荷转移为主,通过公式(4.6)将分配好的需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa分配至四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr;当ΔWz≤Fa时,四个旋翼2需求升力只满足载荷转移需求,通过公式(4.7)将分配好的需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa分配至四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr;当ΔWz>Fa时,四个旋翼2需求升力需要满足需求总升力,通过公式(4.8)将分配好的需求前后轮轴载荷转移量ΔWx、需求左右轮轴载荷转移量ΔWy、旋翼2需求升力Fa分配至四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr
公式(4.5):
Figure BDA0003281621060000171
Figure BDA0003281621060000172
Figure BDA0003281621060000173
Figure BDA0003281621060000174
公式(4.6):
Figure BDA0003281621060000175
Figure BDA0003281621060000176
Figure BDA0003281621060000177
Figure BDA0003281621060000178
公式(4.7):
ΔWfl=ΔWfl_xy
ΔWfr=ΔWfr_xy
ΔWrl=ΔWrl_xy
ΔWrr=ΔWrr_xy
公式(4.8):
Figure BDA0003281621060000179
Figure BDA00032816210600001710
Figure BDA0003281621060000181
Figure BDA0003281621060000182
步骤S04中旋翼2需求升力ΔWij与转速ωij对应关系为公式(4.9)所示,也可以采用查表插值获得;
公式(4.9):
Figure BDA0003281621060000183
式中,CT为拉力系数,旋翼2反转时为负值;ρ为飞行环境空气密度;D为旋翼2直径。
S05:四个旋翼电机控制器22根据接收到的四个旋翼2需求升力ΔWfl,ΔWfr,ΔWrl,ΔWrr或四个需求转速ωflfrrlrr,分别控制四个旋翼电机21运行,四个旋翼电机21分别控制四个旋翼2运行。
陆空设备的控制方法中:步骤S021、步骤S022、步骤S023为能够同时进行的步骤;步骤S031、步骤S032为能够同时进行的步骤;步骤S041、步骤S042根据实际需求选择其中一个步骤进行。
本文中应用了具体的实施例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以对本发明进行若干改进和修饰,这些改进和修饰也落入本发明权利要求的保护范围内。

Claims (12)

1.一种陆空设备,其特征在于,包括设备主体和中央控制器,设备主体包括轮胎、旋翼,中央控制器与轮胎、旋翼均建立通信并同时控制两者运行;中央控制器能够在设备主体产生侧向失稳趋势时控制旋翼以抵抗侧向失稳的操作运行。
2.如权利要求1所述的陆空设备,其特征在于,所述轮胎包括左前轮和右前轮。
3.如权利要求2所述的陆空设备,其特征在于,所述左前轮和/或右前轮安装有转角传感器,转角传感器与中央控制器建立通信,转角传感器用于检测左前轮和/或右前轮的转向角,并发送至中央控制器。
4.如权利要求3所述的陆空设备,其特征在于,还包括与中央控制器建立通信的检测单元,检测单元用于检测设备主体的运行参数并发送至中央控制器。
5.如权利要求4所述的陆空设备,其特征在于,所述中央控制器包括转向意图估计模块、稳定性估计模块、侧翻指数估计模块,该三者均与检测单元建立通信,检测单元检测到的设备主体的运行参数发送至转向意图估计模块、稳定性估计模块、侧翻指数估计模块;转向意图估计模块、稳定性估计模块均与转角传感器建立通信,转角传感器检测到的左前轮和/或右前轮的转向角发送至转向意图估计模块、稳定性估计模块。
6.如权利要求5所述的陆空设备,其特征在于,所述中央控制器还包括防侧滑控制模块和防侧翻控制模块,防侧滑控制模块与转向意图估计模块、稳定性估计模块均建立通信,防侧翻控制模块与侧翻指数估计模块建立通信。
7.如权利要求6所述的陆空设备,其特征在于,所述中央控制器还包括旋翼拉力分配模块,其与防侧滑控制模块、防侧翻控制模块均建立通信;旋翼拉力分配模块还与旋翼建立通信,用于控制旋翼运行。
8.如权利要求7所述的陆空设备,其特征在于,所述旋翼至少为四个,旋翼拉力分配模块能够控制不同旋翼进行不同的操作。
9.如权利要求1~8任一所述的陆空设备的控制方法,其特征在于,包括以下步骤:
S01、转角传感器检测左前轮和/或右前轮的转向角,并发送至中央控制器;检测单元检测设备主体的运行参数,并发送至中央控制器;
S02、中央控制器根据接收到的左前轮和/或右前轮的转向角、设备主体的运行参数控制旋翼运行。
10.如权利要求9所述的陆空设备的控制方法,其特征在于,所述步骤S01中转角传感器检测到的左前轮和/或右前轮的转向角,发送至中央控制器的转向意图估计模块和稳定性估计模块;检测单元检测到的设备主体的运行参数,发送至中央控制器的转向意图估计模块、稳定性估计模块和侧翻指数估计模块。
11.如权利要求10所述的陆空设备的控制方法,其特征在于,所述检测单元检测设备主体的运行参数为纵向车速u、侧向速度v、横摆角速度ω、侧向加速度ay;检测单元发送至转向意图估计模块的运行参数为纵向车速u,发送至稳定性估计模块的运行参数为纵向车速u、侧向速度v、横摆角速度ω、侧向加速度ay,发送至侧翻指数估计模块的运行参数为侧向加速度ay
12.如权利要求11所述的陆空设备的控制方法,其特征在于,所述步骤S02具体包括以下步骤:
步骤S021:转向意图估计模块根据接收到的参数计算得到期望横摆角速度ωd,并发送至防侧滑控制模块;与此同时,稳定性估计模块根据接收到的参数计算得到实际转向稳定性因数
Figure FDA0003281621050000021
并发送至防侧滑控制模块;与此同时,侧翻指数估计模块根据接收到的参数计算得到侧翻指数R,并发送至防侧翻控制模块;
步骤S022:防侧滑控制模块根据接收到的参数判定旋翼需求升力Fa,与此同时,防侧滑控制模块还根据接收到的参数,决策前后轮轴载荷转移量ΔWx,并将旋翼需求升力Fa和前后轮轴载荷转移量ΔWx发送至旋翼拉力分配模块;与此同时,防侧翻控制模块根据接受到的参数,决策左右轮轴载荷转移量ΔWy,并发送至旋翼拉力分配模块;
步骤S023:旋翼拉力分配模块根据接收到的参数控制旋翼运行。
CN202111134833.3A 2021-09-27 2021-09-27 陆空设备及其控制方法 Active CN113715570B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111134833.3A CN113715570B (zh) 2021-09-27 2021-09-27 陆空设备及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111134833.3A CN113715570B (zh) 2021-09-27 2021-09-27 陆空设备及其控制方法

Publications (2)

Publication Number Publication Date
CN113715570A true CN113715570A (zh) 2021-11-30
CN113715570B CN113715570B (zh) 2023-05-16

Family

ID=78685057

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111134833.3A Active CN113715570B (zh) 2021-09-27 2021-09-27 陆空设备及其控制方法

Country Status (1)

Country Link
CN (1) CN113715570B (zh)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5746390A (en) * 1996-03-20 1998-05-05 Fran Rich Chi Associates, Inc. Air-land vehicle with ducted fan vanes providing improved performance
CN103600632A (zh) * 2013-11-25 2014-02-26 中国南方航空工业(集团)有限公司 飞行汽车
CN104097701A (zh) * 2014-07-30 2014-10-15 福州大学 主动空气动力辅助控制的车辆稳定性控制方法及系统
CN204020983U (zh) * 2014-08-19 2014-12-17 北京福田戴姆勒汽车有限公司 一种带有辅助转向翼的车辆
CN104924866A (zh) * 2015-07-14 2015-09-23 合肥多加农业科技有限公司 一种遥控式两轮飞车
JPWO2016163482A1 (ja) * 2015-04-07 2018-02-08 株式会社Soken 移動体
CN108248601A (zh) * 2018-01-10 2018-07-06 大连理工大学 一种基于四轮独立驱动电动车的转向稳定性控制系统及方法
CN110329022A (zh) * 2019-07-26 2019-10-15 北京理工大学 一种飞行器及陆空两栖车
CN111546843A (zh) * 2020-05-19 2020-08-18 覃立伟 一种陆空两用交通工具

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5746390A (en) * 1996-03-20 1998-05-05 Fran Rich Chi Associates, Inc. Air-land vehicle with ducted fan vanes providing improved performance
CN103600632A (zh) * 2013-11-25 2014-02-26 中国南方航空工业(集团)有限公司 飞行汽车
CN104097701A (zh) * 2014-07-30 2014-10-15 福州大学 主动空气动力辅助控制的车辆稳定性控制方法及系统
CN204020983U (zh) * 2014-08-19 2014-12-17 北京福田戴姆勒汽车有限公司 一种带有辅助转向翼的车辆
JPWO2016163482A1 (ja) * 2015-04-07 2018-02-08 株式会社Soken 移動体
CN104924866A (zh) * 2015-07-14 2015-09-23 合肥多加农业科技有限公司 一种遥控式两轮飞车
CN108248601A (zh) * 2018-01-10 2018-07-06 大连理工大学 一种基于四轮独立驱动电动车的转向稳定性控制系统及方法
CN110329022A (zh) * 2019-07-26 2019-10-15 北京理工大学 一种飞行器及陆空两栖车
CN111546843A (zh) * 2020-05-19 2020-08-18 覃立伟 一种陆空两用交通工具

Also Published As

Publication number Publication date
CN113715570B (zh) 2023-05-16

Similar Documents

Publication Publication Date Title
CN107953801B (zh) 一种全轮毂电机驱动车辆的驱动力控制方法
CN106467111B (zh) 车身稳定控制方法、系统及汽车
WO2021027286A1 (zh) 一种控制车辆稳定性的方法及设备
CN106183892B (zh) 电动轮驱动汽车的试验样车及驱动稳定性控制方法
CN110023166B (zh) 车辆运动状态推断装置
EP1479581B1 (en) An integrated sensing system for an automotive system
CN108248454B (zh) 车身稳定控制系统、方法及汽车
CN109159817B (zh) 四驱电动汽车的转向控制器、系统、转向与运行控制方法
CN105501078A (zh) 一种四轮独立驱动电动汽车协同控制方法
CN109263483A (zh) 考虑车身侧倾的分布式驱动电动汽车防滑控制系统及方法
WO2012023162A1 (en) A vehicle
CN111152661A (zh) 一种四轮分布式驱动客车电驱动系统失效控制方法
CN112744227B (zh) 一种多模态陆空两栖车辆起降控制方法及控制装置、计算机存储介质
CN111731267B (zh) 一种装备非充气弹性车轮的分布式电动汽车稳定性控制系统及方法
CN104417603B (zh) 转向控制设备和方法
KR102644549B1 (ko) 차량의 통합 제어 장치
CN108569288B (zh) 一种汽车危险工况的界定与避撞控制方法
CN113665304B (zh) 陆空双模式设备及其控制方法
CN113715570A (zh) 陆空设备及其控制方法
CN113401114B (zh) 一种半挂汽车横摆稳定性控制方法
JP3039071B2 (ja) 車両旋回限界判定装置
KR20220086734A (ko) 최대 노면 마찰계수 추정방법
EP1745953A1 (en) A vehicle dynamic control system and method
CN110758378B (zh) 一种无人驾驶汽车抗侧风控制方法
Jing et al. Effect of the tire lateral force saturation on stability control of 4WDEV steering

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