欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2023101272267
申请人: 湖南大学
专利类型:发明专利
专利状态:已下证
专利领域: 一般车辆
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种四轮独立转向车辆的泊车轨迹规划方法,其特征在于,包括:

S1,获取车辆初始位置、目标泊车位置和泊车场景的栅格地图,以目标泊车位置作为搜索起点,车辆初始位置作为终点,用改进的混合A*算法进行全局路径规划,获取原始全局路径;其中,改进的混合A*算法包括子节点拓展步骤,该子节点拓展步骤采用预先设置的与车辆运动模式相对应的子节点拓展方式;

S2,以原始全局路径上的模式切换节点为端点,将原始全局路径进行分段,对各段路径进行路径优化和速度规划,获取优化全局轨迹;

步骤S1中,与车辆运动模式中的前后轮异向运动模式相对应的子节点拓展方式生成(k1+2)个子节点,左转子节点位姿描述为下式(1),右转子节点位姿描述为下式(2),直行子节点位姿描述为下式(3):式中,(x1,y1)为(k1+2)个子节点之一在大地坐标系中的坐标,(x,y)为父节点在大地坐标系中的坐标,R为转向半径,且i为1到k1/4的所有整数,L为轴距,θ为最大车轮转向角度,α为父节点处的车辆航向角,Δα为车辆的偏航角,l1为步长,α1为(k1+2)个子节点之一处的车辆航向角;

与车辆运动模式中的原地旋转运动模式相对应的子节点拓展方式生成k2个下式(5)描述的子节点:

式中,(x2,y2)为k2个子节点之一在大地坐标系中的坐标,(x,y)为父节点在大地坐标系中的坐标,α为父节点处的车辆航向角,i为1到k2的所有整数,α2为k2个子节点之一的航向角;

与车辆运动模式中的前后轮同向运动模式相对应的子节点拓展方式生成k3个下式(7)描述的子节点:式中,(x3,y3)为k3个子节点之一在大地坐标系中的坐标,(x,y)为父节点在大地坐标系中的坐标,α为父节点处的车辆航向角,l2为步长,α3为k3个子节点之一的航向角,前轮转角j为1到k3/4的所有整数。

2.如权利要求1所述的四轮独立转向车辆的泊车轨迹规划方法,其特征在于,步骤S1中的“改进混合A*算法”过程中,记录生成每一节点的拓展方式信息,在计算子节点的代价值时,当父节点的拓展方式信息与子节点的拓展方式信息一致,子节点总代价值表示为f(n)=g(n)+h(n);当父节点的拓展方式信息与子节点的拓展方式信息不一致,则子节点总代价值表示为f(n)=g(n)+h(n)+p(n),其中,f(n)、g(n)、h(n)、p(n)分别表示节点n的总代价值、路径代价值、启发代价值、模式切换代价值。

3.如权利要求2所述的四轮独立转向车辆的泊车轨迹规划方法,其特征在于,步骤S1中的“改进混合A*算法”中计算子节点的启发式代价值g(n)时,当子节点的拓展方式信息分别为前后轮异向、原地旋转和前后轮同向运动模式时,启发式代价值g(n)分别描述为下式提供的g1(n)、g2(n)和g3(n):g1(n)=l1·(ωl1+ωb1+ωt1·Δα)    (4)

g2(n)=ωr·|α2-α|     (6)

g3(n)=l2·(ωl2+ωb2+ωt2·β)      (8)

式中,ωl1、ωb1和ωt1分别为前后轮异向运动模式拓展方式对应的路径长度惩罚系数、倒车惩罚系数、转弯惩罚系数;ωr为原地旋转模式拓展方式对应的旋转角度惩罚系数;ωl2、ωb2和ωt2分别为前后轮同向运动模式拓展方式对应的路径长度惩罚系数、倒车惩罚系数、车轮转角惩罚系数。

4.如权利要求3所述的四轮独立转向车辆的泊车轨迹规划方法,其特征在于,步骤S1中的“改进混合A*算法”中计算子节点的模式切换代价值p(n)时,若为前后轮异向与原地旋转两运动模式切换,p(n)描述为常数p1;若为前后轮异向与前后轮同向两运动模式切换,p(n)描述为常数p2;若为前后轮同向与原地旋转两运动模式切换,p(n)描述为常数p3。

5.如权利要求1所述的四轮独立转向车辆的泊车轨迹规划方法,其特征在于,步骤S2中,原始全局路径分段形成前后轮异向运动路径段和前后轮同向运动路径段,使用基于梯度的数值优化方法对前后轮异向运动路径段进行路径优化。

6.一种四轮独立转向车辆的泊车轨迹规划装置,其特征在于,包括:

环境感知模块,其用于生成车位信息、栅格地图和车辆初始位置信息;

车位管理模块,其用于接收环境感知模块输送的车位信息、栅格地图和车辆初始位置信息,选择一个最佳的车辆可泊入车位,再根据选择的可泊入车位生成目标泊车位置信息;

泊车轨迹规划模块,其用于接收环境感知模块输送的车辆初始位置信息和栅格地图以及车位管理模块输送的目标泊车位置信息后,使用如权利要求1-5中任一项所述的四轮独立转向车辆的泊车轨迹规划方法生成的优化全局轨迹作为泊车轨迹;

车辆控制模块,其用于接收到泊车轨迹规划模块输送的泊车轨迹信息后,根据轨迹信息来完成泊车任务车辆控制模块拥有控制功能,用于控制车辆完成泊车;在接收到泊车轨迹规划模块输送的泊车轨迹信息后,车辆控制模块根据轨迹信息来控制车辆的方向盘、油门、刹车等执行机构完成泊车任务。