1.一种基于数据融合的自动泊车控制方法,其特征在于,包括:
S1、接收泊车请求,获取当前车速,判断当前车速是否低于预设车速阈值,是则启动泊车控制系统;
S2、调整泊车摄像头的角度到第一预设角度,同时启动泊车雷达;
S3、同时通过基于图像识别及基于障碍物检测的方法,分别检测泊车位;
S4、当基于图像识别的方法首先找到泊车位时,执行下一步,否则执行S7;
S5、计算泊车位标示线右边沿相对于泊车雷达的位置LR;
S6、判断LR是否大于0,是则执行下一步,否则循环执行本步骤;
S7、将系统切换到基于障碍物检测的车位类型识别模式;
S8、根据基于障碍物检测的方法规划泊车路径。
2.根据权利要求1所述的基于数据融合的自动泊车控制方法,其特征在于,所述S8之后还包括:
S9、将泊车摄像头调整到第二预设角度。
3.根据权利要求1所述的基于数据融合的自动泊车控制方法,其特征在于,所述第一预设角度通过实际标定来确定。
4.根据权利要求2所述的基于数据融合的自动泊车控制方法,其特征在于,所述第二预设角度为摄像头的中心轴呈水平状态。
5.根据权利要求1所述的基于数据融合的自动泊车控制方法,其特征在于,所述S5包括如下步骤:
S501、读取预先存储的泊车摄像头中心轴在图像坐标系中对应的像素点A的坐标以及泊车雷达与泊车摄像头的相对位置;
S502、根据泊车位标示线右下方角点“┘”的横坐标与所述像素点A的横坐标距离差,解算出泊车摄像头相对于泊车位标示线右边沿的距离L1;
S503、根据泊车摄像头与泊车雷达两者在车辆进行方向上的投影距离L0以及泊车摄像头相对于泊车位标示线右边沿的距离L1,计算泊车位标示线右边沿相对于泊车雷达的位置LR。
6.根据权利要求5所述的基于数据融合的自动泊车控制方法,其特征在于,所述LR确定公式为:
当泊车摄像头安装在泊车雷达前方时,LR=L1-L0;当泊车摄像头安装在泊车雷达后方时,LR=L0-L1。
7.一种基于数据融合的自动泊车控制装置,其特征在于,包括:泊车请求接收模块、车速获取模块、车速判断模块、摄像头角度控制模块、摄像头模块、摄像头车位识别模块、雷达控制模块、雷达模块、雷达车位识别模块、数据转换模块、泊车路径规划模块;
所述泊车请求接收模块,用于接收用户发起的自动泊车请求;
所述车速获取模块,用于获取当前车速;
所述车速判断模块,用于判断当前车速是否低于预设车速阈值;
所述摄像头角度控制模块,用于调整泊车摄像头的角度;
所述摄像头模块,用于拍摄车身周围的图像;
所述摄像头车位识别模块,用于根据摄像头拍摄的图片进行车位识别;
所述雷达控制模块,用于控制雷达的开启;
所述雷达模块,用于探测车身周围的障碍物;
所述雷达车位识别模块,用于根据雷达探测的障碍物进行车位识别;
所述数据转换模块,用于将摄像头车位识别模块的信息转换为雷达车位识别模块的信息;
所述泊车路径规划模块,用于自动规划泊车路径。
8.根据权利要求7所述的基于数据融合的自动泊车控制装置,其特征在于,所述数据转换模块包括:读取模块、摄像头距离解算模块、雷达距离解算模块;
所述读取模块,用于读取预先存储的泊车摄像头中心轴在图像坐标系中的像素点的坐标以及泊车雷达与泊车摄像头的相对位置;
所述摄像头距离解算模块,用于摄像头距离解算模块根据泊车位标示线右下方角点的横坐标与所述泊车摄像头中心轴在图像坐标系中的像素点的横坐标距离差,解算出泊车摄像头相对于泊车位标示线右边沿的距离;
所述雷达距离解算模块,用于根据泊车摄像头与泊车雷达两者在车辆进行方向上的投影距离以及泊车摄像头相对于泊车位标示线右边沿的距离,计算泊车位标示线右边沿相对于泊车雷达的位置。