本发明专利技术提供了一种旅客登机车自动路径规划及车辆控制方法及装置，属于领域属于车辆运行路径规划和控制技术领域。在全局路径规划中，通过改进后的评价函数将节点夹角信息和目标点距离信息综合融入到评价函数中，在算法搜索时具有方向性和明确的目的，避免了不必要的节点搜索，遍历点减少，达径搜索时间减少，提高了算法的效率；同时在全局最优路径规划的基础上，在行驶中实时感知障碍物对局部路径实时调整生成平滑路径，实现车辆控制的最优局部路径规划，针对机场复杂场景中控制方法在保证精度的同时也能保证速度。的同时也能保证速度。的同时也能保证速度。
【技术实现步骤摘要】
一种旅客登机车自动路径规划及车辆控制方法及装置
[0001]本专利技术属于车辆运行路径规划和控制
，具体涉及一种旅客登机车自动路径规划及车辆控制方法及装置。
技术介绍
[0002]智慧机场是未来机场运行管理的发展目标，智慧化就是“AI+自动控制”，人工操作应逐渐退出机场的运行，人不再直接参与运行，人的作用就是监控系统的工作，并在系统发生故障的时候进行干预，恢复系统的正常运行。
[0003]传统的登机模式是飞机都滑行到候机楼，这种模式不利于实现机场的自动化运行，可以改变登机模式，便于实现登机自动化，为此需要引入特种设备。一种是移动登机桥，移动登机桥是一种新型的特种设备，其功能可以看成是廊桥和登机梯的结合物。移动登机桥是全封闭的，内置自动扶梯，其功能类似固定登机桥，对接飞机舱门一端可以上下自由升降以适合不同类型的飞机；移动登机桥的另一端对接摆渡车。移动登机桥还可以前后、左右移动，可以实现与飞机舱门自动对接。另一种是旅客登机车，其可以同时实现摆渡、载物和登机梯功能，旅客登机车同样有自动升降功能，以适用不同的机型，相对前一种登机更加灵活、效率更高。
[0004]目前智慧机场的发展目标，由于机场需要更为安全和可靠的运行路径和车辆控制，机场情况更为复杂多变，在车辆实际行驶的过程中会出现各种复杂的情况，例如车道边缘出现障碍物需进行规避的情况，但是现有的路径规划方式难以灵活匹配这种路边避障的情况。亟需一种适应机场环境的旅客登机车高精度自动路径规划及车辆控制方法，实现旅客登机车从起始点到目标客机终点安全准确的路径规划以及车辆控制方法。
技术实现思路
[0005]本专利技术的目的在于解决上述现有技术中存在的难题，提供一种旅客登机车自动路径规划及车辆控制方法。
[0006]本专利技术的旅客登机车自动路径规划及车辆控制方法具体包含如下步骤：
[0007]步骤1，接收旅客登机车当前停泊点A以及登机目标点B在机场静态二维构型空间中的坐标信息；
[0008]步骤2，生成由当前停泊点A至登机目标点B的最优全局路径规划；
[0009]具体基于机场的静态二维构型空间中计算全局最优路径中，依据成本评价函数进行搜索，将搜索到满足成本评价函数的点作为下一次要搜索的点，并重复此过程，直到找到登机目标点，形成最优路径，其成本评价函数如下:
[0010]f(n)＝h
update
(n)+g(n)
[0011]其中，f(n)为当前节点n的成本评价函数,g(n)为旅客登机车从初始位置到当前节点n的实际成本，h
update
(n)为旅客登机车从当前节点n到目标点的启发函数。
[0012]为了减少扩大搜索的范围节点的低效计算，提升全局寻优的搜索速度，同时考虑
上一节点的影响以及节点夹角信息的影响，本申请提出改进后的启发函数如下：
[0013][0014]上式中l
nt
是当前节点n与登机目标点B之间的距离长度，l
st
是起始点与登机目标点B之间的距离长度，k为n的上一节点，h(n)是当前节点的启发函数，h(k)是当前节点n的上一节点的启发函数。节点方向夹角θ为起始点到当前节点n的向量与当前节点n指向登机目标点B的向量之间的夹角，夹角取值范围为[0
°
,120
°
]。
[0015]进一步，如果两个节点之间的f(n)的估计值相同，则估计值节点与目标点的距离越大，说明该节点与起始点、目标点之间的夹角越大，反之亦然,m为权重值,本申请中m取值为0
‑
1的数值。
[0016]进一步，根据车辆起始点和目标点的位置，根据上述算法生成的路线最优全局路径规划，车辆沿着道路中心线行驶，根据车辆速度和道路限速要求产生在不同路径节点位置上的控制参数,生成旅客登机车的运动轨迹。
[0017]步骤3，基于最优全局路径规划控制旅客登机车按照最优全局路径规划行驶，并在行驶中实时感知障碍物对局部路径实时调整生成平滑路径；
[0018]步骤3.1，由机场实时监控系统采集得到当前行驶的局部路径上是否存在障碍物，包括行人、其他车辆、路障、禁入指示区域，当存在上述障碍物时，根据检测算法得到对应障碍物在图像中边缘点位置坐标；将障碍物在图像中边缘点位置坐标射至机场的静态二维构型空间中；障碍物在静态二维构型空间中的位置坐标(x
z
,y
z
)，其中z∈(1，M)，M为边缘点的个数；
[0019]步骤3.2，路径规划的节点i为全局路径规划中除目标点的任一节点，扩展得到的随机采样点为r，然后遍历所有已存在的节点并计算得到离r最近的现有节点n，以给定的步长t从节点n向r扩展，如果在扩展路径上没有阻碍物，则将新生成的扩展节点r加入到扩展随机树中，若发生碰撞则舍弃扩展节点r；
[0020]具体由于旅客登机车作自身性能以及安全要求，转弯角度幅度小于预设的角度θ，结合障碍物在静态二维构型空间中的位置坐标(x
z
,y
z
)，其中z∈(1，M)，本申请中M取值为8；
[0021]本申请依据如下方式取舍规则确定扩展节点r是否舍弃，具体计算步骤如下：
[0022]步骤3.2.1，计算扩展节点r与障碍物在静态二维构型空间中的位置坐标(x
z
,y
z
)距离度量Dm；
[0023]步骤3.2.2，计算扩展节点r与障碍物位置坐标(x
z
,y
z
)距离最近的前4个点，并取前4个最近距离均值得到距离度量Dm
’
；
[0024]步骤3.2.3，判断距离度量Dm
’
是否小于5t,若小于则进入步骤3.2.4；否则保留该扩展节点；
[0025]步骤3.2.4，确定扩展节点r下一扩展节点r1形成的向量方向，并判断该向量方向是否落入扩展节点r与障碍物在静态二维构型空间中的位置坐标(x
z
,y
z
)形成的最大角度范围内，若r、r1两点形成的向量方向落入上述范围内，则舍弃该扩展节点，否则保留该扩展节点。
[0026]步骤3.2.5，重新在当前树节点上随机选取新的扩展方向，反复循环直到找到目标点g，依据保留的扩展节点输出局部路径，依据预设的转弯角度幅度约束生成平滑路径；
[0027]除此之外，本申请还提供了一种旅客登机车自动路径规划及车辆控制方法对应的
计算机装置以及可读存储介质，其中计算机装置包括处理器和存储器，所述存储器存储有能够被所述处理器执行的计算机可执行指令，所述处理器执行所述计算机可执行指令以实现上述旅客登机车自动路径规划及车辆控制方法。所述计算机可执行指令在被处理器调用和执行时，计算机可执行指令促使处理器实现上述车辆控制方法。
[0028]与现有技术相比，本专利技术的有益效果是：(一)通过改进后的评价函数将节点夹角信息和目标点距离信息综合融入到评本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种旅客登机车自动路径规划及车辆控制方法，其特征在于包含如下步骤：步骤1，接收旅客登机车当前停泊点A以及登机目标点B在机场静态二维构型空间中的坐标信息；步骤2，生成由当前停泊点A至登机目标点B的最优全局路径规划；具体依据成本评价函数进行搜索，形成最优路径，其成本评价函数如下:f(n)＝h
update
(n)+g(n)，其中，f(n)为当前节点n的成本评价函数,g(n)为旅客登机车从初始位置到当前节点n的实际成本，h
update
(n)为旅客登机车从当前节点n到目标点的启发函数；其中启发函数通过如下公式计算：其中，l
nt
是当前节点n与登机目标点B之间的距离长度，l
st
是起始点与登机目标点B之间的距离长度，k为n的上一节点，h(n)是当前节点的启发函数，h(k)是当前节点n的上一节点的启发函数,m为权重值，θ为节点方向夹角，节点方向夹角为起始点到当前节点n的向量与当前节点n指向登机目标点B的向量之间的夹角；步骤3，基于最优全局路径规划控制旅客登机车按照最优全局路径规划行驶，并在行驶中实时感知障碍物对局部路径实时调整生成平滑路径。2.根据权利要求1所述的旅客登机车自动路径规划及车辆控制方法，其特征在于步骤3包含如下步骤：步骤3.1，由机场实时监控系统采集得到当前行驶的局部路径上是否存在障碍物，当存在上述障碍物时，根据检测算法得到对应障碍物在图像中边缘点位置坐标；将障碍物在图像中边缘点位置坐标射至机场的静态二维构型空间中；障碍物在静态二维构型空间中的位置坐标(x
z
,y
z
)，其中z∈(1，M)，M为边缘点的个数；步骤3.2，路径规划的节点i为全局路径规划中除目标点的任一节点，扩展得到的随机采样点为r，然后遍历所有已存在的节点并计算得到离r最近的现有节点n，以给定的步长t从节点n向r扩展，如果在扩展路径上没有阻碍物，则将新生成的扩展节点r加入到扩展随机树中，若发生碰撞则舍弃扩展节点r。3.根据权利要求2所述的旅客登机车自动路径规划及车辆控制方法，其特征在于：步骤3.2包含如下步骤：步骤3.2.1，计算扩展节点r与障碍物在静态二维构型空间中的位置坐标(x
z
,y
z...
【专利技术属性】
技术研发人员：单萍，单帅，马列，马敏，
申请(专利权)人：江苏天一航空工业股份有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。