第1页共12页编号:时间:2021年x月x日书山有路勤为径,学海无涯苦作舟页码:第1页共12页基于光耦传感器的控制方法-从离散量到连续量康世胤1,李长城2,莫一林3,顾全全4,陆耿5(1.清华大学自动化系,北京100084;2.清华大学自动化系,北京100084;3.清华大学自动化系,北京100084;4.清华大学自动化系,北京100084;5.清华大学自动化系,北京100084)摘要:第一届“飞思卡尔”杯全国大学生智能车邀请赛要求对高速行驶的小车进行实时控制,使其巡线完成比赛赛道。针对这种要求,我们选择了最成熟的PID控制,尝试了由离散的不完全微分的PD控制到相对连续PD控制的过渡,通过采集光耦传感器输出的模拟量,采用对称求位置法得到连续性较好的位置信息,利用双排传感器计算角度,对位置和角度同时进行PD控制,经过细致调试确定相应参数,并合理利用分段、设置死区等方法,最终小车可以获得较好的稳定性和在高速情况对赛道中心线的跟随特性。关键词:道路寻迹;PID控制;对称定位;离散;连续第2页共12页第1页共12页编号:时间:2021年x月x日书山有路勤为径,学海无涯苦作舟页码:第2页共12页ControlMethodBasedonPhotoelectricCouplingDevice–fromDiscreteSignaltoContinualSignalKANGShiyin1,LIChangcheng2,MOYilin3,GUQuanquan4,LUGeng5(1.Automation,TsinghuaUniversity,Beijing100084,China;2.Automation,TsinghuaUniversity,Beijing100084,China;3.Automation,TsinghuaUniversity,Beijing100084,China;4.Automation,TsinghuaUniversity,Beijing100084,China;5.Automation,TsinghuaUniversity,Beijing100084,China;)Abstract:InthecomingFREESCALECollegeStudentSmartCarCompetition’06,realtimecontrolstrategiesarerequiredtobeappliedinthehigh-speedmodelcarwhichtomakesurethecartrackingtheunknownroadandfinishing2lapsofgame.Basedontherequirementweselectoneofthemostwellappliedproportion-integration-deviation(PID)method.MuchworksarecarriedoutincludingtryingvariesofstrategyfrominitialdiscretePDtofinalcontinualPD.InthecurrentstrategyanalogoutputofphotoelectriccouplingdevicesaresampledandconvertedfromAtoD.Symmetricpositioningmethodisappliedtoobtainprecisedirectioninformation.Furthermorebyapplyingdualsensorarraytheturningangleiscalculated.PDmethodisappliedonlocationandangle.Aftercareful第3页共12页第2页共12页编号:时间:2021年x月x日书山有路勤为径,学海无涯苦作舟页码:第3页共12页modificationthecorrespondingparametersaredecidedempirically.Inadditionbyusingsomeothermethodssuchastracksegmentationanddeadareapresetting,themodelcarcanobtainbetterstatusincludinggoodstabilityandfinetrackingcharacterinhighspeed.Keywords:RoadTracking,Proportion-Integration-DeviationControl,SymmetricPositioning,Discrete,Continual第一届“飞思卡尔”杯全国大学生智能车邀请赛的赛题是控制比赛小车,使其按要求用尽可能短的时间完成比赛赛道,比赛允许选手自行设计传感器和控制电路,并编写控制程序,禁止改动舵机和轮胎等小车结构。针对这种要求,从控制系统的观点出发,我们按照设计跟随系统的思路设计车模的控制策略;从几何关系上讲,为了实现车模的寻线运动,控制器应当控制前轮转向,满足在车模运动中车身相对于线的位置偏差和车身纵向相对于线的夹角为0的控制目标。根据以上思路,寻线跟随系统应当有2个输入——位置偏差和角度偏差,1个输出——舵机转角,考虑第4页共12页第3页共12页编号:时间:2021年x月x日书山有路勤为径,学海无涯苦作舟页码:第4页共12页了速度的因素后,系统便成为一个3输入2输出的复杂系统。在我们的方案中,位置偏差和角度偏差由光偶传感器检测得到,舵机转角由PWM信号控制。由于通常传感器检测得到的量是离散量,动作控制也只能针对离散量进行控制,并且根据单片机的处理能力,我们使用数字PID作为基本的控制器,但这只适用于低速情况,高速情况下过于离散的控制将造成系统控制缓慢、...