CN113844460B - 车辆控制方法、装置及车辆 - Google Patents

Abstract

本申请公开了一种车辆控制方法、装置及车辆，属于驾驶领域。所述方法包括：在检测到车辆退出手动驾驶模式时，获取N条路径的平滑误差，所述N条路径是所述车辆在进入所述手动驾驶模式前已规划的路径，N为大于1的整数，第一路径的平滑误差用于指示所述车辆从第一位置过渡到所述第一路径的平稳程度，所述第一位置是所述车辆当前的位置，所述第一路径是所述N条路径中的任一条；根据所述N条路径的平滑误差，从所述N条路径中选择一条路径作为第二路径；根据所述第二路径，控制所述车辆自动驾驶。本申请能够提高自动驾驶的效率。

Description

车辆控制方法、装置及车辆

技术领域

本申请涉及驾驶领域，特别涉及一种车辆控制方法、装置及车辆。

背景技术

目前的自动驾驶(automated driving/ADS)技术可用于智能车(smart/intelligent car)，自动驾驶技术是通过车辆的路径规划模块进行路径的规划，车辆基于规划的路径控制自身自动完成驾驶的过程。

车辆在基于规划的路径进行驾驶的过程，车辆行驶的路径可能与用户的需求不同，此时用户可能接管车辆，自己手动驾驶，车辆退出自动驾驶模式，进入手动驾驶模式。用户在手动驾驶一段时间后可能需要车辆继续自动驾驶时，目前只能停车，重新手动开启自动驾驶模式，使车辆继续自动驾驶。所以目前的自动驾驶效率较低。

发明内容

本申请提供了一种车辆控制方法、装置及车辆，以提高自动驾驶的效率。所述技术方案如下：

第一方面，本申请提供了一种控制车辆的方法，在所述方法中：在检测到车辆退出手动驾驶模式时，获取N条路径的平滑误差，该N条路径是车辆在进入手动驾驶模式前已规划的路径，N为大于1的整数，第一路径的平滑误差用于指示车辆从第一位置过渡到第一路径的平稳程度，第一位置是车辆当前的位置，第一路径是该N条路径中的任一条。根据该N条路径的平滑误差，从该N条路径中选择一条路径作为第二路径；根据第二路径，控制车辆自动驾驶。

在从手动驾驶模式进入自动驾驶模式时，获取在进入手动驾驶模式之前已规划的N条路径中的每条路径的平滑误差，根据每条路径的平滑误差选择一条路径作为第二路径，这样便根据第二路径控制车辆自动驾驶，从而不需要停车重启自动驾驶模式，提高了自动驾驶的效率。另外，由于路径的平滑误差用于指示车辆从第一位置过渡到第一路径的平稳程度，又由于基于平滑误差选择的第二路径，所以能够控制车辆较平滑地从第一位置过渡到第二路径，提高了自动驾驶的舒适性和安全性。

在一种可能的实现方式中，根据车辆的运动信息确定预瞄点，该预瞄点是车辆在指定时间长度内待到达的位置，该预瞄点位于第一路径上；根据该预瞄点和车辆的行驶方向，获取第一路径的平滑误差。由于预瞄点是车辆在指定时间长度内待到达第一路径上的位置，所以预瞄点和车辆的行驶方向都能反应车辆从第一位置到预瞄点所需要行驶的轨迹和转动的角度，该轨迹和角度包括车辆从第一位置过渡到第一路径的平稳程度，从而实现了准确获取第一路径的平滑误差。

在另一种可能的实现方式中，将预瞄点映射到车辆的车辆坐标系中，得到预瞄点在车辆坐标系中的横向坐标；根据该横向坐标，以及车辆的行驶方向与第一切线之间的夹角，获取第一路径的平滑误差，第一切线为第一路径在预瞄点处的切线。其中，横向坐标反应了车辆从第一位置到达预瞄点的横向偏移，该夹角反应了车辆在过滤到预瞄点所需要转动的角度，从而基于该横向坐标和该夹角可以准确地获取第一路径的平滑误差。

在另一种可能的实现方式中，确定包括N条路径的区域；在第一位置位于该区域中，获取N条路径的平滑误差。该区域是一个安全区域，该区域可能不存在障碍物等，所以当第一位置位于该区域内，控制车辆从第一位置过渡到预瞄点的路径上可能不会障碍物发生碰撞，从而提高了驾驶安全性。

在另一种可能的实现方式中，在第一位置位于该区域外，通过车辆的路径规划模块规划待行驶的至少一条路径，根据至少一条路径控制车辆自动驾驶。位于该区域外可能存在障碍物，在第一位置位于该区域外，从第一位置到达该N条路径中的任一条路径，可能会与障碍物发生碰撞。所以在第一位置位于该区域外，重新规划路径，重新划分的路径避开了障碍物，基于重新划分的路径自动驾驶，提高了驾驶安全性。

在另一种可能的实现方式中，显示所述至少一条路径；在检测到用户对第三路径的选择操作时，获取第三路径，第三路径是所述至少一条路径中的一条路径；根据第三路径控制车辆自动驾驶。从而实现了人机交互，可以让用户选择了自己需要期望的路径，满足用户的需求。

在另一种可能的实现方式中，获取第四路径的路径参数，第四路径是在使用手动驾驶模式的时间段内车辆行驶的路径，路径参数用于车辆的路径规划模块基于路径参数，规划车辆在行驶完第二路径之后待行驶的至少一条路径。由于第四路径是用户手动驾驶的路径，所以第四路径的路径参数反应用户的驾驶习惯，车辆的路径规划模块基于路径参数，规划出符合用户驾驶习惯的路径。

第二方面，本申请提供了一种控制车辆的装置，用于执行第一方面或第一方面的任意一种可能实现方式中的方法。具体地，所述装置包括用于执行第一方面或第一方面的任意一种可能实现方式的方法的单元。

第三方面，本申请提供了一种控制车辆的装置，所述装置包括：处理器、存储器和收发器。其中，所述处理器、所述存储器和所述收发器之间可以通过总线系统相连。所述存储器用于存储一个或多个程序，所述处理器用于执行所述存储器中的一个或多个程序，使得所述装置完成第一方面或第一方面的任意可能实现方式中的方法。

第四方面，本申请提供了一种计算机可读存储介质，计算机可读存储介质中存储有程序代码，当其在计算机上运行时，使得计算机执行上述第一方面或第一方面的任意可能实现方式中的方法。

第五方面，本申请提供了一种包含程序代码的计算机程序产品，当其在计算机上运行时，使得计算机执行上述第一方面或第一方面的任意可能实现方式中的方法。

第六方面，本申请提供了一种车辆，包括第二方面所述的装置或第三方面所述的装置。

附图说明

图1是本申请实施例提供的一种车辆结构示意图；

图2是本申请实施例提供的一种规划的路径示意图；

图3是本申请实施例提供的另一种规划的路径示意图；

图4是本申请实施例提供的一种手动驾驶车辆行驶路径的示意图；

图5是本申请实施列提供的一种控制车辆的方法流程图；

图6是本申请实施例提供的预瞄点的示意图；

图7是本申请实施例提供的车辆坐标系的示意图；

图8是本申请实施例提供的一种控制车辆的装置结构示意图；

图9是本申请实施例提供的一种控制器的结构示意图。

具体实施方式

下面将结合附图对本申请实施方式作进一步地详细描述。

参见图1，本申请实施例提供了一种车辆1，该车辆1包括控制器11、感知系统12、定位系统13和路径规划模块14，控制器11、感知系统12、定位系统13和路径规划模块14均安装在车辆1的本体上，控制器11分别与定位系统13和路径规划模块14之间建立有通信连接，路径规划模块14还与感知系统12和定位系统13建立有通信连接。

可选的，控制器11、感知系统12、定位系统13和路径规划模块14可连接到车辆1的控制器局域网络(controller area network，CAN)总线上。控制器11通过CAN总线分别与定位系统13和路径规划模块14之间建立有通信连接，路径规划模块14通过CAN总线还与感知系统12和定位系统13建立有通信连接。

车辆1需要进行自动驾驶时，感知系统12用于感知车辆1周围的环境信息，向路径规划模块14发送感知到的环境信息；以及，定位系统13用于获取车辆1的运动信息，向路径规划模块14发送车辆1的运动信息。

可选的，感知系统12能够周期性地感知车辆1周围的环境信息，并向路径规划模块14发送感知的环境信息。同样，定位系统13也能够周期性地获取车辆1的运动信息，并向路径规划模块14发送车辆1的运动信息。

路径规划模块14用于接收感知系统12发送的车辆1周围的环境信息，以及接收定位系统13发送的车辆1的运动信息，基于接收的车辆1的环境信息和运动信息，规划在第一时间段内待行驶的至少一条路径。第一时间段位于当前时间之后，第一时间段的时间长度为指定的第一时间长度，该至少一条路径中的每条路径的起始位置相同，每条路径的长度是基于车辆1的运动信息和第一时间长度确定的。然后控制器11从该至少一条路径中选择一条路径，基于选择的一条路径，在第一时间段内控制车辆1自动驾驶。

路径规划模块14还用于继续接收感知系统12发送的车辆1周围的环境信息，以及接收定位系统13发送的车辆1的运动信息，继续基于接收的车辆1的环境信息和运动信息，规划在第二时间段内待行驶的至少一条路径。第二时间段位于第一时间段之后，第二时间段的时间长度为指定的第一时间长度，第二时间段内待行驶的至少一条路径中的每条路径的起始位置相同，该起始位置可能是控制器11从第一时间段内待行驶的至少一条路径中选择的一条路径的终点位置，第二时间段内待行驶的每条路径的长度是基于车辆1的运动信息和第一时间长度确定的。然后控制器11从第二时间段内待行驶的至少一条路径中选择一条路径，基于选择的一条路径，在第二时间段控制车辆1自动驾驶。路径规划模块14和控制器11重复上述过程，不断地控制车辆1自动驾驶。

例如，参见图2，假设，路径规划模块14根据接收的车辆1的环境信息和运动信息，规划出在第一时间段内待行驶的4条路径，该4条路径分别为路径1a、1b、1c和1d，该4条路径的起始位置相同。控制器11从该4条路径中选择了路径1a，根据选择的路径1a，在第一时间段内控制车辆1自动驾驶。

参见图3，路径规划模块14继续接收车辆1的环境信息和运动信息，并继续规划出在第二时间段待行驶的3条路径，该3条路径分别为路径2a、2b和2c，该3条路径的起始位置相同，均为路径1a的终点位置。控制器11从该3条路径中选择了路径2a，根据选择的路径2a，在第二时间段内控制车辆1自动驾驶。控制器11和路径规划模块14重复上述过程，实现控制车辆1自动驾驶。

可选的，车辆1周围可能包括障碍物，车辆1周围的环境信息可能包括该障碍物的类型和运动信息等。障碍物的运动信息包括障碍物的位置、运动速度、运动加速度和运动方向等中的至少一个。其中，对于处于静止状态的障碍物，该运动速度和运动加速度均为0。

车辆1的运动信息包括车辆1的位置、运动速度、运动加速度和运动方向等中的至少一个。

可选的，感知系统12包括至少一个感知传感器，该至少一个感知传感器包括摄像头和雷达等中的一个或多个。该雷达包括毫米波雷达、激光雷达和超声波雷达等中的一个或多个。

可选的，定位系统13为全球定位系统(global positioning system，GPS)或北斗导航系统等。

其中，需要说明的是：在控制器11按照选择的路径控制车辆1自动驾驶的过程中，选择的路径可能与用户的需求不同，此时用户可能直接使用车辆1的方向盘进行手动驾驶，在用户进行手动驾驶一段时间后，用户可能停止使用方向盘进行手动驾驶，再次需要控制器11从当前位置继续控制车辆1进行自动驾驶，为了便于说明称此时的当前位置为第一位置。

例如，参见图4，在控制器11按照选择的路径2a控制车辆1自动驾驶时，在行驶到路径2a上的位置31时，用户使用方向盘手动驾驶车辆1，使得车辆1偏离了路径2a并继续行驶。在行驶到位置32时，此时用户停止使用方向盘进行手动驾驶，位置32为第一位置，需要控制器11从第一位置32处继续控制车辆1进行自动驾驶。

其中，上述用户手动使用方向盘驾驶车辆1的模式称为手动驾驶模式，以及上述控制器11控制车辆1驾驶的模式称为自动驾驶模式。在车辆1退出手动驾驶模式并进入自动驾驶模式时，如何控制车辆1自动驾驶的详细实现过程，将通过如下任一实施例来实现。

参见图5，本申请实施例提供了一种自动驾驶的方法，该方法应用于图1所示的车辆，该方法可以由车辆中的控制器来执行，包括：

步骤501：在检测到车辆退出手动驾驶模式并进入自动驾驶模式时，获取N条路径，该N条路径是车辆在进入手动驾驶模式前已规划的路径，N为大于1的整数。

车辆在进入手动驾驶模式之前，车辆的驾驶模式为自动驾驶模式，车辆的路径规划模块规划出N条路径，车辆基于该N条路径中的一条路径进行自动驾驶。在自动驾驶的过程中，如果车辆行驶的路径与用户的需求不同，用户可以手动转动方向盘进行手动驾驶，此时车辆退出自动驾驶模式并进入手动驾驶模式。用户在手动驾驶一段时间后，停止使用方向盘进行手动驾驶，此时车辆退出手动驾驶模式并进入自动驾驶模式。

例如，参见图4，在车辆处于自动驾驶模式时，车辆的路径规划模块规划出3条路径，分别为路径2a、2b和2c，车辆基于该三条路径中的路径2a进行自动驾驶。在车辆自动驾驶到位置31时，用户手动转动方向盘进行手动驾驶，车辆进入手动驾驶模式。用户在手动驾驶到位置32时，停止使用方向盘进行手动驾驶，此时车辆退出手动驾驶模式并进入自动驾驶模式。

在本步骤中，需要检测车辆处于的驾驶模式，在检测到车辆退出手动驾驶模式并进入自动驾驶模式时执行本步骤。

其中，需要说明是：在车辆处于手动驾驶模式时，用户手动转动方向盘来驾驶车辆。用户在手动转动方向盘时，会改变方向盘的扭矩，使该方向盘的扭矩大小超过扭矩阈值；在车辆处于自动驾驶模式的情况下，用户不会转动方向盘，此时方向盘的扭矩大小为0或小于该扭矩阈值。因此，在步骤中列举了一种检测车辆的驾驶模式的实现实例，在实现实例中通过获取车辆的方向盘的扭矩大小，基于该扭矩大小检测车辆的驾驶模式。

可选的，该实现实例可以为：

在车辆处于自动驾驶模式的情况下，实时获取车辆的方向盘的扭矩大小，并对每次获取的方向盘的扭矩大小进行确定，在确定出方向盘的扭矩大小从小于扭矩阈值变为大于扭矩阈值时，确定车辆从自动驾驶模式进入手动驾驶模式。在车辆处于手动驾驶模式的情况下，也实时获取车辆的方向盘的扭矩大小，并对每次获取的方向盘的扭矩大小进行确定，在确定出方向盘的扭矩大小从大于扭矩阈值变为小于扭矩阈值时，确定车辆从手动驾驶模式进入自动驾驶模式。

该N条路径是车辆从自动驾驶模式进入手动驾驶模式之前，车辆的路径规划模块最近一次规划的路径。例如，参见图4，车辆在行驶到位置31时由自动驾驶模式进入手动驾驶模式，车辆的路径规划模块最近一次规划的路径包括路径2a、2b和2c。在用户手动驾驶到位置32时车辆由手动驾驶模式进入自动驾驶模式。因此，在本步骤中，在检测出车辆退出手动驾驶模式时，获取路径2a、2b和2c。

步骤502：获取该N条路径中的每条路径上的预瞄点，其中，第一路径上的预瞄点位于第一路径上，且是车辆在指定第二时间长度内待到达的位置，第一路径是该N条路径中的任一条路径。

其中，需要说明的是：在车辆进入手动驾驶模式之前，车辆基于该N条路径中的一条路径进行自动驾驶。在车辆处于手动驾驶模式时，用户使用车辆的方向盘驾驶车辆，用户手动驾驶车辆行驶的路径会偏离该条路径，所以车辆在退出手动驾驶模式时，车辆的当前位置可能不在该N条路径中的任一条路径上，为了便于说明称车辆退出手动驾驶模式时的当前位置为第一位置。

例如，参见图4，在车辆进入手动驾驶模式之前，车辆基于路径2a进行自动驾驶，在车辆处于手动驾驶模式时，用户驾驶车辆行驶的路径偏离了路径2a，所以车辆在退出手动驾驶模式时，车辆的第一位置32不在路径2a、2b和2c上。

由于第一位置不在该N条路径上，所以在车辆退出手动驾驶模式时，需要为车辆从该N条路径中选择一条路径，将车辆过渡到选择路径上，使车辆基于该选择的路径进行自动驾驶。而路径的预瞄点，就是期望车辆从第一位置过渡到该路径上的接入点位置。

其中，需要说明的是：如果第一位置在该N条路径中的某条路径上，则在车辆进入自动驾驶模式时，直接根据该条路径控制车辆进行自动驾驶。

在本步骤中，对于该N条路径中的任一条路径，即对于第一路径，根据车辆的运动信息确定第一路径上的预瞄点。在实现时，

获取车辆的运动信息和第一位置(即车辆的当前位置)，根据车辆的运动信息和第二时间长度，获取车辆在第二时间长度内行驶的距离；以第一位置为圆点并以该距离为半径，确定一个圆；对于第一路径，确定第一路径与该圆相交的一个或多个交点；如果该一个或多个交点中存在交点位于车辆的前方，则将位于车辆前方的交点确定为第一路径上的预瞄点；如果该一个或多个交点中没有交点位于车辆的前方，则将第一路径的终点位置确定为第一路径上的预瞄点。

可选的，通过车辆的定位系统获取车辆的运动信息，该运动信息包括车辆的运动速度、加速度和运动方向等。根据该车辆的运动速度和加速度，以及第二时间长度，获取车辆在第二时间长度内行驶的距离。

可选的，第一位置是在世界坐标系中的位置，在得到第一路径上的交点时，获取该交点在世界坐标系中的位置，根据第一位置和该交点的位置，可以确定该交点是否位于车辆的前方。

例如，参见图6，通过车辆1包括的定位系统获取车辆的第一位置32，以及获取车辆的运动速度、加速度和运动方向等运动信息。根据第二时间长度、车辆的运动速度和加速度，获取车辆在第二时间长度内行驶的距离。以第一位置32为圆点以该距离为半径，确定一个圆，对于路径2a，确定路径2a与该圆相交的交点L，该交点L没有位于车辆的前方，则将路径2a的终点位置K确定为路径2a上的预瞄点。对于路径2b，确定路径2b与该圆相交的交点G和H，该交点H位于车辆的前方，则将交点H确定为路径2b上的预瞄点。对于路径2c，确定路径2c与该圆相交的交点E和F，该交点F位于车辆的前方，则将交点F确定为路径2c上的预瞄点。

可选的，在执行本步骤之前，确定包括该N条路径的区域。可选的，该区域为包括该N条路径的最小区域。在第一位置位于该区域中，执行本步骤。即在第一位置位于该区域中，获取N个路径中的每条路径上的预瞄点。在第一位置位于该区域外，通过车辆的路径规划模块规划待行驶的至少一条路径，根据至少一条路径控制车辆自动驾驶。

可选的，从该至少一条路径选择一条路径，基于选择的一条路径控制车辆自动驾驶。

其中，该N条路径是路径规划模块基于车辆周围的环境信息规划的，路径规划模块规划的路径都是比较安全的，车辆基于规划的任一条路径自动驾驶时不会与车辆周围的障碍物发生碰撞，该障碍物为其他车辆或行人等。该区域为该N条路径共同包围的区域，所以在该区域内可能不会有障碍物存在，因此当第一位置位于该区域内，在该区域内控制车辆过度到该N条路径的某条路径上，车辆不会与障碍物碰撞，提高了自动驾驶的安全性。

而当第一位置位于该区域外，即车辆位于该区域外，如此需要控制车辆从该区域外过度到该N条路径中的某条路径上，位于该区域外可能有障碍物，这样车辆从第一位置过度到该N条路径中的某条路径时，可能与障碍物发生碰撞。所以为了避免此情况发生，以提高自动驾驶的安全性。在第一位置位于该区域外，直接通过路径规划模块根据感知系统感知车辆周围的环境信息和定位系统获取车辆的运动信息，规划至少一条路径，基于该至少一条路径自动驾驶。

例如，参见图6，确定包括路径2a、2b和2c的最小区域为区域NMJKN，其中第一位置32位于该最小区域NMJKN，则通过本步骤获取位于路径2a上的预瞄点K，位于路径2b上的预瞄点H和位于路径2c上的预瞄点F。

步骤503：根据每条路径的预瞄点和车辆的行驶方向，分别获取每条路径的平滑误差。

对于该N条路径中的任一条路径，即对于第一路径，根据第一路径上的预瞄点和车辆的行驶方向，获取第一路径的平滑误差，第一路径的平滑误差用于指示车辆从第一位置过渡到第一路径的平稳程度。

在本步骤中，可以通过如下5031至5032获取第一路径的平滑误差，该5031至5032分别为：

5031：对于第一路径上的预瞄点，将该预瞄点映射到车辆的车辆坐标系中，得到该预瞄点在车辆坐标系中的横向坐标。

可选的，预瞄点的横向坐标的绝对值等于车辆从第一位置到达预瞄点的横向偏移。

在本操作中，确定车辆坐标系，车辆坐标系以车辆包括的目标点的位置作为坐标原点，以车头的朝向方向为x轴，以与车头朝向垂直的方向为y轴。根据目标点在世界坐标系中的位置，确定车辆坐标系与世界坐标系之间的转换关系，基于该转换关系，将该预瞄点映射到车辆的车辆坐标系中，得到第一路径上的预瞄点在车辆坐标系中的横向坐标。

可选的，目标点为车辆的后轴中心、车辆的中心或车辆的前轴中心等。

例如，参见图7，假设目标点为车辆的后轴中心33，以目标点33的位置作为坐标原点，以车头的朝向方向为x轴，以与车头朝向垂直的方向为y轴。获取目标点33在世界坐标系中的位置，基于目标点的位置确定车辆坐标系与世界坐标系之间的转换关系。对于路径2a的预瞄点K，基于该转换关系，将该预瞄点K映射到车辆的车辆坐标系中，得到路径2a上的预瞄点K在车辆坐标系中的横向坐标xa。对于路径2b的预瞄点H，基于该转换关系，将该预瞄点H映射到车辆的车辆坐标系中，得到路径2b上的预瞄点H在车辆坐标系中的横向坐标xb。对于路径2c的预瞄点F，基于该转换关系，将该预瞄点F映射到车辆的车辆坐标系中，得到路径2c上的预瞄点F在车辆坐标系中的横向坐标xc。

5032：根据该横向坐标，以及车辆的行驶方向与第一切线之间的夹角，获取第一路径的平滑误差，第一切线为第一路径在该预瞄点处的切线。

对于第一路径上的预瞄点，确定第一切线，第一切线为第一路径在该预瞄点处的切线，获取车辆的行驶方向与第一切线之间的夹角，根据该横向坐标的绝对值，以及车辆的行驶方向与第一切线之间的夹角，获取第一路径的平滑误差。

可选的，该夹角反应了车辆在过滤到该预瞄点所需要转动的角度，且车辆到达该预瞄点时，车辆的行驶方向与第一切线平行。

可选的，由于第一路径是路径规划模块规划出的路径，所以可以获取第一路径在其预瞄点处的曲率，基于该曲率可以确定第一路径在该预瞄点处的第一切线的方向。而车辆的行驶方向，可以通过车辆的定位系统实时获取到。基于第一切线的方向和车辆的行驶方向，可以获取车辆的行驶方向与第一切线之间的夹角。

可选的，按如下第一公式，获取第一路径的平滑误差。

第一公式为：err＝a*|x|+b*θ

在第一公式中，err为第一路径的平滑误差，x为预瞄点的横向坐标，θ为该夹角，a和b为两个权重。

例如，参见图7，对于路径2a上的预瞄点K，确定路径2a在预瞄点K处的第一切线34，获取车辆的行驶方向与第一切线34之间的夹角，根据该预瞄点的横向坐标xa，以及车辆的行驶方向与第一切线34之间的夹角，获取路径2a的平滑误差。对于路径2b上的预瞄点H，确定路径2b在预瞄点H处的第一切线35，获取车辆的行驶方向与第一切线35之间的夹角，根据该预瞄点的横向坐标xb，以及车辆的行驶方向与第一切线35之间的夹角，获取路径2b的平滑误差。对于路径2c上的预瞄点F，确定路径2c在预瞄点F处的第一切线36，获取车辆的行驶方向与第一切线36之间的夹角，根据该预瞄点F的横向坐标xc，以及车辆的行驶方向与第一切线36之间的夹角，获取路径2c的平滑误差。

步骤504：根据该N个路径的平滑误差，从N个路径中选择一个路径作为第二路径。

可选的，根据该N个路径的平滑误差，从N个路径中选择平滑误差最小的一个路径作为第二路径。

例如，根据路径2a的平滑误差，路径2b的平滑误差和路径2c的平滑误差，从路径2a、路径2b和路径2c中选择路径2b。

由于第二路径的平滑误差最小，而第二路径的平滑误差用于指示车辆从第一位置过渡到第二路径的平稳程度，所以控制车辆过度到选择的第二路径最平稳，所需要转动车辆的行驶方向的角度最小。例如，参见图7，选择路径2b的平滑误差最小，控制车辆从第一位置32过度到选择路径2b的预瞄点H所需要的转动车辆的行驶方向的角度最小。所以从第一位置过度到路径2b最平稳，最安全。

步骤505：根据第二路径，控制车辆自动驾驶。

在本步骤中，控制车辆从第一位置自动驾驶至第二路径的预瞄点上，且第二路径的预瞄点处车辆的行驶方向与第一切线平行，该第一切线为第二路径在该预瞄点处的切线。控制第二路径控制车辆从该预瞄点继续自动驾驶。

例如，控制车辆从第一位置32自动驾驶至路径2b的预瞄点H，且在预瞄点H处车辆的行驶方向与路径2b在预瞄点H的切线35平行。

可选的，还能够获取第四路径的路径参数，第四路径是在使用手动驾驶模式的时间段内车辆行驶的路径，这样使车辆的路径规划模块基于该路径参数，规划车辆在行驶完第二路径之后待行驶的至少一条路径。从该至少一条路径中选择一条路径，在行驶完第二路径后，基于选择一条路径控制车辆继续自动驾驶。

可选的，该第四路径的路径参数包括第四路径的曲率和平滑程序等至少一个。

可选的，在步骤502中，在第一位置不在包括N条路径的区域内时，也可以获取第四路径的路径参数，使车辆的路径规划模块基于该路径参数，规划至少一条路径，从该至少一条路径中选择一条路径，基于选择一条路径控制车辆继续自动驾驶。

第四路径是用户手动驾驶车辆行驶的路径，所以第四路径的路径参数用于反应用户的驾驶习惯，因此路径规划模块在基于车辆的环境信息和运动信息规划路径时，引入第四路径的路径参数，这样路径规划模块基于车辆的环境信息和运动信息，以及第四路径的路径参数，能够规划出符合用户驾驶习惯的路径。

可选的，在路径规划模块规划出至少一条路径后，获取该至少一条路径中的每条路径的代价参数，路径的代价参数用于反应用户的驾驶风格和习惯等中的至少一个，根据每条路径的代价参数，选择一条路径。

可选的，在路径规划模块规划出至少一条路径后，还可显示该至少一条路径；以让用户选择满足自己需求的路径。

相应的，在检测到用户对第三路径的选择操作时，获取第三路径，第三路径是至少一条路径中的一条路径；根据第三路径控制所述车辆自动驾驶。

在本申请实施例中，在从手动驾驶模式进入自动驾驶模式时，获取在进入手动驾驶模式之前已规划的N条路径，确定包括该N条路径的区域，在车辆的当前位置位于该区域内才获取该N条路径中的每条路径的平滑误差，根据每条路径的平滑误差选择一条路径作为第二路径，这样便根据第二路径控制车辆自动驾驶，从而不需要停车重启自动驾驶模式，提高了自动驾驶的效率。另外，由于在车辆的当前位置位于该区域内才选择第二路径，这样可以提高了驾驶安全性。由于路径的平滑误差用于指示车辆从第一位置过渡到第一路径的平稳程度，又由于基于平滑误差选择的第二路径，所以能够控制车辆较平滑地从第一位置过渡到第二路径，提高了自动驾驶的舒适性和安全性。

参见图8，本申请实施例提供了一种控制车辆的装置800，所述装置800可部署在上述图1或图5所示实施例的车辆控制器上，包括：

处理单元801，用于在检测到车辆退出手动驾驶模式时，获取N条路径的平滑误差，该N条路径是车辆在进入手动驾驶模式前已规划的路径，N为大于1的整数，第一路径的平滑误差用于指示车辆从第一位置过渡到第一路径的平稳程度，第一位置是车辆当前的位置，第一路径是该N条路径中的任一条；根据该N条路径的平滑误差，从该N条路径中选择一条路径作为第二路径。

控制单元802，用于根据第二路径，控制车辆自动驾驶。

可选的，处理单元801获取N条路径的平滑误差的详细实现过程，可以参见图5所示实施例中的步骤501至503中的相关内容，在此不再详细说明。

可选的，处理单元801选择第二路径的详细实现过程，，可以参见图5所示实施例中的步骤504中的相关内容，在此不再详细说明。

控制单元802控制车辆自动驾驶的详细实现过程，可以参见图5所示实施例中的步骤505至503中的相关内容，在此不再详细说明。

可选的，处理单元801，用于：

根据车辆的运动信息确定预瞄点，预瞄点是车辆在指定时间长度内待到达的位置，预瞄点位于第一路径上；

根据预瞄点和车辆的行驶方向，获取第一路径的平滑误差。

可选的，处理单元801获取第一路径的平滑误差的详细实现过程，可以参见图5所示实施例中的步骤5031至5032中的相关内容，在此不再详细说明。

可选的，处理单元801，用于：

将预瞄点映射到车辆的车辆坐标系中，得到预瞄点在车辆坐标系中的横向坐标；

根据横向坐标，以及车辆的行驶方向与第一切线之间的夹角，获取第一路径的平滑误差，第一切线为第一路径在预瞄点处的切线。

可选的，处理单元801，用于确定包括N条路径的区域；在第一位置位于该区域中，获取N条路径的平滑误差。

可选的，处理单元801，还用于：

在第一位置位于该区域外，通过车辆的路径规划模块规划待行驶的至少一条路径，根据至少一条路径控制车辆自动驾驶。

可选的，所述装置800还包括：显示单元803，

显示单元803，用于显示该至少一条路径；

控制单元802，用于：

在检测到用户对第三路径的选择操作时，获取第三路径，第三路径是该至少一条路径中的一条路径；根据第三路径控制车辆自动驾驶。

可选的，处理单元801，还用于：

获取第四路径的路径参数，第四路径是在使用手动驾驶模式的时间段内车辆行驶的路径，该路径参数用于车辆的路径规划模块基于该路径参数，规划车辆在行驶完第二路径之后待行驶的至少一条路径。

应理解的是，本申请实施例的装置800可以通过专用集成电路(application-specific integrated circuit，ASIC)实现，或可编程逻辑器件(programmable logicdevice，PLD)实现，上述PLD可以是复杂程序逻辑器件(complex programmable logicaldevice，CPLD)，现场可编程门阵列(field-programmable gate array，FPGA)，通用阵列逻辑(generic array logic，GAL)或其任意组合。也可以通过软件实现图5所示的控制车辆的方法时，所述装置800及其各个模块也可以为软件模块。

根据本申请实施例的装置800可对应于执行本申请实施例中描述的方法，并且所述装置800中的各个单元的上述和其它操作和/或功能分别为了实现图5中的各个方法的相应流程，为了简洁，在此不再赘述。

在本申请实施例中，处理单元在从手动驾驶模式进入自动驾驶模式时，获取在进入手动驾驶模式之前已规划的N条路径中的每条路径的平滑误差，根据每条路径的平滑误差选择一条路径作为第二路径，这样便控制单元根据第二路径控制车辆自动驾驶，从而不需要停车重启自动驾驶模式，提高了自动驾驶的效率。另外，由于路径的平滑误差用于指示车辆从第一位置过渡到第一路径的平稳程度，又由于处理单元基于平滑误差选择的第二路径，所以控制单元能够控制车辆较平滑地从第一位置过渡到第二路径，提高了自动驾驶的舒适性和安全性。

参见图9，本申请实施例提供了一种控制车辆的控制器900示意图。该控制器900可以是上述任一实施例中的控制器，例如该控制器900为图1所示实施例或图5所示实施例中的控制器。该控制器900包括至少一个处理器901，内存单元902，存储介质903、通信接口904和总线系统905。其中，处理器901、内存单元902、存储介质903、通信接口904通过总线系统905进行通信。

处理器901可以调用内存单元902中存储的计算机执行指令(例如，程序代码)实现图5所示实施例中控制器执行的操作步骤。例如，在检测到车辆退出手动驾驶模式时，获取N条路径的平滑误差，该N条路径是车辆在进入手动驾驶模式前已规划的路径，N为大于1的整数，第一路径的平滑误差用于指示车辆从第一位置过渡到第一路径的平稳程度，第一位置是车辆当前的位置，第一路径是N条路径中的任一条；根据N条路径的平滑误差，从N条路径中选择一条路径作为第二路径；根据第二路径，控制车辆自动驾驶。

可选的，存储介质903中存储该计算机执行指令和操作系统，在该装置900启动运行时，处理器901可以将存储介质903存储的该计算机执行指令和操作系统加载到内存单元902中，并在操作系统提供的运行环境中调用并运行内存单元902中的该计算机执行指令。

可选的，上述处理器901可以是一个CPU，微处理器，特定应用集成电路(application-specific integrated circuit，ASIC)，或一个或多个用于控制本申请方案程序执行的集成电路。作为一种实施例，处理器901可以包括一个或多个CPU，例如图9中的CPU0和CPU1。该处理器901还可以是其他通用处理器、数字信号处理器(digital signalprocessing，DSP)、专用集成电路(ASIC)、现场可编程门阵列(FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者是任何常规的处理器等。

该控制器900中总线系统905除包括数据总线之外，还可以包括电源总线、控制总线和状态信号总线等。但是为了清楚说明起见，在图中将各种总线都标为总线系统905。

上述通信接口904，用于与其他设备通信。例如，处理器901通过通信接口904与感知系统和定位系统进行通信，处理器901通过通信接口904与感知系统和定位系统进行通信，以获取到移动物体周围的障碍物的位置和运动属性信息。

该存储介质903可以是易失性存储器或非易失性存储器，或可包括易失性和非易失性存储器两者。其中，非易失性存储器可以是只读存储器(read-only memory，ROM)、可编程只读存储器(programmable ROM，PROM)、可擦除可编程只读存储器(erasable PROM，EPROM)、电可擦除可编程只读存储器(electrically EPROM，EEPROM)或闪存。易失性存储器可以是随机存取存储器(random access memory，RAM)，其用作外部高速缓存。通过示例性但不是限制性说明，许多形式的RAM可用，例如静态随机存取存储器(static RAM，SRAM)、动态随机存取存储器(DRAM)、同步动态随机存取存储器(synchronous DRAM，SDRAM)、双倍数据速率同步动态随机存取存储器(double data date SDRAM，DDR SDRAM)、增强型同步动态随机存取存储器(enhanced SDRAM，ESDRAM)、同步连接动态随机存取存储器(synchlinkDRAM，SLDRAM)和直接内存总线随机存取存储器(direct rambus RAM，DR RAM)。

该总线905除包括数据总线之外，还可以包括电源总线、控制总线、状态信号总线、车内总线(例如控制器局域网络(controller area network，CAN)总线)等。但是为了清楚说明起见，在图中将各种总线都标为总线305。

应理解，根据本申请实施例的控制器900可对应于本申请实施例中的装置800，并可以对应于执行根据本申请实施例图5中的相应主体，并且控制器900中的各个模块的上述和其它操作和/或功能分别为了实现图5中的各个方法的相应流程，为了简洁，在此不再赘述。

本申请还提供一种车辆，该车辆包括图9所示的控制器900，该控制器900用于执行上述图5中各个方法中相应主体的操作步骤，为了简洁，在此不再赘述。

上述实施例，可以全部或部分地通过软件、硬件、固件或其他任意组合来实现。当使用软件实现时，上述实施例可以全部或部分地以计算机程序产品的形式实现。所述计算机程序产品包括一个或多个计算机指令。在计算机上加载或执行所述计算机程序指令时，全部或部分地产生按照本申请实施例所述的流程或功能。所述计算机可以为通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算机指令可以存储在计算机可读存储介质中，或者从一个计算机可读存储介质向另一个计算机可读存储介质传输，例如，所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(DSL))或无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据中心进行传输。所述计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集合的服务器、数据中心等数据存储设备。所述可用介质可以是磁性介质(例如，软盘、硬盘、磁带)、光介质(例如，DVD)、或者半导体介质。半导体介质可以是固态硬盘(solid state drive，SSD)。

本领域普通技术人员可以理解实现上述实施例的全部或部分步骤可以通过硬件来完成，也可以通过程序来指令相关的硬件完成，所述的程序可以存储于一种计算机可读存储介质中，上述提到的存储介质可以是只读存储器，磁盘或光盘等。

以上所述仅为本申请的可选实施例，并不用以限制本申请，凡在本申请的原则之内，所作的任何修改、等同替换、改进等，均应包含在本申请的保护范围之内。

Claims (12)

1.一种控制车辆的方法，其特征在于，所述方法包括：

在检测到车辆退出手动驾驶模式时，获取N条路径的平滑误差，所述N条路径是所述车辆在进入所述手动驾驶模式前已规划的路径，N为大于1的整数，第一路径的平滑误差用于指示所述车辆从第一位置过渡到所述第一路径的平稳程度，所述第一位置是所述车辆当前的位置，所述第一路径是所述N条路径中的任一条；

根据所述N条路径的平滑误差，从所述N条路径中选择一条路径作为第二路径；

根据所述第二路径，控制所述车辆自动驾驶；

其中，获取所述第一路径的平滑误差，包括：

根据所述车辆的运动信息确定预瞄点，所述预瞄点是所述车辆在指定时间长度内待到达的位置，所述预瞄点位于所述第一路径上；

将所述预瞄点映射到所述车辆的车辆坐标系中，得到所述预瞄点在所述车辆坐标系中的横向坐标；

根据所述横向坐标，以及所述车辆的行驶方向与第一切线之间的夹角，获取所述第一路径的平滑误差，所述第一切线为所述第一路径在所述预瞄点处的切线。

2.如权利要求1所述的方法，其特征在于，所述获取N条路径的平滑误差之前，还包括：

确定包括所述N条路径的区域；

所述获取N条路径的平滑误差，包括：

在所述第一位置位于所述区域中，获取N条路径的平滑误差。

3.如权利要求2所述的方法，其特征在于，所述方法还包括：

在所述第一位置位于所述区域外，通过所述车辆的路径规划模块规划待行驶的至少一条路径，根据所述至少一条路径控制所述车辆自动驾驶。

4.如权利要求3所述的方法，其特征在于，所述方法还包括：

显示所述至少一条路径；

所述根据所述至少一条路径控制所述车辆自动驾驶，包括：

在检测到用户对第三路径的选择操作时，获取所述第三路径，所述第三路径是所述至少一条路径中的一条路径；

根据所述第三路径控制所述车辆自动驾驶。

5.如权利要求1至4任一项所述的方法，其特征在于，所述方法还包括：

获取第四路径的路径参数，所述第四路径是在使用手动驾驶模式的时间段内所述车辆行驶的路径，所述路径参数用于所述车辆的路径规划模块基于所述路径参数，规划所述车辆在行驶完所述第二路径之后待行驶的至少一条路径。

6.一种控制车辆的装置，其特征在于，所述装置包括：

处理单元，用于在检测到车辆退出手动驾驶模式时，获取N条路径的平滑误差，所述N条路径是所述车辆在进入所述手动驾驶模式前已规划的路径，N为大于1的整数，第一路径的平滑误差用于指示所述车辆从第一位置过渡到所述第一路径的平稳程度，所述第一位置是所述车辆当前的位置，所述第一路径是所述N条路径中的任一条；根据所述N条路径的平滑误差，从所述N条路径中选择一条路径作为第二路径；

控制单元，用于根据所述第二路径，控制所述车辆自动驾驶；

其中，所述处理单元，用于：

根据所述车辆的运动信息确定预瞄点，所述预瞄点是所述车辆在指定时间长度内待到达的位置，所述预瞄点位于所述第一路径上；

将所述预瞄点映射到所述车辆的车辆坐标系中，得到所述预瞄点在所述车辆坐标系中的横向坐标；

根据所述横向坐标，以及所述车辆的行驶方向与第一切线之间的夹角，获取所述第一路径的平滑误差，所述第一切线为所述第一路径在所述预瞄点处的切线。

7.如权利要求6所述的装置，其特征在于，所述处理单元，用于确定包括所述N条路径的区域；在所述第一位置位于所述区域中，获取N条路径的平滑误差。

8.如权利要求7所述的装置，其特征在于，所述处理单元，还用于：

在所述第一位置位于所述区域外，通过所述车辆的路径规划模块规划待行驶的至少一条路径，根据所述至少一条路径控制所述车辆自动驾驶。

9.如权利要求8所述的装置，其特征在于，所述装置还包括：显示单元，

所述显示单元，用于显示所述至少一条路径；

所述控制单元，用于：

在检测到用户对第三路径的选择操作时，获取所述第三路径，所述第三路径是所述至少一条路径中的一条路径；

根据所述第三路径控制所述车辆自动驾驶。

10.如权利要求6至9任一项所述的装置，其特征在于，所述处理单元，还用于：

获取第四路径的路径参数，所述第四路径是在使用手动驾驶模式的时间段内所述车辆行驶的路径，所述路径参数用于所述车辆的路径规划模块基于所述路径参数，规划所述车辆在行驶完所述第二路径之后待行驶的至少一条路径。

11.一种车辆，其特征在于，所述车辆包括如权利要求6至10任一项所述的装置。

12.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质中存储有指令，当所述指令被处理器运行时，使得所述处理器执行如权利要求1至5任一项所述的方法。