新型视觉区域智能车辆导航控制器设计

２００６年１０月

第２３卷第１０期公路交通科技ＪｏｕｒｎａｌｏｆＨｉｇｈｗａｙａｎｄＴｒａｎｓｐｏｒｔａｔｉｏｎＲｅｓｅａｒｃｈａｎｄＤｅｖｅｌｏｐｍｅｎｔ

Ｏｃｔ．２００６

Ｖｏｌ．２３Ｎｏ．１０

文章编号：１００２－０２６８（２００６）１０－０１０３－０５

收稿日期：２００５－０８－０２

基金项目：中国博士后科学基金资助项目（２００４０３６３９７）；吉林大学青年教师基金资助项目

作者简介：王荣本（１９４６－），男，教授，博士生导师．研究方向为智能车辆与汽车安全辅助驾驶．（ｗｒｂ＠ｊｌｕ．ｅｄｕ．ｃｎ）

０前言

近年来，在解决生产线的自动化与高速公路智能化的同时，人们也将研究方向转向市内新型区域

智能交通系统———

ＣｙｂｅｒＣａｒＳｙｓｔｅｍ的开发上来。这是智能车辆领域又一新的发展方向，旨在解决城市交通中存在的很多问题，是人类科技发展的一个象征。

区域智能车辆（ＣｙｂｅｒＣａｒ）是具有完全自主驾驶能力的道路交通工具，在初始阶段，它只是为在市区或限定范围内以低速行驶的短途运输而设计的，长期目标是能够在专用轨道上高速自动运行。

智能车辆的导航方法根据导航信息的形式不同，一般分为无线式导航和有线式导航。无线式导航又可分为参考位置设定法、标志反射法、图像识别法等。有线导航可分为磁感应式导航法、标识线图像识别法等。在上述的各种导航方式中，视觉导航因为具有信息丰富、适应范围广、智能化程度高等特有的优越性能而受到各国的关注，将逐渐成为智能车辆导航方式的主要发展方向。对于户外自主引导区域智能车辆（ＣｙｂｅｒＣａｒ）的导航控制器，目前较少论文涉及，为了开展对该领域的研究，我们设计并制造了基于视觉导航的ＪＬＵＩＶ－５区域智能车辆（Ｃｙｂｅｒ－

Ａｂｓｔｒａｃｔ：ＴｈｅｇｕｉｄｉｎｇｐｒｉｎｃｉｐｌｅａｎｄｃｏｍｐｏｓｉｔｉｏｎｏｆＣｙｂｅｒＣａｒｂａｓｅｄｏｎｍａｃｈｉｎｅｖｉｓｉｏｎｗａｓｉｎｔｒｏｄｕｃｅｄ．ＡｐｐｌｙｉｎｇＩＭｓｅｑｕｅｎｃｅｓｉｇｎａｌｓａｓｉｎｐｕｔｒｅｓｐｏｎｓｅｓｉｇｎａｌｓａｎｄｌｅａｓｔｓｑｕａｒｅｓｍｅｔｈｏｄｔｏｅｓｔａｂｌｉｓｈｔｈｅｄｙｎａｍｉｃｅｑｕａｔｉｏｎｆｏｒＣｙｂｅｒＣａｒｓｔｅｅｒｉｎｇｓｙｓｔｅｍｂｙｓｙｓｔｅｍｉｄｅｎｔｉｆｉｃａｔｉｏｎｅｘｐｅｒｉｍｅｎｔｓｃｏｍｂｉｎｅｄｗｉｔｈｔｈｅｐｒｅｖｉｅｗｋｉｎｅｍａｔｉｃｓｍｏｄｅｌａｎｄｔｗｏ－ｄｅｇｒｅｅｓｔｅｅｒｉｎｇｄｙｎａｍｉｃｍｏｄｅｌｏｆｖｅｈｉｃｌｅ，ｔｈｅｒｅｆｏｒｅｔｈｅｓｔｅｅｒｉｎｇｃｏｎｔｒｏｌｍａｔｈｅｍａｔｉｃｓｍｏｄｅｌｂａｓｅｄｏｎｐｒｅｖｉｅｗｋｉｎｅｍａｔｉｃｓｆｏｒＣｙｂｅｒＣａｒｗａｓｅｓｔａｂｌｉｓｈｅｄ．Ｔｈｅｏｐｔｉｍａｌｃｏｎｔｒｏｌｏｆａｌｉｎｅａｒｓｔａｔｅ－ｖａｒｉａｂｌｅｆｅｅｄｂａｃｋｗａｓｏｂｔａｉｎｅｄｔｈｒｏｕｇｈｔｈｅｌｉｎｅａｒｑｕａｄｒａｔｉｃｆｏｒｍｏｐｔｉｍａｌｃｏｎｔｒｏｌｔｈｅｏｒｙ．ＩｔｗａｓｐｒｏｖｅｄｂｙｔｈｅｓｉｍｕｌａｔｉｏｎａｎａｌｙｓｉｓａｎｄｏｕｔｄｏｏｒＣｙｂｅｒＣａｒｅｘｐｅｒｉｍｅｎｔｓｔｈａｔｔｈｅｏｐｔｉｍａｌｃｏｎｔｒｏｌｌｅｒｃｏｕｌｄｔｒａｃｅｔｈｅｐａｔｈｓｔｅａｄｉｌｙａｎｄｒｅｌｉａｂｌｙ．

Ｋｅｙｗｏｒｄｓ：ｓｙｓｔｅｍｉｄｅｎｔｉｆｉｃａｔｉｏｎ；ｏｐｔｉｍａｌｃｏｎｔｒｏｌｌｅｒ；ｉｎｔｅｌｌｉｇｅｎｔｖｅｈｉｃｌｅ；ＣｙｂｅｒＣａｒ

新型视觉区域智能车辆导航控制器设计

王荣本，张荣辉，储江伟，金立生，游峰

（吉林大学交通学院，吉林长春１３００２５）

摘要：简要介绍了基于机器视觉导航区域智能车辆（ＣｙｂｅｒＣａｒ）的导航原理和组成。首先采用逆Ｍ序列作为辨识输入信号和最小二乘算法得到车辆转向系统的系统辨识特征方程，结合预瞄运动学模型和车辆二自由度转向动力学模型，从而建立车辆基于视觉预瞄的转向动力学控制数学模型，根据线性二次型最优控制理论得到状态线性反馈的最优控制规律。通过仿真分析和试验，验证了最优控制器在ＣｙｂｅｒＣａｒ户外路径跟踪过程中平稳、可靠。关键词：系统辨识；最优控制器；智能车辆；ＣｙｂｅｒＣａｒ中图分类号：ＴＰ２４

文献标识码：Ａ

ＣｏｎｔｒｏｌｌｅｒＤｅｓｉｇｎｆｏｒＣｙｂｅｒＣａｒＢａｓｅｄｏｎＶｉｓｉｏｎＮａｖｉｇａｔｉｏｎ

ＷＡＮＧＲｏｎｇ－ｂｅｎ，ＺＨＡＮＧＲｏｎｇ－ｈｕｉ，ＣＨＵＪｉａｎｇ－ｗｅｉ，ＪＩＮＬｉ－ｓｈｅｎｇ，ＹＯＵＦｅｎｇ

（ＣｏｌｌｅｇｅｏｆＴｒａｎｓｐｏｒｔａｔｉｏｎ，ＪｉｌｉｎＵｎｉｖｅｒｓｉｔｙ，ＪｉｌｉｎＣｈａｎｇｃｈｕｎ１３００２５，Ｃｈｉｎａ）

公路交通科技第２３卷

Ｃａｒ）试验样车，并基于该平台设计最优控制器进行试

验研究工作。

１车辆视觉导航原理

目前，视觉导航逐渐成为智能车辆导航方式的

主流。我们在路面铺设反光白条，由于路标和暗色

路面在ＣＣＤ所采图像中的灰度值具有一定差异，进

行相关图像处理工作来拟合路径的中心线，得到准

确的路径信息，如图１所示。图像的中心点位置代

表车辆的纵向中心线和横向中心线的交点，当图像

的横向中心线与路径中心线交点位于图像中心点左

边时，侧向距离偏差ｅｄ定义为负；当图像的横向中

心线与路径中心线交点位于图像中心点右边时，侧

向距离偏差ｅｄ定义为正。方位偏差ｅθ以垂直向上为

起始方向，顺时针为正，逆时针为负。

１．１方位偏差的计算

得到拟合的路径中心线之后，设直线方程为：

ｙ＝Ａｘ＋Ｄ，其中Ａ为直线斜率，Ｄ为直线截距。车辆

的方位偏差ｅ

θ

＝－ａｔａｎ（Ａ）。

图１导航控制器输入参数

Ｆｉｇ．１Ｔｈｅｉｎｐｕｔｐａｒａｍｅｔｅｒｓｏｆｃｏｎｔｒｏｌｌｅｒ

１．２侧向偏差的计算

使图像横向中心线与路径拟合中心线相交，得

到交点Ｏ（ｘｏ，ｙｏ），则Ｏ点横坐标和图像中心点的横坐

标之差即为车辆的侧向距离偏差ｅｄ：

ｅｄ＝ｘ

ｏ

－ｗ／２，

式中，ｗ为图像的宽度。

２车辆转向最优控制器设计

区域智能车辆（ＣｙｂｅｒＣａｒ）的结构示意图如图２所示，主要包括转向系统、驱动系统、控制单元、安全保障系统、计算机控制平台、充电装置。ＣＣＤ安装在ＣｙｂｅｒＣａｒ挡风玻璃前处。

２．１车辆转向系统的系统辨识

车辆要实现灵敏的转向控制，其转向机构的数学模型在控制器设计中占有重要地位，描述着计算机Ｄ／Ａ输出值和转向轮转角的关系。采用数学解析方法十分复杂且通常不能反映系统特性，故采用系统辨识的方法进行建模。辨识原理如图３所示。

图２ＣｙｂｅｒＣａｒ结构示意图

Ｆｉｇ．２ＴｈｅｓｔｒｕｃｔｕｒｅｏｆＣｙｂｅｒＣａｒ

图３ＣｙｂｅｒＣａｒ转向系统辨识原理

Ｆｉｇ．３Ｔｈｅｉｄｅｎｔｉｆｉｃａｔｉｏｎｐｒｉｎｃｉｐｌｅｏｆｓｔｅｅｒｉｎｇｓｙｓｔｅｍ

要得到车辆转向系统动态特征方程，首先对ＣｙｂｅｒＣａｒ转向系统进行阶跃输入响应试验，如图４所示，步进电机输入频率的大小为８００Ｈｚ，右图为采用了ＢｕｔｔｅｒＷｏｒｔｈ［８，０．３８６］低通滤波器数据处理后的结果，可看出转向轮转角在很短的时间内就进入稳态过程，难以反映系统动态特性，所以做差分处理，可得转向轮角速度阶跃响应曲线，如图５所示，输入频率为８００Ｈｚ，右图为采用了ＢｕｔｔｅｒＷｏｒｔｈ［８，０．２７３］低通滤波器数据处理后的结果。差分公式为：

图４ＣｙｂｅｒＣａｒ转向系统阶跃响应曲线图

Ｆｉｇ．４Ｔｈｅｓｔｅｐｒｅｓｐｏｎｓｅｏｆｓｔｅｅｒｉｎｇｓｙｓｔｅｍ

１０４