飞思卡尔智能车光电资料全

飞思卡尔智能车光电资料

-----------------------作者：-----------------------日期：

基于光耦传感器的控制方法-从离散量到连续量

康世胤1，长城2，莫一林3，顾全全4，陆耿5

(1. 清华大学自动化系，100084；

2. 清华大学自动化系， 100084；

3. 清华大学自动化系， 100084；

4. 清华大学自动化系， 100084；

5. 清华大学自动化系， 100084)

摘要:第一届“飞思卡尔”杯全国大学生智能车邀请赛要求对高速行驶的小车进行实时控制，使其巡线完成比赛赛道。针对这种要求，我们选择了最成熟的PID控制，尝试了由离散的不完全微分的PD控制到相对连续PD控制的过渡，通过采集光耦传感器输出的模拟量，采用对称求位置法得到连续性较好的位置信息，利用双排传感器计算角度，对位置和角度同时进行PD控制，经过细致调试确定相应参数，并合理利用分段、设置死区等方法，最终小车可以获得较好的稳定性和在高速情况对赛道中心线的跟随特性。

关键词：道路寻迹；PID控制；对称定位；离散；连续

Control Method Based on Photoelectric Coupling Device –from Discrete Signal to Continual Signal

KANG Shiyin1，LI Changcheng2，MO Yilin3，GU Quanquan4，LU

Geng5

(1.Automation, Tsinghua University, Beijing 100084,

China；

2. Automation, Tsinghua University, Beijing 100084,

China；

3. Automation, Tsinghua University, Beijing 100084,

China；

4. Automation, Tsinghua University, Beijing 100084,

China；

5. Automation, Tsinghua University, Beijing 100084,

China；)

Abstract:In the coming FREESCALE College Student Smart Car Competition ’06, real ti me control strategies are required to be applied in the high-speed model car which to make sure the car tracking the unknown road and finishing 2 laps of game. Based on the requirement we select one of the most well applied proportion-integration-deviation (PID) method. Much works are carried out including trying varies of strategy from initial discrete PD to final continual PD. In the current strategy analog output of photoelectric coupling devices are sampled and converted from A to D. Symmetric positioning method is applied to obtain precise direction information. Furthermore by applying dual sensor array the turning angle is calculated. PD method is applied on location and angle. After careful modification the corresponding parameters are decided empirically. In addition by using some other methods such as track segmentation and dead area presetting, the model car can obtain better status including good stability and fine tracking character in high speed.

Keywords:Road Tracking, Proportion-Integration-Deviation Control, Symmetric Positioning, Discrete, Continual

第一届“飞思卡尔”杯全国大学生智能车邀请赛的赛题是控制比赛小车，使其按要求用尽可能短的时间完成比赛赛道，比赛允许选手自行设计传感器和控制电路，并编写控制程序，禁止改动舵机和轮胎等小车结构。针对这种要求，从控制系统的观点出

发，我们按照设计跟随系统的思路设计车模的控制策略；从几何关系上讲，为了实现车模的寻线运动，控制器应当控制前轮转向，满足在车模运动中车身相对于线的位置偏差和车身纵向相对于线的夹角为0的控制目标。根据以上思路，寻线跟随系统应当有2个输入——位置偏差和角度偏差，1个输出——舵机转角，考虑了速度的因素后，系统便成为一个3输入2输出的复杂系统。在我们的方案中，位置偏差和角度偏差由光偶传感器检测得到，舵机转角由PWM信号控制。由于通常传感器检测得到的量是离散量，动作控制也只能针对离散量进行控制，并且根据单片机的处理能力，我们使用数字PID作为基本的控制器，但这只适用于低速情况，高速情况下过于离散的控制将造成系统控制缓慢、滞后，阶跃变化较大，甚至无法达到控制目标。由于这种原因，将小车速度提升之后，对小车进行连续控制是十分必要的，实际结果证明，传感器检测模拟量进行连续位置和角度的PID控制可以使小车具有很好的稳定性和跟随特性。

1.数字量的采集和数字PID控制

1.1.位置计算

判断传感器输出数字量，根据读到黑线的传感器确定位置，以14个光耦传感器对称排列为例，根据传感器状态，位置分别为-14,-13,…,0,…13,14。其中-14和14分别表示黑线在传感器左侧且没有传感器输出1和黑线在传感器右侧且没有传感器输出1，其它奇数位置表示相应传感器输出1，偶数位置表示相邻两个传感器输出1。