详情

原文传递一种基于码头环境的行驶轨迹生成系统及方法

专利名称：	一种基于码头环境的行驶轨迹生成系统及方法
摘要：	一种基于码头环境的行驶轨迹生成系统及方法，属于自动驾驶领域。现有的自动驾驶领域的行驶轨迹生成系统和方法灵活性和自主性差。本发明在道路中心参考线的横向和纵向上按一定密度均匀的撒点采样，并通过多项式拟合横向、纵向状态，用多项式方程描述车辆位置行驶到每一个采样点的行驶轨迹；然后按照到达目的、符合交规，通过碰撞检测、平稳舒适的要求对每条行驶轨迹打分；在生成了横向轨迹和纵向之后，将横向轨迹和纵向轨迹合成，选择一条符合要求的最佳规划轨迹。本发明的系统实现原理简单，稳定性高，能够实时生成安全，可行的行驶轨迹。与完全固定行驶线路的码头AGV相比，该系统又有较高的灵活性，能够实现避障，跟车等自主决策。
专利类型：	发明专利
国家地区组织代码：	广东;44
申请人：	深圳数翔科技有限公司
发明人：	廖志闯;魏晓宇
专利状态：	有效
申请日期：	2019-07-06T00:00:00+0800
发布日期：	2019-10-18T00:00:00+0800
申请号：	CN201910607143.1
公开号：	CN110341711A
代理机构：	牡丹江市丹江专利商标事务所(特殊普通合伙)
代理人：	张雨红
分类号：	B60W40/02(2006.01);B;B60;B60W;B60W40
申请人地址：	518118 广东省深圳市坪山区马峦街道坪环社区锦龙大道1号
主权项：	1.一种基于码头环境的行驶轨迹生成系统，其特征在于：其组成包括：定位模块，用于通过gps、imu、车轮编码器实时提供车辆当前的位姿、速度、加速度；gps为全球定位系统；imu为惯性测量装置；感知模块，用于通过激光雷达、摄像头、毫米波雷达实时提供障碍物信息，障碍物信息包括障碍物轮廓的外包络、障碍物行进速度和障碍物行进方向；港口调度模块，用于根据规划场景下发全局路径参考线的规划命令和目标点信息，目标点信息包括给当前车辆下发要到达任务终点时的车辆的状态信息，如位置、航向角、速度、加速度；地图模块，用于按照调度系统下发的全局路径提供车辆行驶的道路中心参考线；车辆控制模块，用于根据行驶轨迹点计算控制变化量，控制车辆的速度及车轮转角变化；轨迹生成系统，用于接收定位模块、感知模块、港口调度模块、地图模块传输来的信息生成符合规划轨迹的行驶轨迹点，并将行驶轨迹点的序列作为输出发送给车辆控制模块。 2.一种基于码头环境的行驶轨迹生成系统，其特征在于，其组成包括：轨迹生成系统接收调度系统的指令，通过采集相关信息，并将生成的运行轨迹作为输出发送给车辆的执行系统，最终指引车辆安全到达预定地点；轨迹生成系统要接收调度系统下达的指令，生成从起点到终点的运行轨迹，并将质量传输给执行系统，通过执行系统前往目标地点；轨迹生成系统包括定位模块、感知模块、地图模块、决策模块；执行系统包括控制模块和监测模块；在工作过程中，调度系统指示相应的车辆到达预定的坐标点，该指令会被传输给轨迹生成系统；轨迹生成系统在接收指令后，会利用决策模块分析处理由地图模块、定位模块、感知模块所传递的相关信息，规划并制定运行轨迹路线和行驶速度，然后向执行系统下达指令；执行系统在接受到轨迹生成系统的指令后，通过控制模块将指令转换成实际的车辆运行动作，使车辆按照预定的速度和路线行驶，同时监测模块会实时监测车辆的运行状态，并反馈给决策模块；决策模块则会综合分析地图模块、定位模块、感知模块、监测模块所传递的信息，实时调整运行轨迹和运行速度，保证车辆顺利到达预定位置；其中，定位模块实时提供车辆的位置和车身姿态；感知模块实时探测外部障碍物的位置、距离和车辆行驶道路的参考线；地图模块存储着该地区的现有道路地图；决策模块会综合其他模块存储和采集的信息，通过经过评价分析，选定轨迹路线；控制模块根据接收到的指令，计算控制变化量，控制车辆的速度及转向角度；监测模块实施监测车辆的行驶速度和行驶方向；决策模块的工作过程可分为三步，即生成备选轨迹、轨迹评分、轨迹选择；在实际应用中，定位模块和地图模块会首先将车辆所处位置和现有区域的道路地图传输给决策模块，感知模块则会将采集到的外部信息实时传输给决策模块，从而生成备选的轨迹路线，然后决策系统会对现有的若干条路线进行分项评价，再视调度系统的指令需要对备选轨迹路线根据分项评价分数进行排序，从中选取分数最高项作为初选路线；在沿初选路线行驶过程中，决策模块还会实时接收感知模块和监测模块采集到的信息，再结合地图模块和定位模块传输的信息，根据实际情况对车辆的轨迹路线进行调整。 3.根据权利要求1所述的一种基于码头环境的行驶轨迹生成方法，其特征在于：所述方法包括采样候选轨迹的步骤、轨迹评分的步骤、轨迹选择的步骤；其中，采样候选轨迹的步骤为，根据定位模块提供的车辆自身位置信息以及地图模块提供的道路中心参考线信息生成行驶轨迹的原理，在道路中心参考线的横向和纵向上按一定密度均匀的撒点采样，并通过多项式拟合横向、纵向状态，用多项式方程描述车辆位置行驶到每一个采样点的行驶轨迹；轨迹评分的步骤为，按照以下4点要求对每条行驶轨迹打分，并对得分进行由低到高的排序；其中，4点要求分别是：到达目的、符合交规，通过碰撞检测、平稳舒适；到达目的是指到达撒点采样的位置；一个采样的纵向位置是指一个小的目标点；轨迹选择的步骤为，在生成了横向轨迹和纵向之后，将横向轨迹和纵向轨迹合成，然后选择一条符合要求的最佳规划轨迹。 4.根据权利要求3所述的一种基于码头环境的行驶轨迹生成方法，其特征在于：所述的采样候选轨迹的步骤中，轨迹包含纵向维度、横向维度、时间维度三维信息，将三维的轨迹生成过程解耦为路径规划和速度规划的两个二维子过程，即分别为横向规划纵向规划，再将两个子过程合并；在码头自动驾驶环境中，使用道路的中心线作为参考线，即命名为道路中心参考线，以车辆自身为原点，坐标轴的s方向为沿着道路中心参考线的方向，称为纵向(Longitudinal)，坐标轴的l方向为道路中心参考线上过当前点的法向，称为横向(Lateral)，s方向与l方向相互垂直；候选轨迹生成流程；步骤1、首先，将笛卡尔坐标系转换为Frenet坐标系，在Frenet坐标系下，获取车辆当前时刻t0的起始状态：然后，在轨迹持续时间内的t1时刻进行一次采样，得末状态：步骤2、分别将末状态和初始状态的横向和纵向做多项式拟合，生成横向轨迹多项式l＝f(s)和纵向多项式轨迹s＝f(t)；步骤3、给定一个时刻t，根据s＝f(t)计算出一个纵向偏移量s，再根据l＝f(s)计算出一个横向偏移量l；步骤4、通过道路中心参考线，将Frenet坐标系下的点(s，l)转化为Cartesian坐标下的坐标(x，y)；以此类推，通过一系列采样时间{t}，获得一系列采样点{P}，最终形成一条完整的轨迹。 5.根据权利要求4所述的一种基于码头环境的行驶轨迹生成方法，其特征在于：轨迹评分的步骤具体为：步骤1、针对对每条行驶轨迹打分的4点要求，设计六个评分准则，分别为：速度V、纵向加速度、发生碰撞、向心加速度a、横向偏移和横向加速度：速度越接近道路允许的速度，评分的分值越高；横向加速度、纵向加速度、向心加速度越接近人体舒适度，评分的分值越高；和道路中的障碍物距离越远，评分的分值越高；横向偏移越小，评分的分值越高；速度是对路程的求导计算；纵向加速度是对速度的求导计算；向心加速度a是a＝VVkappa；V是速度，Kappa是曲率，通过之前给出的公式求出kappa；横向偏移，是轨迹上的位置相对于道路中心参考线的位置偏差；横向加速度表示车辆车身偏移道路中心参考线的快慢程度；步骤2、用cost表示得评分的分值，按照每条轨迹的cost值进行从小到大的排序： Cost＝k1c1+k2c2+k3c3+k4c4+k5c5+k6c6； c1是轨迹上速度和道路速度的差值； c2是轨迹上纵向加速度的平均值； c3是和障碍物距离的最小值； c4是轨迹上向心加速度的平均值； c5是横向偏差的最大值； c6是轨迹上横向加速度的平均值； k1，k2，...k6是系数，是经验值。 6.根据权利要求5所述的一种基于码头环境的行驶轨迹生成方法，其特征在于：轨迹选择的步骤具体为：步骤1、首先，选取评分cost值最低的一对横向轨迹与纵向轨迹，然后进行轨迹合成；步骤2、判断合成的轨迹是否符合速度、加速度、向心加速度、横向偏移、横向加速度的物理限制，是否通过了港口障碍物的碰撞检测，若是，则该轨迹为符合要求的轨迹；否则，按照cost值得分顺序选择下一对横向轨迹与纵向轨迹进行轨迹合成，直到判断其符合速度、加速度、向心加速度、横向偏移、横向加速度的物理限制，也通过了港口障碍物的碰撞检测，其中，物理限制是指，轨迹上点速度、加速度、曲率、加加速度、向心加速度是否在车体运行范围内；碰撞检测是指，依次遍历轨迹上的点，用一个矩形表示车辆的占据范围；同时根据有效障碍物信息，也用一个矩形表示障碍物的占据范围；判断这两个矩形是否相交，若相交，则说明该轨迹有碰撞风险，这条轨迹得舍弃；若轨迹上所有点都不发生相交，则该轨迹通过了碰撞检测。 7.根据权利要求6所述的一种基于码头环境的行驶轨迹生成方法，其特征在于：所述的将笛卡尔坐标系(cartesian坐标系)转换为Frenet坐标系的过程为：已知：cartesian坐标系的输入：(x，y，θx，kx，vx，ax) 求：frenet坐标系的输出：求解公式如下：令：Δθ＝θx-θr l′＝(1-krl)tanΔθ 8.根据权利要求7所述的一种基于码头环境的行驶轨迹生成方法，其特征在于：所述的通过道路中心参考线，将Frenet坐标系下的点(s，l)转化为笛卡尔坐标系(Cartesian坐标系)下的坐标(x，y*)的过程为：已知：frenet坐标系的输入：求：cartesian坐标系的输出：(x，y，θx，kx，vx，ax) 令： x＝xr-l sin θr y＝yr+l cos θr θx＝Normalize(Δθ+θr)
所属类别：	发明专利