[发明专利]用于检测拖车角度的系统和方法

权利要求书

1.一种用于牵引车和拖车的车载控制系统，包括：

光学传感器，被配置成被安装在所述牵引车上并生成指示所述拖车与所述牵引车之间所形成的角度的光学数据；

处理器；以及

计算机可读存储器，与所述处理器通信并且具有存储在其上的计算机可执行指令，以使所述处理器执行以下操作：

接收所述光学数据，

确定表示所述拖车的表面的至少一个候选平面，所述候选平面在所述光学数据中可见，以及

至少基于所述至少一个候选平面来确定所述拖车与所述牵引车之间的所述角度。

2.根据权利要求1所述的系统，其中所述光学传感器被定位成面向所述拖车。

3.根据权利要求1所述的系统，其中所述光学传感器包括LiDAR检测器，所述LiDAR检测器被配置成生成指示所述拖车的可见表面的空间位置的所述光学数据。

4.根据权利要求1所述的系统，其中所述光学传感器包括相机，所述相机被配置成生成包括所述拖车上的标记物的表示的图像。

5.根据权利要求4所述的系统，其中所述标记物是快速响应(QR)码。

6.根据权利要求1所述的系统，其中所述光学数据包括点云数据，所述点云数据包括表示所述拖车的表面在空间中的地点的一组数据点。

7.根据权利要求6所述的系统，其中所述存储器具有存储在其上的计算机可执行指令，以使所述处理器执行以下操作：

从属于所述拖车的所述点云中提取点，以及

从提取到的所述点中去除属于所述拖车的边缘区域的点，

其中确定所述至少一个候选平面基于提取到的所述点被执行，属于所述拖车的所述边缘区域的点从提取到的所述点中被去除。

8.根据权利要求1所述的系统，其中所述存储器具有存储在其上的计算机可执行指令，以使所述处理器执行以下操作：

使用期望最大化框架完善所述至少一个候选平面，所述期望最大化框架包括以下多个重复：i)包括确定映射函数的期望步骤以及ii)包括优化目标函数的最大化步骤。

9.一种非暂态计算机可读存储介质，具有存储在其上的指令，所述指令在被执行时使至少一个计算设备执行以下操作：

接收来自光学传感器的光学数据，所述光学传感器被配置成被安装在牵引车上并生成指示拖车与所述牵引车之间所形成的角度的所述光学数据；

确定表示所述拖车的表面的至少一个候选平面，所述候选平面在所述光学数据中可见；以及

至少基于所述至少一个候选平面来确定所述拖车与所述牵引车之间的所述角度。

10.根据权利要求9所述的非暂态计算机可读存储介质，其中所述光学传感器被定位成面向所述拖车。

11.根据权利要求9所述的非暂态计算机可读存储介质，其中所述光学传感器包括LiDAR检测器，所述LiDAR检测器被配置成生成指示所述拖车的可见表面的空间位置的所述光学数据。

12.根据权利要求9所述的非暂态计算机可读存储介质，其中所述光学传感器包括相机，所述相机被配置成生成包括所述拖车上的标记物的表示的图像。

13.根据权利要求11所述的非暂态计算机可读存储介质，其中所述标记物是快速响应(QR)码。

14.根据权利要求9所述的非暂态计算机可读存储介质，其中所述光学数据包括点云数据，所述点云数据包括表示所述拖车的表面在空间中的地点的一组数据点。