无限网络的多智能小车编队控制系统.doc

《无限网络的多智能小车编队控制系统.doc》由会员分享，可在线阅读，更多相关《无限网络的多智能小车编队控制系统.doc（31页珍藏版）》请在得力文库 - 分享文档赚钱的网站上搜索。

1、Four short words sum up what has lifted most successful individuals above the crowd: a little bit more.-author-date无限网络的多智能小车编队控制系统(2013 -2014 学年第2学期)无线通信网络的多智能小车编队控制系统摘要：首先设计了基于ARM Cortex-M3的智能小车控制系统，利用模块化理念设计了无线通信、磁场检测传感器、电机驱动等硬件模块，采用ZigBee设计了多智能小车协作控制的车载自组织无线通信网络，利用磁场检测完成小车的导航方式，采用旋转编码器实现小车的测速功能然

2、后在智能小车上移植了嵌入式wCOS一11实时操作系统，根据多智能小车协作控制要求，设计了智能小车分布式自主决策程序，实现多智能小车自由运行、队列跟随和路口协作等运行模式最后采用线性最优二次型的车队跟随控制算法，实现多智能小车编队的启停、匀速和加减速控制，利用通信协商的路口协作算法，实现多智能小车路口协作任务实验结果表明，设计的无线通信网络的多智能小车系统能够满足多智能小车协作控制、编队控制和路口协作控制要求关键词：ZigBee；无线通信网络；智能小车；嵌入式操作系统；多智能小车编队Multi-smart car control system based on wireless communic

3、ation networkAbstract：First，the smart car control system based on A CortexM3 is studiedThe wirelesscommunications，the magnetic field sensors，motor drives and other hardware modules are designedThe multismat car cooperative control self-organizing wireless communication networks are designed by ZigBe

4、eThe smart Car navigation is achieved by magnetic field detection an d the smart car speed function is realized by using the rotary encoderThen the embedded ICOSlI realtime op crating system is tran splan ted into the slnart carAccording to the requirements of multi-smart Car cooperative control，dis

5、tributed autonomous decisionmaking procedures arc programmed to achieve free running，queue following and road junction collaborating of the multismart carFinally，the linear optimal quadratic fleet tracking control algorithm is utilized to realize multi-smart Car start and stop formationsand uniform

6、and ramp contro1collaborative communication negotiation intersection algorithms are applied to achieve crossing collaborative tasks of the smart CarThe expe rimental results show that the designed ZigBce wireless com unication network meets the requirements of the collaboration control，fleet control

7、 and road junction colaborating control of the smart CarKey words：ZigBee；wireless com unication network；smart Car；embedded operating system；multismart Car coordination.使用真实车辆进行多车编队实验，维护工作十分复杂，实验成本很高，而且真实的智能车高速运行可能会造成危险的交通事故 因此，采用自主开发的智能小车替代真实车辆，搭建了一个基于ZigBee无线通信网络的多智能小车编队控制研究实验平台本文提出一种基于无线通信网络的多智能小车

8、编队控制系统，设计了系统的协作体系结构、通信方法、硬件电路与软件编队算法，在实验环境下实现了多智能小车编队控制1 控制系统结构和无线通信网络设计多智能小车编队控制系统采用分布式控制结构，没有集中控制单元，各智能小车关系平等，均能够与其他机器人通过通信进行信息交流以协调各自行为，各智能小车具有高度的自治能力，自主地规划与决策 J这种结构有较好的容错性、适应性和扩展性如图1所示，在分布式控制结构体系下，根据小车内的感知模块获取外界环境信息，再由通信模块获取区域内其他小车的状态信息，通过程序分析处理发送控制命令到小车的执行机构，使智能小车能够自主规划与决策在多辆智能小车编队协作过程中，每辆智能小车具

9、有独立的行驶方向和速度，需要通过车一车组成的无线网络通信协商，其网络拓扑结构是频繁变化的，通过无线通信网络获取区域内其他小车的状态信息当2辆车之间的距离低于安全距离时，智能小车通过信息的交互，后车自主地参与协作，调整速度以维持一定的安全距离并以接近前方车辆的速度行驶，形成一个局部的跟随模型无线通信网络的建立是基于ZigBee协议栈 JZigBee协议的体系结构由物理(PHY)层、媒体接人控制(MAC)层、逻辑链路层、网络层和应用层组成其中，PHY层和媒体介质访问层采用IEEE 802154协议标准上层MAC、逻辑链路层和网络层由ZigBee联盟定义应用层可以实现的功能是管理高级的协议栈用户应用

10、程序在端点(协调器、路由器、终端节点)上实现通过ZICM2410 ZigBee芯片供给用户进行交互的控制命令可以对网络内端点的通信信道、目的地址、数据显示形式、休眠状态和通讯模式进行设置2 控制系统硬件和软件设计智能小车的硬件采用模块化设计理念智能小车的硬件整体设计如图2所示，主要包括以下几个模块：1)处理器模块该模块是智能小车的“大脑”，用于接收信息、发出控制命令MCU选用了基于ARM CortexM3内核的STM32F103VET6微处理器芯片2)磁场检测传感器模块智能小车处理器通过AD接口读入磁场检测传感器输出的电压，进而判断引导线的位置，实现智能小车的导航控制3)速度传感器(里程传感器

11、)模块智能小车的运动速度和运行里程通过旋转增量式编码器进行检测，为准确获得运动速度和运行距离采用在车体上加装与道路接触的测速轮，再将旋转增量式编码器的转轴和i贝4速轮同轴连接4)无线通信模块智能小车为获取编队中其他小车的运动状态信息，需要通过无线模块和编队中其他小车进行通信将获取到的信息通过USART串口输入处理器模块5)电机驱动模块智能小车获取环境信息后，处理器经过运算发出2个PWM波至驱动模块，控制左、右2个直流电机通过改变PWM 波的占空比，改变2个直流电机的速度实现小车的转向、加减速、启停控制6)人机交互模块小车需要设定参数和显示运行状态，所以设计了键盘、状态指示灯智能小车的处理器通过

12、普通 O口控制键盘和状态指示灯根据软件系统实现智能小车的编队控制的功能目标，软件既要保证实时性，又要完成多项复杂的功能简单的状态机开发模型已不能满足需要，于是引入了嵌入式实时操作系统(RTOS)如图3所示，智能小车控制系统软件体系自下而上包括以下几个层次：1)硬件驱动层外设驱动主要有磁传感器驱动、测速传感器驱动、电机驱动模块驱动、无线模块驱动、人机交互驱动等2)嵌入式实时操作系统层负责任务调度、任务间通信、内存的管理、信号量管理等IxCOSlI是由Labrosse编写的一个源代码公开的嵌入式实时操作系统，具有可移植性强、可固化、可剪裁、占先式内核、多任务处理等特点，还具有极高的稳定性与可靠性，

13、但人机界面部分不是很完善适合于对实时性要求较高的小规模嵌入式系统中使用，因此可应用于小型移动机器人控制系统中 J3)智能车编队控制应用程序层属于用户应用程序层，是实现智能小车编队控制功能的主体部分pCOSlI操作系统可以管理64个任务，但一般都保留8个任务，留给用户应用程序的最多可有54个任务，优先级可以为459之间的任何数，数值越低，表示优先级越高主要设计了初始化任务、检测和编队控制任务、串口通信发送任务和人机交互处理任务等用户任务，见表13 控制系统实验结果31 多智能小车编队算法如图4所示，在多智能小车编队跟随过程中，设S ， 分别为il辆车和i辆车的位移，V，V分别为f一1辆车和f辆车

14、的速度，a ，a 分别为第f一1辆车和第f辆车的加速度，d。为2辆车的理想间距第f辆智能小车与其前车f一1车的跟随关系转换为状态方程形式： （1）式中，状态变量，u=ai,w=ai-1.多智能小车编队跟随系统中，跟随控制的目标是最小化跟随距离误差和速度误差，并且使控制量尽量小，因此跟随控制可被视为一个最优控制问题采用线性最优二次型(LQ)控制方法l6 求解，优化的目标函数为二次型指标函数： (2)式中，Q为状态变量的权重矩阵；R为控制量的权重矩阵最小化性能指标函数得到最优控制率为 (3)矩阵P的计算可以根据李雅普诺夫第二方法，P需要满足Riccati方程： (4)状态变量权重矩阵Q和控制量的权

15、重矩阵尺的选取对系统的控制性能影响很大先选取适当的Q和，并利用Maab软件画出系统的状态响应曲线，根据曲线的效果，最终确定 ,R=400结合式(3)可计算得跟随车辆f的控制输入量U为 (5)32 多智能小车编队控制实验在一个单车道的交通道路实验场景，对线性最优二次型编队控制算法进行实验 如图5所示，3辆智能小车编队行驶，智能小车通过无线通信网络广播实时状态信息(如车速、位置等)，运用线性最优二次型算法对编队进行控制 J，智能车之间的初始车间距为57 cm，由于间距的设定采用时距法，即车间距与车辆速度成线性比例，车速越高设定车间距也越大如图6所示，多智能小车编队实验数据中的前车与后车速度和间距分

16、别是车队中1号车与2号车的行驶速度和车间距前车在t=90T(T为控制周期)时刻启动，后车很快响应并与前车保持相近的速度(略微延时10个控制周期，约为02S)在前车停车时，前车的速度降为0，后车的速度也降为0，前车与后车的间距与初始车间距相同前车的速度在056，100cms这3档变化，后车的速度能够快速地与前车保持一致，车间距的变化与2辆车的速度变化保持一致，以保持安全车间距实验表明，线性最优二次型的控制算法在车队启动、停车、变速的情况下，既能使车间距保持在一定的安全范围内，又能够使跟随车辆的速度有较快的响应速率4 结语本文主要从分析多智find,车编队控制系统需求人手，采用ZigBee车载自组

17、织无线通信网络，实现车车通信方式的信息交互智能小车采用磁场检测导航方式，控制芯片选择了基于ARM CortexM3内核的微处理器，硬件采用模块化设计理念设计了无线通信模块、磁场检测传感器、电机驱动模块等硬件模块在智能小车上移植了嵌入式 COS一实时操作系统，设计了多智能小车编队控制应用程序在实验室环境下，设计了基于线性最优二次型的车队跟随控制算法，实现了多智能小车编队的启停、匀速和加减速控制任务本系统作为一个基于无线通信网络的多智能小车协作控制研究实验平台具有十分重要的意义参考文献(References)1 Yang M，Parent MCybernetic technologies for

18、cars in Chinese citiesC.Proceedings of CityTrans ChinaShanghai，China，2(104：17182 祖丽楠，田彦涛，梅昊大规模多移动机器人合作任务的分布自主协作系统J机器人，2006，28(5)：4704773Zu Linan，Tian Yantao，Mei HaoDistributed autonomous cooperation system for the largescale cooperation task of multiple mobile robotsJRobot，2006，28(5)：4704774 Gradine

19、scu V，Gorgorin C，Diaconescu R，et a1Adapfive traffic lights using cartocar communicationC.IEEE Vehicular Technology Conference. Dublin,Ireland.2oo7：21255 王永宁，赵士杰，齐长远p,COS一及其在ARM 平台上的实现J计算机应用与软件，2007，24(12)：180181，2176 Wang Yongning，Zhao S ie，Qi Changyuan. COS一and its implementation on ARMJComputer Ap

20、plications and Software，2007，24(12)：180181，217.7 Labrosse JMicroCOS-II：the realtime kernelM2nd ed北京：北京航空航天大学出版社，20038 Dissanayake S D，Karunasekara P P C，Lakrnanaarachchi D D et a1Zigbee wireless vehicular identification and authentication systemc. International Conference on Information and Automati

21、on for SustainabilityColombo，Sri Lanka，2008：2572609 Seiler P，Pant A，Hedrick KDisturbance propagation in vehicle stringsJIEEE Transactions on Automatic Control，2004，49(10)：1835184110 Halle S，Laumonier J，Chaib BA decentralized approach to collaborative driving coordinationc.International IEEE Conference on Intelligent Transportation SystemsWashington，DC，USA，2004：453458-