[发明专利]无人驾驶车辆对位方法、系统、设备及存储介质

摘要

本发明提供了无人驾驶车辆对位方法、系统、设备及存储介质，该方法包括：采用摄像头拍摄前方的正方形二维码图案的图像；根据图像建立坐标系，图案的四角的坐标建立第一矩阵A，设俯视状态下第二矩阵B，并获得变换矩阵M；建立在行车线路上每个二维码图案与定位坐标信息的映射关系表；拍摄行驶方向的当前图像，采集二维码图案伸形变为正方形二维码图案；当前图像包含预设二维码图案，则根据当前图像建立坐标系，图案的四角建立当前矩阵C，获得俯视矩阵D＝C*M，计算无人驾驶车辆与二维码图案的距离；计算无人驾驶车辆的当前坐标，从而对车辆进行控制。本发明能够通过自动化的方式精确行驶到目标坐标，提高整体运行效率。

主权项

1.一种无人驾驶车辆对位方法，其特征在于，包括以下步骤：S101、采用无人驾驶车辆的固定式摄像头拍摄拍摄行车方向前方地面上一个边长为Lcm正方形二维码图案的图像；根据图像建立坐标系，坐标系原点为矩形的所述图像的一角，因透视形变为梯形的正方形二维码图案的四角的坐标分别为(X1，Y1)、(X2，Y2)、(X3，Y3)和(X4，Y4)；设第一矩阵第二矩阵根据第一矩阵A和第二矩阵B获得变换矩阵M，M＝(A^TA)^‑1A^TB；S102、在行车线路上设置多个正方形二维码图案，并建立每个二维码图案与该二维码图案的定位坐标信息的映射关系表；S103、使用无人驾驶车辆的摄像头拍摄行驶方向的当前图像，采集所述当前图像中的二维码图案，将所述图像中的二维码图案拉伸形变为正方形二维码图案；S104、判断当前图像中的二维码图案是否命中所述映射关系表中的一个，若是，则执行步骤S105，若否，则返回步骤S103；S105、根据当前图像建立坐标系，当前图像中因透视形变为梯形的正方形二维码图案的四角的坐标分别为(X5，Y5)、(X6，Y6)、(X7，Y7)和(X8，Y8)；设当前矩阵获得俯视矩阵则所述无人驾驶车辆与当前图像中二维码图案的距离为Scm，S106、根据步骤S105中得到的所述无人驾驶车辆与当前图像中二维码图案的距离，以及所述当前图像中正方形二维码图案的定位坐标信息获得所述无人驾驶车辆的当前坐标；S107、判断所述无人驾驶车辆是否到达目标坐标，若是，则执行步骤S109，若否，则执行步骤S108；S108、对比所述无人驾驶车辆的当前坐标和目标坐标进行油门或刹车；以及S109、结束。