一种飞行汽车的车位泊入方法及装置与流程
本技术涉及飞行器智能控制,尤其涉及一种飞行汽车的车位泊入方法及装置。
背景技术:
1、随着低空经济的发展,飞行汽车作为新型交通工具正逐步从概念走向实际应用。现有飞行汽车通常采用垂直起降方式,其停泊过程主要依赖专用的起降坪或开阔场地,通过主升力旋翼的垂直推力实现空中悬停与定点降落。
2、由于垂直起降飞行器的旋翼展开尺寸较大,且降落过程需要上方及周边具有足够的无障碍空间,因此现有飞行汽车无法适配城市中广泛存在的标准地面停车位。标准地面停车位通常位于露天停车场或地下车库中,其空间尺寸仅能满足普通乘用车的停泊需求,且车位上方及两侧空间受限,不具备飞行汽车垂直起降所需的净空条件与安全裕度。若飞行汽车仅能在专用起降坪完成停泊,则无法在目的地直接降落至地面车位,严重制约了飞行汽车作为日常通勤工具的实用性与便捷性。
3、因此,如何使飞行汽车像普通乘用车一样自主泊入标准地面车位,是亟待解决的技术问题。
技术实现思路
1、(一)要解决的技术问题
2、鉴于现有技术的上述缺点、不足,本技术提供一种飞行汽车的车位泊入方法及装置,其解决了飞行汽车在近地环境下如何泊入常规地面车位的技术问题。
3、(二)技术方案
4、为了达到上述目的,本技术采用的主要技术方案包括:
5、第一方面,本技术实施例提供一种飞行汽车的车位泊入方法。
6、本技术实施例提出的飞行汽车的车位泊入方法,包括:响应于泊车指令,获取目标车位的车位几何与坐标数据以及周边障碍物的空间点云分布;获取当前飞行汽车的车身位置,基于所述车身位置、车位几何与坐标数据和空间点云分布,生成从车身位置至目标车位垂直范围外的空中目标位置的参考轨迹,控制飞行汽车沿所述参考轨迹移动至所述空中目标位置;在飞行汽车移动至所述空中目标位置后,获取可控性裕度指标和车身运动状态数据,基于可控性裕度指标和车身运动状态数据,控制飞行汽车降落至预设近地目标高度;在飞行汽车降落至预设近地目标高度后,控制飞行汽车沿水平推进路径移动至目标车位垂直范围内的目标泊车位置;在飞行汽车移动至目标泊车位置后,检测车身位置相对于目标泊车位置的位置偏差,当所述位置偏差小于预设阈值时,执行驻车锁止。
7、可选地,在本技术的一些实施例中,所述获取目标车位的车位几何与坐标数据,以及周边障碍物的空间点云分布,包括:通过稀疏感知算法对机载相机采集的车位图像进行语义识别,获取车位几何数据,所述车位几何数据包括车位几何中心、车位边界、车位中轴线、角点位置和语义标签;通过激光雷达扫描周边障碍物,获取障碍物点云数据;以车位几何中心为基准点,建立统一的泊入参考坐标系,将所述车位几何数据和障碍物点云数据进行空间对齐与坐标变换,得到具有语义标签的车位几何与坐标数据和周边障碍物的空间点云分布。
8、可选地,在本技术的一些实施例中,所述获取当前飞行汽车的车身位置,基于所述车身位置、车位几何与坐标数据和空间点云分布,生成从车身位置至目标车位垂直范围外的空中目标位置的参考轨迹,包括:采集飞行汽车的离地高度,基于所述车位几何与坐标数据和所述离地高度确定所述空中目标位置;根据所述语义标签对空间点云分布进行障碍物分类,根据所述车位边界以及空间点云分布构建障碍物占据空间,基于障碍物分类和障碍物占据空间,确定目标车位垂直范围外的空中可通行自由空间;以所述车身位置为轨迹起点、所述空中目标位置为轨迹终点,在所述空中可通行自由空间内进行路径搜索得到空中路径,并对所述空中路径进行曲线拟合与时间参数化,生成参考轨迹。
9、可选地,在本技术的一些实施例中,所述基于障碍物分类和障碍物占据空间,确定目标车位垂直范围外的空中可通行自由空间,包括:以所述车身位置为起始参考点、所述空中目标位置为终止参考点,沿所述起始参考点至所述终止参考点的连线方向按预设步长采样,得到由归一化的路径参数表征的空中路径点集;在所述障碍物占据空间中,根据所述障碍物分类确定空中路径点集中各空中路径点处不同类别障碍物的高度提取规则,提取所述各路径参数处的障碍物高度上界,并叠加与所述障碍物分类对应的预设安全距离裕度,得到各空中路径点处的安全通行高度;对所述各空中路径点处的安全通行高度沿所述连线方向进行连续化拟合,得到连续调度函数;所述连续调度函数表征沿所述连线方向的飞行汽车的可通行高度下界,且随路径参数的增大而单调非增;基于所述可通行高度下界、预设侧向安全距离以及所述目标车位垂直范围,确定所述空中可通行自由空间。
10、可选地,在本技术的一些实施例中,所述对所述空中路径进行曲线拟合与时间参数化,生成参考轨迹,包括:对所述空中路径中的各空中路径点,基于飞行汽车的预设最大水平速度和预设最大垂直速度进行时间分配,得到各空中路径点的期望通过时刻;采用最小加加速度优化方法,求解满足预设空中边界条件的平滑轨迹;所述预设空中边界条件包括:所述各空中路径点的期望通过时刻、所述空中路径的起始点处的预设轨迹起始边界条件,以及所述空中目标位置处的预设轨迹终止边界条件;将求解得到的平滑轨迹作为所述参考轨迹。
11、可选地,在本技术的一些实施例中,所述飞行汽车包括动力执行器;所述动力执行器包括多个旋翼和多个底盘涵道;所述基于可控性裕度指标和车身运动状态数据,控制飞行汽车降落至预设近地目标高度,包括:
12、将所述可控性裕度指标和车身运动状态数据输入预配置的动力自适应分配模型,得到动力分配控制指令;所述可控性裕度指标基于姿态角与预设悬停基准姿态的偏差、所述角速度、以及动力执行器的可用动力余量计算得到;所述可用动力余量为各旋翼或各底盘涵道的最大动力输出与当前输出之差的最小值;采集飞行汽车的离地高度,基于所述动力分配控制指令,对飞行汽车的动力执行器进行控制,直至离地高度不超过所述预设近地目标高度;所述动力分配控制指令包括各旋翼的转速目标值和各底盘涵道的推力目标值,并在各旋翼的转速目标值均为零时收起各旋翼并锁止;其中,各旋翼的转速目标值与各底盘涵道的推力目标值满足预设的垂向力平衡关系,使得在旋翼转速减小的同时底盘涵道推力相应增大。
13、可选地,在本技术的一些实施例中,所述动力自适应分配模型通过以下方式配置:以车身运动状态数据为状态量,以各旋翼的转速目标值与各底盘涵道的推力目标值为控制量,建立六自由度动力学预测模型;构建二次型代价函数,所述二次型代价函数包含用于驱动车身运动状态趋近期望值的状态偏差惩罚项、用于限制各旋翼和底盘涵道的输出幅值的控制量幅值惩罚项,以及用于抑制各旋翼和底盘涵道的输出突变的控制量变化率惩罚项;基于预设离散采样周期,将所述六自由度动力学预测模型和所述二次型代价函数离散化为标准二次规划形式,得到所述动力自适应分配模型。
14、可选地,在本技术的一些实施例中,所述方法还包括对所述动力自适应分配模型输出的动力分配控制指令,进行双通道扩张状态观测器补偿;所述双通道包括垂直通道和水平通道;所述双通道扩张状态观测器补偿包括:通过对应于垂直通道的第一扩张状态观测器,根据所述车身运动状态数据估计垂直集总扰动值,并将所述垂直集总扰动值前馈补偿为垂向力及横滚、俯仰力矩附加分量;通过对应于水平通道的第二扩张状态观测器,根据所述车身运动状态数据估计水平集总扰动值,并将所述水平集总扰动值前馈补偿为水平力及偏航力矩附加分量;将垂向力及横滚、俯仰力矩附加分量与水平力及偏航力矩附加分量映射至所述各旋翼转速目标值和各底盘涵道推力目标值并对应叠加,得到补偿后的动力分配控制指令。
15、可选地,在本技术的一些实施例中,所述在飞行汽车降落至预设近地目标高度后,控制飞行汽车沿水平推进路径移动至目标车位垂直范围内的目标泊车位置,包括:基于所述车位几何与坐标数据确定车位边界和车位中轴线;以所述车位中轴线为参考线,生成从飞行汽车的当前车身位置至目标车位垂直范围内的目标泊车位置的水平推进路径;通过差动调节各底盘涵道的推力目标值,控制飞行汽车沿所述水平推进路径移动;在控制飞行汽车沿所述水平推进路径移动的过程中,按预设时间间隔获取重新计算的可控性裕度指标,在各旋翼转速目标值为零的条件下,将重新计算的可控性裕度指标和车身运动状态数据输入所述动力自适应分配模型,得到仅通过底盘涵道动力维持车身姿态稳定的动力分配控制指令。
16、第二方面,本技术实施例提供一种飞行汽车的车位泊入装置。
17、本技术实施例提出的飞行汽车的车位泊入装置,包括:至少一个处理器;以及与所述处理器通信连接的至少一个存储器,其中,所述存储器存储有可被所述处理器执行的程序指令,所述处理器调用所述程序指令能够执行如上述任一实施例中所述的飞行汽车的车位泊入方法。
18、(三)有益效果
19、本技术的有益效果是:本技术的一种飞行汽车的车位泊入方法及装置,由于采用分阶段泊入控制策略,响应泊车指令获取车位几何、坐标及周边障碍物点云数据,生成避开障碍物的空中参考轨迹并引导飞行汽车移动至目标车位垂直范围外的空中目标位置;随后基于可控性裕度指标与车身运动状态数据控制降落至预设近地高度,再沿水平推进路径移入车位垂直范围内的目标泊车位置,并在位置偏差满足阈值时执行驻车锁止,相对于现有技术而言,其可以解决飞行汽车在近地环境下如何泊入常规地面车位,达到了提升飞行汽车停泊场景通用性、近地安全性与泊入精度的效果。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com