CN113771828B 一种自动驾驶定点停车的控制方法及系统 （采埃孚商用车系统(青岛)有限公司）

(19)国家知识产权局(12)发明专利(10)授权公告号CN113771828B(65)同一申请的已公布的文献号申请公布号CN113771828A(73)专利权人采埃孚商用车系统(青岛)有限公司地址266510山东省青岛市黄岛区渭河路917号(72)发明人石庆兰B60W30/14(2006.01)B60W40/076(2012.01)B60W40/105(2012.01)审查员陶洪敏(74)专利代理机构青岛智地领创专利代理有限公司37252专利代理师种艳丽一种自动驾驶定点停车的控制方法及系统本发明公开了一种自动驾驶定点停车的控制方法及系统，属于汽车智能驾驶技术领域，控制方法包括如下步骤：确定目标停车位置，自动生成目标轨迹点、预估制动距离和预估滑行距离；根据目标轨迹点以及当前控制偏差，计算当前位置距离与目标终点之间的纵向距离；实时采响应时间信息；根据距离目标终点的纵向距离和实时车速以固定的频率更新纵向距离；基于控制状态决策逻辑实时估算与目标停车点的距离，以确定车辆控制状态。控制系统包括车辆信息采集性。21.一种自动驾驶定点停车的控制方法，其特征在于，包括如下步骤：S1.确定目标停车位置，自动生成目标轨迹点、预估制动距离和预估滑行距离；S2.根据目标轨迹点以及当前控制偏差，计算当前位置与目标终点之间的纵向距离；S4.根据距离目标终点的纵向距离和实时车速以固定的频率更新纵向距离；S5.基于控制状态决策逻辑实时估算与目标停车点的距离，以确定车辆控制状态；所述目标轨迹点为一个点列表(p0,p1,…,pn-1,pn),其中p0是当前位置点，Pn是目标停车点，(p1…pn-1)是当前位置点和目标停车点之间的离散预测位置；车辆纵向距离的计算更新采用基于卡尔曼滤波的融合算法；固定的频率预设为10ms;所述控制状态决策逻辑的内容为：若距离目标终点的纵向距离≤预估的制动距离，进入制动控制阶段；若距离目标终点的纵向距离≤预估的滑行距离，进入减速滑行控制阶段；若当前车速≥稳态时目标车速+补偿车速，进入减速控制阶段；减速阶段控制车辆缓慢减速至设定的稳定驾驶车速；稳态速度阶段控制离合器处于半滑摩状态，使车速能够稳定在固定的车速区间；减速滑行阶段控制打开离合器减速蠕行；制动阶段根据目标终点距离控制车辆缓慢停止至目标位置点。2.一种自动驾驶定点停车的控制系统，其特征在于，采用如权利要求1所述自动驾驶定点停车的控制方法实现车辆自动驾驶的定点停车；车辆信息采集模块，采用达到毫米级精度车轮滚动距离的车辆主动速度传感器，实时采集车辆行驶信息并计算车速、坡度、车辆制动响应时间信息，并将这些信息发动到位置估位置估计模块，采用基于卡尔曼滤波的融合算法，基于车辆信息采集模块传递过来的车辆信息，同时配以车辆自身ESC模块中10ms更新率的偏航率进行车辆位置的实时计算；控制状态决策模块，集成了控制状态决策逻辑控制程序，根据位置估计模块实时估算的车辆距离和当前车辆速度进行车辆状态控制。3.根据权利要求2所述自动驾驶定点停车的控制系统，其特征在于，使用具有三级联的控制系统，外级联控制车辆位置，中间级联控制车速，内级联用于控制制动系统施加的制动力和离合器控制施加的传动系力。4.根据权利要求3所述自动驾驶定点停车的控制系统，其特征在于，完成定点停车的控1)进入定点停车控制模式后，车辆缓慢减速至预设的恒定机动速度；2)使用运动控制模式平稳地保持车辆操纵速度，直到车辆距目标停车点的距离达到由行驶阻力和离合器打开滞后时间计算的离合器预打开距离；3)保持离合器打开并让车辆自由滚动，直到车辆距目标停车点的距离达到由行驶阻力和制动施加滞后时间计算的制动预施加距离；4)一旦车辆停止，施加全制动以保持车辆静态安全。5.根据权利要求4所述自动驾驶定点停车的控制系统，其特征在于，所述运动控制模式3通过牵引控制、制动控制和离合器执行器控制共同配合完成车辆的速度平稳控制。4技术领域[0001]本发明属于汽车智能驾驶技术领域，具体涉及一种自动驾驶定点停车的控制方法及系统。背景技术[0002]在自动驾驶车辆中，很多情况下要求车辆能够准确停止在目标位置上，比如公交[0003]常规的自动驾驶轨迹跟踪与速度实时控制方法受限于执行器的响应时间与精度，以下三种实际情况使得常规的自动驾驶控制在以AMT和气动制动系统的重型卡车上停车位置精度不够：(1)通常虚拟驾驶员会每100毫秒更新一次车辆定位，这意味着即使速度为1km/h,车辆在两次位置信息更新之间已经移动了3.6厘米，定位更新频率低；(2)对于大多数商用车来说，离合器执行器和制动控制系统都是气动执行系统，响应滞后很长；例如，从施加制动到制动缸建立到所需的压力，主车需要600多毫秒，拖车需要1000多毫秒；另一方面，离合器控制和制动力控制在低幅度范围内都非常不稳定和不准确；(3)要达到10cm级别的停车精度，必须使用极低(1-2km/h)且稳定(甚至更重要)的车速，对于大多数带有AMT的商用车，系统需要控制离合器在该速度范围内工作在打滑状态，这对离合器和制动器的控制精度提出了很高的要求。[0004]针对以上情况，需要开发设计特定的控制功能，通过控制离合器和制动系统实现高精度定点停车，同时能够兼顾驾驶舒适性。发明内容[0005]为了解决上述问题，本发明提出了一种自动驾驶定点停车的控制方法及系统，实现高精度定点停车功能和最大的舒适度。[0006]本发明的技术方案如下：[0007]一种自动驾驶定点停车的控制方法，包括如下步骤：[0008]S1.确定目标停车位置，自动生成目标轨迹点、预估制动距离和预估滑行距离；[0009]S2.根据目标轨迹点以及当前控制偏差，计算当前位置与目标终点之间的纵向距[0011]S4.根据距离目标终点的纵向距离和实时车速以固定的频率更新纵向距离；[0012]S5.基于控制状态决策逻辑实时估算与目标停车点的距离，以确定车辆控制状态。[0013]进一步地，目标轨迹点为一个点列表(p0,p1,…,pn-1,pn),其中p0是当前位置点，Pn是目标停车点，(p1…pn-1)是当前位置点和目标停车点之间的离散预测位置。[0014]进一步地，车辆纵向距离的计算更新采用基于卡尔曼滤波的融合算法；固定的频率预设为10ms。5[0016]若距离目标终点的纵向距离≤预估的制动距离，进入制动控制阶段；[0017]若距离目标终点的纵向距离≤预估的滑行距离，进入减速滑行控制阶段；[0018]若当前车速≥稳态时目标车速+补偿车速，进入减速控制阶段；[0020]进一步地，减速阶段控制车辆缓慢减速至设定的稳定驾驶车速；稳态速度阶段控制离合器处于半滑摩状态，使车速能够稳定在固定的车速区间；减速滑行阶段控制打开离合器减速蠕行；制动阶段根据目标终点距离控制车辆缓慢停止至目标位置点。[0021]一种自动驾驶定点停车的控制系统，采用如上所述自动驾驶定点停车的控制方法实现车辆自动驾驶的定点停车；[0023]车辆信息采集模块，采用达到毫米级精度车轮滚动距离的车辆主动速度传感器，实时采集车辆行驶信息并计算车速、坡度、车辆制动响应时间信息，并将这些信息发动到位置估计模块；[0024]位置估计模块，采用基于卡尔曼滤波的融合算法，基于车辆信息采集模块传递过来的车辆信息，同时配以车辆自身ESC模块中10ms更新率的偏航率进行车辆位置的实时计[0025]控制状态决策模块，集成了控制状态决策逻辑控制程序，根据位置估计模块实时估算的车辆距离和当前车辆速度进行车辆状态控制。[0026]进一步地，使用具有三级联的控制系统，外级联控制车辆位置，中间级联控制车速，内级联用于控制制动系统施加的制动力和离合器控制施加的传动系力。[0028]1)进入定点停车控制模式后，车辆缓慢减速至预设的恒定机动速度；[0029]2)使用运动控制模式平稳地保持车辆操纵速度，直到车辆距目标停车点的距离达到由行驶阻力和离合器打开滞后时间计算的离合器预打开距离；[0030]3)保持离合器打开并让车辆自由滚动，直到车辆距目标停车点的距离达到由行驶阻力和制动施加滞后时间计算的制动预施加距离；[0031]4)一旦车辆停止，施加全制动以保持车辆静态安全。[0032]进一步地，运动控制模式通过牵引控制、制动控制和离合器执行器控制共同配合完成车辆的速度平稳控制。[0033]本发明所带来的有益技术效果：[0034]通过采用车辆传感器，并基于卡尔曼滤波的融合算法，对接收的定位信息进行了更短周期的预估，获得了更实时、更高精度的定位；通过本发明控制方法可以控制离合器保持在滑磨状态，有利于停车时的快速松开动力系统传动链，使离合器控制和制动力控制在低幅度范围内都非常稳定和准确，兼顾了驾驶舒适性；通过将到目标停车点的距离规划在一个稳定可控的车速，在停车前，同时控制离合器和制动系统，已达到最佳的停车位置。附图说明[0035]图1为本发明自动驾驶定点停车控制方法的结构图；[0036]图2为本发明自动驾驶定点停车控制阶段的车速图。6具体实施方式[0037]下面结合附图以及具体实施方式对本发明作进一步详细说明：[0038]为了实现高精度定点停车功能，一种自动驾驶定点停车的控制系统使用具有三级联的控制系统，外级联控制车辆位置，中间级联控制车速，内级联用于控制制动系统施加的制动力和离合器控制施加的传动系力。[0039]整个控制系统主要包括车辆信息采集模块、位置估计模块、控制状态决策模块。其中，车辆信息采集模块，采用达到毫米级精度车轮滚动距离的车辆主动速度传感器，实时采集车辆行驶信息并计算车速、坡度、车辆制动响应时间信息，并将这些信息发动到位置估计模块；位置估计模块，采用基于卡尔曼滤波的融合算法，基于车辆信息采集模块传递过来的车辆信息，同时配以车辆自身ESC模块中10ms更新率的偏航率进行车辆位置的实时计算；控制状态决策模块，集成了控制状态决策逻辑控制程序，根据位置估计模块实时估算的车辆距离和当前车辆速度进行车辆状态控制。[0040]如图1所示，一种自动驾驶定点停车的控制方法，包括如下步[0041]步骤1:首先基于控制系统确定目标停车位置，自动生成目标轨迹点(Pt0…Ptn)、预估制动距离和预估滑行距离；[0042]步骤2:根据目标轨迹点(自动驾驶中由虚拟驾驶员发送自动生成的目标轨迹点)以及当前控制偏差dx(车辆实际位置点与目的轨迹点的偏差，由虚拟驾驶员提供),计算当前位置与目标终点之间的纵向距离，此距离更新频率取决于目标轨迹点发送的频率，频率的预设值可以设置为10ms或10ms以下；[0043]步骤3:通过车辆安装的传感器实时采集车辆信息并计算当前车速v_speed、坡度、车辆制动响应时间等信息；[0044]步骤4:根据步骤2计算出的距离目标终点的纵向距离和实时车速更新纵向距离dx_end,此距离更新频率为该系统控制器的计算频率，为10ms或10ms以下；[0045]步骤5:根据当前车速、坡度、车辆制动响应时间等信息，基于控制状态决策逻辑实时估算与目标停车点的距离，以确定车辆何时进入减速阶段、稳态速度阶段、滑行阶段或制动阶段的控制状态，具体各阶段的判断逻辑为：[0046](1)若dx_end≤预估的制动距离，进入制动控制阶段，此阶段根据目标终点距离控制制动系统使车辆缓慢停止至目标位置点；[0047](2)若dx_end≤预估的滑行距离，进入减速滑行控制阶段，该阶段以一定的斜率控制打开离合器减速蠕行；[0048](3)若当前车速v_speed≥稳态时目标车速(1km/h)+补偿车速(1km/h),进入减速控制阶段，该阶段以一定的斜率缓慢减速至稳态时设定的车速(1km/h),该斜率可以根据终点距离决定；[0049](4)否则，车辆保持在稳态速度控制阶段，这个阶段目标时控制离合器半滑摩状态，使车速能够稳定在比较小(1km/h)的车速区间。[0050]上述1km/h为常规车型的设定值，此数值可以根据车型、环境等情况具体设定，不唯一。[0051]本发明其实质包含下面几个方面的关键内容。7[0053]在常规的自动驾驶中，由于硬件或计算资源的限制，虚拟驾驶员会以超过100ms的制系统的车辆信息采集模块采用了低成本的解决方案，即采用基于高精度车辆传感器信息的卡尔曼位置估计算法，由于来自高精度车辆传感器的信息更准确、更直接，例如来自主动速度传感器的具有毫米级精度的车轮滚动距离，再辅助以来自ESC模块的偏航率(具有10ms更新率),因此位置估计精度和稳定性将比来自IMU的融合结果要好得多。[0055]从当前位置到所需停车位置的距离信息由虚拟驾驶员通过轨迹接口提供，这包括在纵向(x)和横向(y)上持续更新到所需目标点的距离。轨迹接口定义为一个点列表(p0,p1,…,pn-1,pn),其中p0是位置控制的当前位置点，Pn是期望的停止位置点，(p1…Pn-1)是当前位置点和期望停止位置点之间离散的预测位置。在本发明的控制系统中，根据轨迹点列表找到终点停止位置点，并以10ms或10ms以下的周期实时计算车辆当前位置与找到的终点停止位置之间的纵向距离(dx_end)。[0056]另一方面，为了克服离合器、制动驱动系统的长响应滞后，采用基于车辆动力学的特殊模型预测方式实现目标停车模式下的纵向控制，根据估计的当前位置和终点停止位置之间的距离提前控制离合器和制动。[0057]基于车辆动力学的特殊模型预测方式的定点停车程序逻辑为：[0058]1)当虚拟驾驶员选择进入定点停车控制模式时，车辆缓慢减速至预设的恒定机动速度(1km/h);[0059]2)使用特殊的运动控制模式平稳地保持操纵速度，直到dx_end达到由行驶阻力和离合器打开滞后时间计算的离合器预打开距离；[0060]3)保持离合器打开并让车辆自由滚动，直到dx_end达到由行驶阻力和制动施加滞后时间计算的制动预施加距离；[0061]4)一旦车辆停止，将施加全制动以保持车辆静态安全。[0063]运动控制模式通过牵引控制、制动控制和离合器执行器控制共同配合完成车辆的速度平稳控制。[0064](1)牵引控制[0065]对于纵向运动控制，将达到或保持所需速度的牵引力(正或负)用作前馈。牵引力高度依赖于道路坡度、滚动阻力和空气阻力，这些阻力可以通过自动驾驶系统中的其他功能模块中的运动学值和车辆动态特性预估获得，此外，还使用运动模块提供的实际车辆速度的反馈控制器，以最大限度地减少速度控制误差。[0066]除了上述常用的控制方法外，某些特殊工况下还需特殊的控制方法。比如当车辆处于低行驶阻力时(例如，卡车单独行驶或卡车拖车在小下坡),由于干式离合器系统无法在小扭矩附近精确控制离合器扭矩，因此难以保持车速稳定在目标值。为了克服这种情况，将在离合器接合控制的同时施加轻微的制动力。这将有助于使离合器扭矩和驱动阻力在更深的位置平衡，离合器扭矩控制更稳定和可控。8[0068]制动控制器将负牵引力(制动力)处理拆分为各个执行器所需输出的制动力，包括行车制动器、缓速器、电机/非内燃发动机等部件，并据此控发动机的扭矩(输出)。为了在制动中更好地发挥电机/非内燃发动机的动力回收功能，传统制动器与他们之间的互动就尤为重要。此外，基于制动系统、电机/非内燃发动机的多样性，将它们的功能统一到一个抽象的、概括性的硬件层中。[0069]为了通过减少停车操作结束时的制动冲击来提高驾驶舒适性，使用软停车功能中实现的从前轴到后轴的制动压力重新分配。[0071]由于低速控制范围，目标控制停车期间的正牵引力由变速器控制功能内的离合器控制处理。在这种情况下，应提供