具体实施方式

铰接车辆转向控制方法实施例：

铰接车辆转向控制方法的主要构思在于，对于铰接车辆转向时，出现前车体和后车体不在一条直线上的情况，通过建立前车体和后车体统一的坐标系，可以准确的对整车的目标区域进行划分，提高了铰接车辆转向控制的安全性。

具体的，铰接车辆转向控制方法，如图1所示，包括以下步骤：

1)铰接车辆转向时，获取前车体和后车体的铰接角、以及障碍物信息。

本步骤中，障碍物信息为通过激光雷达扫描周围的环境得到点云数据，对点云数据进行处理得到障碍物的位置、速度、形状等信息，并且这里的信息为车辆坐标系下(这里的车辆坐标系可以为前车体坐标系，也可以为后车体坐标系，由铰接车辆设定而定)的激光雷达能扫描到的全部障碍物信息；

前车体和后车体的铰接角γ可以通过转角传感器获得，或者为了铰接角γ更加准确可以通过实时计算得出，铰接角γ的获取为现有技术，这里不做过多赘述。

2)在实施步骤1)的同时，确定一个转向坐标系。

转向坐标系即为前车体和后车体统一的坐标系，如图2所示，根据前车体的坐标系和后车体的坐标系得到，前车体的坐标系o-x-y以前车体中心点为坐标原点o，前车体纵向行驶的方向为y轴，前车体横向行驶的方向为x轴；后车体的坐标系以后车体中心点为坐标原点，后车体的纵向行驶方向为y轴，后车体的横向行驶方向为x轴；转向坐标系o1-x1-y1的坐标原点o1为前车体中心点横向延长线和后车体中心点横向延长线的交点；后车体中心点与坐标原点o1连线形成横坐标x1，与横坐标x1垂直且朝向铰接车辆行驶方向的形成纵坐标y1。

3)根据步骤1)中得到的铰接角确定前车体的转向半径和后车体的转向半径。

图2中，γ为前车体和后车体的铰接角，N为铰接点，L_f为前车体到铰接点的距离，L_r为后车体到铰接点的距离，γ_f为前车体航向角，γ_r为后车体航向角，通过几何关系计算出前车体的转向半径R_f和后车体的转向半径R_r：

R_f＝(L_f*cosγ+L_r)/(sinγ)；

R_r＝(L_f+L_r*cosγ)/(sinγ)；

同时可以计算得到前车体中心点在转向坐标系下的坐标(f_cx，f_cy)和后车体中心点在转向坐标系下的坐标(r_cx，r_cy)：

f_cx＝R_f*cos(γ)；

f_cy＝R_f*sin(γ)；

r_cx＝R_r；

r_cy＝0。

4)根据步骤3)中得到的前车体的转向半径确定最小半径；根据步骤3)中得到的后车体的转向半径确定最大半径，根据最小半径和最大半径确定目标区域。

目标区域即为影响铰接车辆转向行驶的障碍物所在的区域，也可以说是一个范围，那么需要找出这个范围的边界以准确的划分出目标区域；

边界对应的即为铰接车辆转向时，以转向坐标系的坐标原点为原点的最小半径和最大半径扫过的区域边界，将最小半径扫过的扇形区域和最大半径扫过的扇形区域之间的扇环区域确定为目标区域。

最大半径和最小半径可以通过计算得出，如图3所示，图中W_f为前车体宽度，W_r为后车体宽度，则目标区域对应的最小半径R_in和最大半径R_out为：

R_in＝R_f-W_f/2；

R_out＝R_r+W_r/2；

实际计算过程中可根据实际场景通过最大半径、最小半径调整扇环区域的大小。

5)将步骤1)中获取的障碍物信息转换到转向坐标系，从而定位在目标区域中的障碍物或障碍物部分。

为了准确的进行后续的步骤，将障碍物信息进行坐标转换，从车辆坐标系转换为转向坐标系，通常是将障碍物的位置信息进行坐标转换，例如：车辆坐标系下障碍物的坐标为(X，Y)，按照运动学关系转化为转向坐标系下的坐标为(x_o，y_o)，转换关系如下：

当γ＞0时，x_o＝-X*sin(γ)-Y*cos(γ)+f_cx；

y_o＝X*cos(γ)-Y*sin(γ)+f_cy；

当γ＜0时，x_o＝-(-X*sin(γ)+Y*cos(γ)+f_cx；

y_o＝X*cos(γ)+Y*sin(γ)+f_cy。

为了对步骤1)中得到的全部障碍物信息进行过滤，定位目标区域中的障碍物和障碍物部分，将转向坐标系下的障碍物信息进行分割，分割的思路为，求出目标区域的曲线方程和障碍物的直线方程的交点，这些交点即为切割的分界线，具体如下：

利用上述得出的最小半径R_in和最大半径R_out得到目标区域以转向坐标的坐标原点为圆心的内圈和外圈的曲线方程；

x²+y²＝R_in²；

x²+y²＝R_out²；

内圈对应附图4、图5的A曲线，外圈对应附图4、图5的B曲线，图中obs1、obs2、obs3、obs4、obs5是激光雷达获取的不同形状的障碍物信息，每个障碍物对应有4个顶点，通过四个顶点信息求出障碍物的4条边的直线方程，两点确定一条直线，例如：点(x1,y1)，点(x2,y2)确定的直线方程为：

(y-y2)/(y1-y2)＝(x-x2)/(x1-x2)；

求得内、外圈的曲线和直线方程的交点，将得到的交点替换目标区域外的点，进而定位目标区域中的障碍物和障碍物部分。例如：障碍物obs1在转向坐标系下四个顶点坐标为m1(-24,4)，m2(-24,6)，m3(-17,6)，m4(-17,4)，则目标区域中的障碍物obs1部分的顶点坐标为n1(-21.63,4)，n2(-21.17,6)，n3(-19.08,6)，n4(-19.6,4)。

6)根据步骤5)中的目标区域中的障碍物或障碍物部分进行铰接车辆转向的控制。

从附图4和附图5看出，障碍物的形状各不相同并且有一定的大小，因此需要找出障碍物中离铰接车辆最近的点，以最近的点的位置信息为判断车辆转向控制的依据，具体为：

a.计算目标区域中的障碍物或障碍物部分的边界点距离铰接车辆的弧长，由于障碍物一般在铰接车辆的前方，那么距离铰接车辆的弧长也即距离前车体的弧长。以转向坐标系下的某个点的坐标为(x_o，y_o)，半径为为例说明弧长的求解过程，某个点(x_o，y_o)到与前车体的夹角θ＝cos^-1((x_o*R+y_o*0)/(R*R))，则该点到前车体的弧长D＝R*θ；

b.得到所有边界点距离铰接车辆的弧长后，找出弧长最小值对应的点，并且根据该点的弧长计算出该点距离铰接车辆的实际横向距离L_lat、实际纵向距离L_lon：

L_lon＝min(D)

L_lat＝R_min(D)-R_veh

其中：L_lat有正有负，为正表示障碍物最近点在车辆左侧，为负表示障碍物最近点在车辆右侧。

c.根据得到的实际横向距离L_lat和实际纵向距离L_lon进行铰接车辆转向的控制，铰接车辆转向的控制包括停车制动、避障换道和避障返回；

设定最小横向距离(即横向距离下限)为Lat_min，最小纵向距离(即纵向距离下限)为Lon_min，若L_lon<Lon_min，控制铰接车辆停车制动；若L_lon>Lon_min、且L_lat>Lat_min、且满足在本车道行驶时，控制铰接车辆避障返回；若L_lon>Lon_min、且L_lat>Lat_min、且不满足本车道行驶时，控制铰接车辆避障换道。

上述实施例中，步骤1)中通过激光雷达获取障碍物的第一信息，作为其他实施方式，也可以采用超声波传感器、红外传感器获取障碍物的第一信息，本发明对此不做限制。

上述实施例中，对于步骤4)中目标区域的最小半径和最大半径是根据前车体宽度和后车体宽度计算得到的，可以更好的满足车辆的需求，作为其他实施方式，也可以根据需要进行设定，比如为了避免移动的障碍物对车辆控制的影响，将目标区域进行扩大等。

上述实施例中，步骤6)中为了控制的准确性，将障碍物信息距离铰接车辆最近的点找出，作为其他实施方式，在障碍物非常小的情况下，也可以任选障碍物的其中一个点作为车辆控制的依据，本发明对此不做限制。

本发明通过统一前车体和后车体的坐标系，解决了车辆不在一条直线上行驶时的准确的目标区域的划分，从而引导车辆做出正确的行为决策，提高车辆转向控制的安全性。

铰接车辆转向控制装置实施例：

铰接车辆转向控制装置，如图6所示，包括处理器、存储器以及存储在所述存储器中并可在处理器上运行的计算机程序，所述处理器在执行所述计算机程序时实现铰接车辆转向控制方法。

铰接车辆转向控制方法的具体实施过程以及效果在上述铰接车辆转向控制方法实施例中介绍，这里不做赘述。

也就是说，以上铰接车辆转向控制方法实施例中的方法应理解可由计算机程序指令实现方法的流程。可提供这些计算机程序指令到处理器(如通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备等)，使得通过处理器执行这些指令产生用于实现上述方法流程所指定的功能。

本实施例所指的处理器是指微处理器MCU或可编程逻辑器件FPGA等的处理装置；

本实施例所指的存储器用于存储实现铰接车辆转向控制方法而形成的计算机程序指令，包括用于存储信息的物理装置，通常是将信息数字化后再以利用电、磁或者光学等方式的媒体加以存储。例如：利用电能方式存储信息的各式存储器，RAM、ROM等；利用磁能方式存储信息的的各式存储器，硬盘、软盘、磁带、磁芯存储器、磁泡存储器、U盘；利用光学方式存储信息的各式存储器，CD或DVD。当然，还有其他方式的存储器，例如量子存储器、石墨烯存储器等等。

通过上述存储有实现铰接车辆转向控制方法而形成的计算机程序指令的存储器、处理器构成的铰接车辆转向控制装置，在计算机中由处理器执行相应的程序指令来实现，计算机可使用windows操作系统、linux系统、或其他，例如使用android、iOS系统程序设计语言在智能终端实现，以及基于量子计算机的处理逻辑实现等。

作为其他实施方式，铰接车辆转向控制装置还可以包括其他的处理硬件，如数据库或多级缓存、GPU等，本发明并不对铰接车辆转向控制装置的结构做具体的限定。