一种基于可见光通信和ROS的自动驾驶方法及其驾驶系统技术方案

本发明专利技术公开了一种基于可见光通信和ROS的自动驾驶方法及其驾驶系统，其中，驾驶系统包括ROS子系统、LED阵列发光子系统和图像采集子系统。ROS子系统根据消息传递的机制，由功能的不同将子系统划分为各个模块，各模块通过读取和分发消息进行关联，从而有效地管理软硬件资源。LED阵列发光子系统包括5×10的LED阵列、ROS发光控制节点以及LED驱动电路。图像采集子系统包括CMOS图像传感器以及ROS图像处理节点。本发明专利技术把可见光通信和ROS系统相结合，有效地管理自动驾驶系统的各个模块，实现了已处理资源信息的共享使得自动驾驶更安全。

An automatic driving method and driving system based on visible light communication and ROS

The invention discloses an automatic driving method and a driving system based on visible light communication and ROS, wherein the driving system comprises a ROS subsystem, a LED array luminous subsystem and an image acquisition subsystem. According to the mechanism of message passing, ROS subsystem divides the subsystem into modules according to different functions. Each module is associated by reading and distributing messages, thus effectively managing hardware and software resources. The LED array illuminant subsystem includes 5 x 10 LED array, ROS luminous control node and LED driver circuit. The image acquisition subsystem includes CMOS image sensor and ROS image processing node. The invention combines visible light communication and ROS system, effectively manages each module of the automatic driving system, realizes the sharing of processed resource information, and makes automatic driving safer.

【技术实现步骤摘要】
一种基于可见光通信和ROS的自动驾驶方法及其驾驶系统
本专利技术涉及可见光通信及无人驾驶的
，具体涉及一种基于可见光通信和ROS的自动驾驶方法及其驾驶系统。
技术介绍
近年来，被誉为“绿色照明”的半导体器件LED迅速发展，相比于传统的白炽灯灯照明光源，LED具有低能耗、寿命长、绿色环保等特点。同时，LED还具有调制性能好、响应灵敏度高、无电磁干扰等优势，可将信号以人眼无法识别的高频进行传输，且LED发出的光频段不需要许可授权，可以实现低成本高宽带且传输速率高的无线通讯，因而催生了一门能够实现照明与通信一体化的技术——可见光通信技术。ROS是一个强大而灵活的机器人编程框架，从软件构架的角度说，它是一种基于消息传递通信的分布式多进程框架。ROS很早就被机器人行业使用，很多知名的机器人开源库，比如基于quaternion的坐标转换、3D点云处理驱动、定位算法SLAM等都是开源贡献者基于ROS开发的。因为ROS本身是基于消息机制的，开发者可以根据功能把软件拆分成为各个模块，每个模块只是负责读取和分发消息，模块间通过消息关联。如今，无人驾驶技术正处于各巨头企业关注并注重研发的时期，无人驾驶是多种技术的集合，包含有环境感知、定位导航、路径规划、决策控制这几个方面。单单是环境感知方面，就要使用到多种传感器，包括长距雷达、激光雷达、短距雷达、摄像头、超声波、GPS、陀螺仪等。每个传感器在运行时都不断产生数据，而且系统对每个传感器产生的数据都有很强的实时处理要求。当数据量增大之后，分配系统资源便成了一个难题。同时，在现有的无人驾驶系统缺乏有效的车车交互，传统的无人驾驶是利用摄像头采集得到的图像并结合其他传感器识别出其他车辆，计算距离及预测运动都需要大量的复杂计算，当有多辆无人车同时行驶先后经过同一地点时，对周围环境都是分别独自识别出基本一样的环境，信息的利用率也不高。因此，需要一种安全可靠的系统来进行软硬件资源的调配，并能够管理各模块之间的有效通信，同时需要一种高效的通信方法进行车车交互，实现信息共享，加快建模速度。
技术实现思路
本专利技术的目的是为了解决现有技术中的上述缺陷，提供一种基于可见光通信和ROS的自动驾驶方法及其驾驶系统。根据公开的实施例，本专利技术的第一方面公开了一种基于可见光通信和ROS的自动驾驶方法，所述的自动驾驶方法包括下列步骤：S1、对需要传输的信息用二进制数表示，把二进制数进行MPPM调制，调制信号控制小车1前后LED阵列的追踪图像序列以一定频率闪烁，与位于小车1附近的小车2进行通信；S2、小车2上的CMOS图像传感器捕获到小车1的LED阵列发送的图像信息，捕获到的图像信息经过一定的图像预处理后，对LED阵列进行追踪定位；S3、根据LED阵列在图像上的大小和位置，小车2计算出其与小车1的相对方位，并对LED灯信号进行解调得到传输的信息；S4、ROS子系统的控制器把上述解调得到传输的信息规划到环境感知层，并和其他传感器所得到的信息进行整合，为ROS子系统提供关于周围环境的可处理信息。进一步地，所述的步骤S1包括以下步骤：S101、对需要传输的信息约定为一系列二进制码；S102、利用MPPM调制把多个二进制的信息元映射为有M个时隙组成的多个脉冲，组成多脉冲排列PPM；S103、小车1前后的LED灯阵列的定位图像序列以一额定频率闪烁，经过MPPM调制的脉冲调制信号通过功率放大电路控制LED灯阵列的追踪图像序列除边缘LED灯之外的其他灯以不同的频率闪烁。进一步地，所述的需要传输的信息包括：紧急刹车提醒、汽车加速提示、失控情况、前方红绿灯情况。进一步地，所述的步骤S2包括以下步骤：S201、小车2的CMOS图像传感器捕获到小车1的LED灯阵发送的图像信息，把图像转换为灰度图，并进行带通滤波、增强处理，然后利用定位图像序列定位到信号源的位置；S202、根据定位到的位置把信号源从背景图像中剪切出来，并在相邻帧上利用定位图像序列辅助继续剪切与已剪切图像相一致的区域。进一步地，所述的步骤S3包括以下步骤：S301、根据水平角ω，垂直角以及光轴的旋转角度γ，计算出3×3的旋转矩阵找出图像上LED灯的3点坐标，由图像坐标，旋转矩阵以及透镜焦距计算出LED灯与摄像头相对X,Y,Z坐标，从而得出小车1和小车2的相对方位；S302、在连续帧上剪切出来的追踪图像序列上得到LED阵列的闪烁图像，对这些图像进行MPPM解码，得到传输的二进制数据，并转换回约定信息。进一步地，所述的矩阵M中各元素的计算公式为：根据公开的实施例，本专利技术的第二方面一种基于可见光通信和ROS的自动驾驶系统，所述的自动驾驶系统包括依次连接的图像采集子系统、ROS子系统和LED阵列发光子系统，所述的图像采集子系统包括CMOS图像传感器以及ROS图像处理节点，所述的CMOS图像传感器采集LED光信号后通过ROS图像处理节点经图像预处理、LED跟踪定位以及脉冲调制解码后传递给所述的ROS子系统；所述的ROS子系统采用主从节点的方式，主节点储存的信息会同时备份到备用节点，利用共享内存的方法，通过传递数据的地址和大小信息来进行通信，并采用组播multicast机制进行数据一对多的传播，利用LinuxContainer来管理节点进程，对进程和资源进行隔离并减少性能损耗；所述的LED阵列发光子系统包括LED阵列、ROS发光控制节点以及功率放大电路，其中，ROS发光控制节点根据所述的ROS子系统的控制信号，经功率放大电路后通过LED阵列发出信息。进一步地，所述的LED阵列为5×10的矩形，分别安装在小车前后方的车牌四周，垂直于地面和车身两侧，5×10的LED阵列拆分为5×5的图像定位序列和5×5的图像追踪序列，其中图像定位序列中所有LED以同一频率闪烁，以方便识别定位。进一步地，所述的ROS发光控制节点通过进行MPPM调制得到脉冲调制信号，经过功率放大电路控制5×5图像追踪序列进行闪烁。进一步地，所述的CMOS图像传感器的帧率为1000fps，透镜焦距为35mm，分辨率为1024×512，在小车前后各安装一个。本专利技术相对于现有技术具有如下的优点及效果：1、本专利技术通过基于消息传递通信的分布式多进程框架，安全有效地管理无人驾驶系统的各个模块，提高软硬件资源利用率。2、本专利技术把可见光通信用于无人驾驶系统之中，在摄像头捕获图像的同时通过识别LED灯进行了车与车之间的信息交互，在得到周围环境图像的同时收到了其他车辆传输的信息，实现了资源信息的共享。附图说明图1是本专利技术公开的基于可见光通信和ROS的自动驾驶系统示意图；图2是本专利技术中无人驾驶系统架构示意图；图3是本专利技术中用于可见光通信的LED阵列示意图；图4是本专利技术中高速CMOS图像传感器捕获LED阵列示意图；图5是本专利技术中可见光通信流程示意图。具体实施方式为使本专利技术实施例的目的、技术方案和优点更加清楚，下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。实施例如图1所示，本专利技术公开了一种基于可见光通信和ROS的自动驾驶系统，包本文档来自技高网...

【技术保护点】
1.一种基于可见光通信和ROS的自动驾驶方法，其特征在于，所述的自动驾驶方法包括下列步骤：S1、对需要传输的信息用二进制数表示，把二进制数进行MPPM调制，调制信号控制小车1前后LED阵列的追踪图像序列以一定频率闪烁，与位于小车1附近的小车2进行通信；S2、小车2上的CMOS图像传感器捕获到小车1的LED阵列发送的图像信息，捕获到的图像信息经过一定的图像预处理后，对LED阵列进行追踪定位；S3、根据LED阵列在图像上的大小和位置，小车2计算出其与小车1的相对方位，并对LED灯信号进行解调得到传输的信息；S4、ROS子系统的控制器把上述解调得到传输的信息规划到环境感知层，并和其他传感器所得到的信息进行整合，为ROS子系统提供关于周围环境的可处理信息。

【技术特征摘要】
1.一种基于可见光通信和ROS的自动驾驶方法，其特征在于，所述的自动驾驶方法包括下列步骤：S1、对需要传输的信息用二进制数表示，把二进制数进行MPPM调制，调制信号控制小车1前后LED阵列的追踪图像序列以一定频率闪烁，与位于小车1附近的小车2进行通信；S2、小车2上的CMOS图像传感器捕获到小车1的LED阵列发送的图像信息，捕获到的图像信息经过一定的图像预处理后，对LED阵列进行追踪定位；S3、根据LED阵列在图像上的大小和位置，小车2计算出其与小车1的相对方位，并对LED灯信号进行解调得到传输的信息；S4、ROS子系统的控制器把上述解调得到传输的信息规划到环境感知层，并和其他传感器所得到的信息进行整合，为ROS子系统提供关于周围环境的可处理信息。2.根据权利要求1所述的一种基于可见光通信和ROS的自动驾驶方法，其特征在于，所述的步骤S1包括以下步骤：S101、对需要传输的信息约定为一系列二进制码；S102、利用MPPM调制把多个二进制的信息元映射为有M个时隙组成的多个脉冲，组成多脉冲排列PPM；S103、小车1前后的LED灯阵列的定位图像序列以一额定频率闪烁，经过MPPM调制的脉冲调制信号通过功率放大电路控制LED灯阵列的追踪图像序列除边缘LED灯之外的其他灯以不同的频率闪烁。3.根据权利要求2所述的一种基于可见光通信和ROS的自动驾驶方法，其特征在于，所述的需要传输的信息包括：紧急刹车提醒、汽车加速提示、失控情况、前方红绿灯情况。4.根据权利要求1所述的一种基于可见光通信和ROS的自动驾驶方法，其特征在于，所述的步骤S2包括以下步骤：S201、小车2的CMOS图像传感器捕获到小车1的LED灯阵发送的图像信息，把图像转换为灰度图，并进行带通滤波、增强处理，然后利用定位图像序列定位到信号源的位置；S202、根据定位到的位置把信号源从背景图像中剪切出来，并在相邻帧上利用定位图像序列辅助继续剪切与已剪切图像相一致的区域。5.根据权利要求1所述的一种基于可见光通信和ROS的自动驾驶方法，其特征在于，所述的步骤S3包括以下步骤：S301、根据水平角ω，垂直角以及光轴的旋转角度γ，计算出3×3的旋转矩阵找出图像上LED灯...

【专利技术属性】
技术研发人员：吴玉香，陈艺文，关伟鹏，陈艺荣，巫朝政，方良韬，
申请(专利权)人：华南理工大学，
类型：发明
国别省市：广东,44