[发明专利]一种多种传感器数据融合立体视觉控制的路桥自主行走划线系统

说明书

一种多种传感器数据融合立体视觉控制的路桥自主行走划线系统，它包括：划线车、多组激光雷达传感装置、多组立体视觉控制和控制器，所述控制器包括划线车自动导航模块和划线控制模块；所述划线车自动导航模块和划线控制模块借助于ROS中间通讯模块传输信号；当第二激光雷达传感装置和第二双目视觉传感装置检测划线机划的线条与导航给出的线条存在累积误差时反馈给控制器，所述控制器指令末端机构进行调整以修正偏差。控制连接设计合理，通过控制器控制多组激光雷达传感装置和传双目视觉传感装置集于一身,可检测划线的划线车行自动划线车前行导航和避障以及划线车与高速公路边水泥栏杆相对位置的定位；对误差融合和补偿使划线机的运动轨迹进行调节。

技术领域

本发明涉及一种多种传感器数据融合立体视觉控制的路桥自主行走划线系统。

背景技术

据市场调查和相关公开文献进行检索，目前城乡道路、高速公路及桥梁道路的划线均为人工划线。虽然已有的专利文献和一些技术成果文献中记载，自动划线、测距的激光雷达和立体视觉传感技术的独立应用技术较为成熟，但末发现在自动公路划线机上应用。

自动行走的划线机器行走路线与划线路线一致，如用北斗(GPS)导航系统定位精度仍然在厘米级，特别是在高速公路上，定位精度受到路边高层建筑、山体和高物体影响、空中云层和天气的干扰，误差至少20厘米-50厘米，该问题成为困扰自动划线机能在实际工程应用的问题。实际上，划线时包括二种误差，一是机器行走时北斗导航的误差，二是划线机末端机构画划线时也会产生误差、二者相加形成综合误差使得划线不准确。如文献阐述了用机器视觉查找水线实现精确定位([1]石磊,高速公路无人驾驶划线车.山东省,山东交通学院,2020-12-30.其主要用图像识别引导划线设备沿预设路线实现姿态调整与自动驾驶；同样也不可避免地存在导航检测误差,且系统控制设置欠合理，也末能公开多种传感器数据融合立体视觉控制路桥自主行走划线系统。

为此，我们研制了一种多种传感器数据融合立体视觉控制的路桥自主行走划线系统。

发明内容

本发明的目的所要解决的技术问题是要提供一种多种传感器数据融合立体视觉控制的路桥自主行走划线系统，控制连接设计合理，通过控制器控制多组激光雷达传感装置和传双目视觉传感装置集于一身，能够实施检测划线的划线车行自动划线车前行导航和避障以及划线车与高速公路边水泥栏杆相对位置的定位；对误差融合和补偿使划线机的运动轨迹进行调节；从而使划线车的易于实施应用。

为了实现上述目的，本发明采用的技术方案是提供一种多种传感器数据融合立体视觉控制的路桥自主行走划线系统，其特征在于，它包括：

划线车；

第一激光雷达传感装置和第一双目视觉传感装置，以及

第二激光雷达传感装置和第二双目视觉传感装置；

控制器，其与所述第一激光雷达传感装置、第一双目视觉传感装置、第二激光雷达传感装置和第二双目视觉传感装置通讯连接；所述控制器包括划线车自动导航模块和划线控制模块；所述划线车自动导航模块和划线控制模块借助于ROS中间通讯模块对划线车包括的行走控制、末端机构划线控制、第一激光雷达传感装置、第一双目视觉传感装置、第二激光雷达传感装置和第二双目视觉传感装置交互链接以发出指令；

当第二激光雷达传感装置和第二双目视觉传感装置检测划线机划的线条与导航给出的线条存在累积误差时反馈给控制器，所述控制器指令末端机构进行调整以修正偏差。

于本发明的一个或多个实施例中，所述划线车自动导航模块包括定位模块和路径模块，所述划线车自动导航模块包括定位模块和路径模块与ROS中间通讯模块双向通讯连接。

于本发明的一个或多个实施例中，所述划线控制模块包括点云算法重构模块和末端机构；所述点云算法重构模块和末端机构与ROS中间通讯模块双向通讯连接。