摘 è¦ï¼šè©²æ™ºèƒ½è»ŠæŽ§åˆ¶ç³»çµ±çš„硬件以MC9S12DG128å–®ç‰‡æ©Ÿç‚ºæ ¸å¿ƒï¼ŒåŒ…æ‹¬è·¯å¾‘æª¢æ¸¬æ¨¡å¡Šã€è»Šé€Ÿæª¢æ¸¬æ¨¡å¡Šã€èˆµæ©Ÿè½‰å‘模塊ã€ç›´æµé›»æ©Ÿé©…動模塊ã€é›»æºæ¨¡å¡Šå’Œé€šè¨Šèª¿è©¦æ¨¡å¡Šç‰éƒ¨åˆ†ã€‚路徑檢測采用CMOSæ”åƒé ,車速檢測采用安è£äºŽåŽè»¸ä¸Šçš„æ—‹è½‰ç·¨ç¢¼å™¨ï¼Œå¾žè€Œåˆ†åˆ¥æ§‹æˆäº†è½‰å‘å’Œè»Šé€Ÿå…©å€‹é–‰ç’°æŽ§åˆ¶ç³»çµ±ã€‚è½‰å‘æŽ§åˆ¶é‡‡ç”¨ä¸å®Œå…¨å¾®åˆ†PD控制器,速度控制采用PID控制器。兩個閉環控制系統的è¨å®šå€¼å‡ç”±ä¸»æŽ§ç¨‹åºçµ¦å‡ºï¼Œå½¢æˆäº†å…·æœ‰åˆ†å±¤çµæ§‹çš„æ™ºèƒ½è»ŠæŽ§åˆ¶ç³»çµ±ã€‚
é—œéµè©žï¼šæ™ºèƒ½è»Šï¼›è·¯å¾‘跟蹤;控制器;傳感器
Abstract:The hardware of the smart car control system takes a singlechip of MC9S12DG128 as the core, including the path detecting module, the car’s speed detecting module, the rudder machine’s direction changing module, the direct current motor’s drive module, the power supply module and communication debugging module etc.The path detecting adopts the CMOS camera. The car’s speed detecting adopts the revolving encoder to be installed in the as the tail shaft of the smart car.thus they respectively constitute two closed-loop control systems which are the direction changing and the car’s speed. The direction changing control adopts the incomplete differential PD controller.The speed control adopts the PID controller.Two given values of two closed-loop control systems are both provided by the master programme, coming into being the smart control system with the layering structure.
Keyword:Smart car;Path follow;Controller; Sensor
1引言
我國自2006年起舉辦的全國大å¸ç”Ÿâ€œé£›æ€å¡çˆ¾æ¯â€æ™ºèƒ½æ±½è»Šç«¶è³½èžç§‘叿€§ã€è¶£å‘³æ€§å’Œè§€è³žæ€§ç‚ºä¸€é«”ï¼Œæ˜¯ä¸€é …ä»¥è¿…çŒ›ç™¼å±•ã€å‰æ™¯å»£é—Šçš„æ±½è»Šé›»åç‚ºèƒŒæ™¯ï¼Œæ¶µè“‹äº†è‡ªå‹•æŽ§åˆ¶ã€æ¨¡å¼è˜åˆ¥ã€å‚³æ„ŸæŠ€è¡“ã€é›»åã€é›»æ°£ã€è¨ˆç®—æ©Ÿã€æ©Ÿæ¢°èˆ‡æ±½è»Šç‰å¤šå€‹å¸ç§‘å°ˆæ¥çš„科技創新比賽。åƒè³½éšŠä¼åœ¨è»Šæ¨¡å¹³è‡ºåŸºç¤Žä¸Šï¼Œåˆ¶ä½œä¸€å€‹èƒ½å¤ 自主è˜åˆ¥è·¯ç·šçš„æ™ºèƒ½è»Šï¼Œåœ¨å°ˆé–€è¨è¨ˆçš„è³½é“上自動è˜åˆ¥é“路行駛 [sup][1][/sup]。
æœ¬æ–‡æ‰€è¿°çš„æ™ºèƒ½è»Šå°±æ˜¯æ ¹æ“šæ¯”è³½è¦å‰‡è¦æ±‚è¨è¨ˆå¹¶åˆ¶ä½œè€Œæˆçš„,該智能車控制系統采用飛æ€å¡çˆ¾åŠå°Žé«”å…¬å¸ç”Ÿç”¢çš„16ä½MC9S12DG128å–®ç‰‡æ©Ÿä½œç‚ºæ•¸å—æŽ§åˆ¶å™¨,由安è£åœ¨è»Šå‰éƒ¨çš„黑白CMOSæ”åƒé è² è²¬é‡‡é›†è³½é“ä¿¡æ¯,并將采集到的信號經二值化處ç†åŽå‚³å…¥å–®ç‰‡æ©Ÿ,單片機å°ä¿¡è™Ÿé€²è¡Œåˆ¤æ–·è™•ç†åŽ,ç”±PWM發生模塊發出PWMæ³¢å°è½‰å‘舵機進行控制,å®Œæˆæ™ºèƒ½è»Šçš„轉å‘。å¦å¤–,智能車åŽè¼ªä¸Šè£æ—‹è½‰ç·¨ç¢¼å™¨,用來采集車輪速度的脈沖信號,單片機使用PID控制算法處ç†åŽçš„æŽ§åˆ¶é‡åŽ»æ”¹è®Šé›»æ©Ÿé©…å‹•æ¨¡å¡Šçš„PWMæ³¢å 空比,從而控制智能車的行駛速度。
2控制方案è¨è¨ˆå’Œç¡¬ä»¶é›»è·¯çµ„æˆ
è¨è¨ˆæœ‰æ•ˆçš„æ™ºèƒ½è»ŠæŽ§åˆ¶ç³»çµ±å¿…é ˆé¦–å…ˆæŽŒæ¡æŽ§åˆ¶å°è±¡çš„ç‰¹æ€§ã€‚æ ¹æ“šå°æ™ºèƒ½è»Šç‰¹é»žçš„分æžï¼Œå¯ä»¥èªç‚ºæ™ºèƒ½è»Šè½‰å‘控制系統的傳éžå‡½æ•¸è¿‘似為一階ç©åˆ†åŠ ç´”æ»¯åŽï¼Œé€Ÿåº¦æŽ§åˆ¶å°è±¡çš„傳éžå‡½æ•¸è¿‘ä¼¼ç‚ºä¸€éšŽæ…£æ€§åŠ ç´”æ»¯åŽçš„çµè«–。
è½‰å‘æŽ§åˆ¶ç³»çµ±ä¸»è¦æ˜¯è¦æ±‚響應速度快,å°ç©©æ…‹æŽ§åˆ¶ç²¾åº¦è¦æ±‚ä¸é«˜ã€‚而且控制å°è±¡åªæœ‰ç©åˆ†å’Œæ»¯åŽç’°ç¯€ï¼Œæ²’æœ‰å¸¸è¦‹çš„æ…£æ€§ç’°ç¯€ã€‚æ ¹æ“šä»¥ä¸Šç‰¹é»žï¼Œè½‰å‘æŽ§åˆ¶é‡‡ç”¨PD控制器。
å°é€Ÿåº¦é€²è¡Œæª¢æ¸¬å’ŒæŽ§åˆ¶çš„æ„ç¾©åœ¨äºŽç›¡å¯èƒ½ä½¿æ™ºèƒ½è»ŠæŒ‰ç…§é“è·¯æ¢ä»¶å…許的最高速度行駛。
åœ¨å½Žé“æ‡‰å°‡è»Šé€Ÿé™åˆ¶ç‚ºä¸è„«è»Œçš„æœ€é«˜é€Ÿåº¦ï¼Œåœ¨ç›´é“應當é©ç•¶é€²è¡Œæ€¥åŠ é€Ÿä»¥ç¸®çŸå–®åœˆé‹è¡Œæ™‚間,æé«˜æ¯”è³½æˆç¸¾ã€‚åŒæ™‚,å°é€Ÿåº¦ä¿¡è™Ÿé€²è¡Œç©åˆ†æ±‚å’Œå¯ä»¥å¾—到賽é“長度信æ¯ï¼Œç‚ºé“è·¯è˜åˆ¥èˆ‡è¨˜æ†¶æ¨¡å¡Šæä¾›æ•¸æ“šã€‚智能車速度控制系統的精度ä¸éœ€è¦å¤ªé«˜ï¼Œé—œéµæ˜¯å¦‚何快速響應賽é“的路æ³è®ŠåŒ–ã€‚å› æ¤é€Ÿåº¦æŽ§åˆ¶é‡‡ç”¨PID控制器。é‡å°ä¸åŒçš„é“路狀æ³è¿…速準確地改變車速,實ç¾ç©©å®šéŽå½Žã€‚
智能車的硬件電路主è¦ç”±è¦–é »è™•ç†æ¨¡å¡Šã€æ–¹å‘控制模塊和車速控制模塊組æˆã€‚儿¨¡å¡Šèˆ‡å–®ç‰‡æ©Ÿä¹‹é–“的關系如圖1所示。

3 模塊功能
(1ï¼‰è¦–é »è™•ç†æ¨¡å¡Šã€‚è¦–é »è™•ç†æ¨¡å¡Šç”±CMOSæ”åƒé ã€äºŒå€¼åŒ–é›»è·¯å’ŒåŒæ¥åˆ†é›¢é›»è·¯æ§‹æˆã€‚
(2ï¼‰è½‰å‘æŽ§åˆ¶æ¨¡å¡Šã€‚è½‰å‘æŽ§åˆ¶æ¨¡å¡Šä¸»è¦ç”±èˆµæ©Ÿå®Œæˆã€‚èˆµæ©Ÿçš„è½‰å‹•æœƒè½‰åŒ–ç‚ºè»Šæ¨¡è½‰å‘æ‹‰æ¡¿çš„æ©«å‘移動,從而帶動車模å‰è¼ªçš„轉動,控制智能車的行駛方å‘ã€‚èˆµæ©Ÿçš„è½‰å‘æŽ§åˆ¶é‡‡ç”¨PDæŽ§åˆ¶ï¼Œæ ¹æ“šè³½é“ä¸å¤®é»‘ç·šçš„ä½ç½®,單片機å‘舵機輸出相應å 空比的PWM信號。
(3)車速控制模塊。車速控制模塊主è¦ç”±ç›´æµé›»æ©Ÿã€é©…動電路和旋轉編碼器構æˆã€‚æ ¹æ“šCMOSæ”åƒé 所檢測的路徑信æ¯åˆ¤æ–·æ™ºèƒ½è»Šç•¶å‰æ‰€è™•的賽é“ç‹€æ³,å¹¶æ ¹æ“šæ—‹è½‰ç·¨ç¢¼å™¨æ‰€æª¢æ¸¬çš„å¯¦éš›è»Šé€Ÿå½¢æˆå°æ™ºèƒ½è»Šè¡Œé§›é€Ÿåº¦çš„閉環控制,åˆç†åœ°èª¿æ•´æ•¸å—PID控制算法的Kpã€Kiã€Kdä¸‰å€‹åƒæ•¸,é”åˆ°è»Šé€ŸéŸ¿æ‡‰è¿…é€Ÿå¹¶æ¶ˆé™¤éœæ…‹èª¤å·®çš„目的。
[b]4 電路è¨è¨ˆ
[/b] (1ï¼‰é›»æºæ¨¡å¡Šè¨è¨ˆã€‚é›»æºæ¨¡å¡Šè¦ç‚ºå–®ç‰‡æ©Ÿã€å‚³æ„Ÿå™¨ã€èˆµæ©Ÿå’Œé©…å‹•é›»æ©Ÿä¾›é›»ã€‚å› æ¤éœ€è¦æä¾›å¤šç¨®é›»æºæ»¿è¶³å„å€‹æ¨¡å¡Šçš„è¦æ±‚ã€‚é›»æ± åœ¨å®Œå…¨å……æ»¿ä¹‹åŽç©ºè¼‰é›»å£“åªæœ‰8vå·¦å³ï¼Œå¹¶éš¨è‘—é›»æ± çš„æ¶ˆè€—ï¼Œé›»å£“é€æ¼¸é™ä½Žã€‚電機啟動åŠå接制動時電æµå¾ˆå¤§ï¼Œä¹Ÿæœ‰å¯èƒ½å°‡é›»æ± 電壓拉得比較低。為了é¿å…é›»æºé›»å£“ä¸ç©©å®šï¼Œå½±éŸ¿æ”åƒé è¦–é »è™•ç†é›»è·¯å’Œå–®ç‰‡æ©Ÿå·¥ä½œä¸æ£å¸¸ï¼Œåœ¨æœ¬è¨è¨ˆæ–¹æ¡ˆä¸ä½¿ç”¨äº†DC-DC變æ›èŠ¯ç‰‡MC34063以åŠä½Žå·®å£“穩壓器LM2940。MC34063輸出穩定的8ä¼é›»å£“æä¾›çµ¦CMOSæ”åƒé ,LM2940為16ä½MC9S12DG128單片機ã€è¦–é »æ”¾å¤§åŠäºŒå€¼åŒ–電路æä¾›ç©©å®šçš„5ä¼é›»æºï¼Œä¿è‰äº†ç³»çµ±åœ¨å„種情æ³ä¸‹çš„穩定é‹è¡Œã€‚é›»æºæ¨¡å¡ŠåŽŸç†åœ–如圖2所示。

(2)直æµé›»æ©Ÿé©…動模塊è¨è¨ˆã€‚ç›´æµé›»æ©Ÿé©…動采用飛æ€å¡çˆ¾å…¬å¸çš„5A 集æˆH橋芯片MC33886。MC33886芯片內置了控制é‚輯ã€é›»è·æ³µã€é–€é©…動電路以åŠä½Žå°Žé€šé›»é˜»çš„MOSFET輸出電路,é©åˆç”¨ä¾†æŽ§åˆ¶æ„Ÿæ€§ç›´æµè² 載(例如直æµé›»æ©Ÿï¼‰ã€‚å¯ä»¥æä¾›é€£çºŒçš„5Aé›»æµï¼Œå¹¶ä¸”集æˆäº†éŽæµä¿è·ã€éŽç†±ä¿è·ã€æ¬ 壓ä¿è·ã€‚é€šéŽæŽ§åˆ¶MC33886 çš„å››æ ¹è¼¸å…¥ç·šå¯ä»¥æ–¹ä¾¿åœ°å¯¦ç¾é›»æ©Ÿæ£è½‰ã€èƒ½è€—制動åŠå接制動。圖3為經éŽç°¡åŒ–çš„H橋電路,當S1ã€S4 導通且S2ã€S3 æˆªæ¢æ™‚ï¼Œé›»æµæ£å‘æµéŽç›´æµé›»æ©Ÿï¼Œæ™ºèƒ½è»Šå‰é€²ï¼›ç•¶S2ã€S3 導通且S1ã€S4 æˆªæ¢æ™‚,電æµå呿µéŽç›´æµé›»æ©Ÿï¼Œé©ç•¶åˆ©ç”¨é€™å€‹éŽç¨‹å¯ä»¥ä½¿è»Šæ¨¡è™•äºŽåæŽ¥åˆ¶å‹•的狀態,迅速é™ä½Žè»Šé€Ÿï¼›ç•¶S3ã€S4導通且S1ã€S2 æˆªæ¢æ™‚,沒有電æºåŠ åœ¨ç›´æµé›»æ©Ÿä¸Šï¼Œç›´æµé›»æ©Ÿé›»æ¨žå…©ç«¯ç›¸ç•¶äºŽçŸæŽ¥åœ¨ä¸€èµ·ã€‚由于電機軸在外力作用下旋轉時,電機å¯ä»¥ç”¢ç”Ÿé›»èƒ½ï¼Œæ¤æ™‚å¯ä»¥æŠŠç›´æµé›»å‹•機看作一個帶了很é‡è² 載的發電機,電機上會產生一個阻礙輸出軸é‹å‹•的力,這個力的大å°èˆ‡è² è·çš„大尿ˆæ£æ¯”ï¼Œæ¤æ™‚電機處于能耗制動狀態。
本è¨è¨ˆæ–¹æ¡ˆä¸é‡‡ç”¨å…©ç‰‡MC33886å¹¶è¯ï¼Œä¸€æ–¹é¢æ¸›å°å°Žé€šé›»é˜»å°ç›´æµé›»æ©Ÿç‰¹æ€§çš„影響,å¦ä¸€æ–¹é¢æ¸›å°MC33886å…§éƒ¨çš„éŽæµä¿è·é›»è·¯å°é›»æ©Ÿå•Ÿå‹•åŠåˆ¶å‹•時的影響。直æµé›»æ©Ÿé©…動模塊電路原ç†åœ–如圖4所示。


(3)傳感器電路è¨è¨ˆã€‚智能車采用CMOSæ”åƒé 作為圖åƒå‚³æ„Ÿå™¨,ä¿è‰è³½é“ä¿¡æ¯é‡‡é›†æº–確有效。CMOSæ”åƒé 的輸出信號是PAL制å¼çš„復åˆå…¨é›»è¦–信號,æ¯ç§’輸出50幀(分為å¶å ´å’Œå¥‡å ´ï¼‰ã€‚ç•¶CMOSæ”åƒé é‡‡é›†åœ–åƒæ™‚,å¶å ´å’Œå¥‡å ´ä¸æ˜¯åŒæ™‚é‡‡é›†çš„ï¼Œå› æ¤ï¼Œå¯ä»¥åœ¨æ¯å ´ä¿¡è™Ÿéƒ½å°è·¯å¾‘進行è˜åˆ¥ã€‚
(4)無線數據傳輸模塊è¨è¨ˆã€‚æ™ºèƒ½è»ŠåŠ è£äº†åŸºäºŽå°„é »æ”¶ç™¼èŠ¯ç‰‡nRF403的無線數據傳輸模塊,并在æ¤åŸºç¤Žä¸Šå¯¦ç¾äº†MODBUS 通信å”è°ï¼Œåœ¨æ¸¬è©¦æ™ºèƒ½è»Šåƒæ•¸åŠç¨‹åºèª¿è©¦çš„éŽç¨‹ä¸å¾ˆæœ‰å¹«åŠ©ã€‚åœ¨é‹è¡Œçš„éŽç¨‹ä¸å¯ä»¥å°‡æ™ºèƒ½è»Šçš„å„é …åƒæ•¸å¯¦æ™‚地發é€ä¸Šä¾†ï¼Œåˆ†æžæ™ºèƒ½è»Šçš„é‹è¡Œç‹€æ…‹å¯ä»¥æ›´æœ‰é‡å°æ€§åœ°å°æŽ§åˆ¶ç¨‹åºé€²è¡Œæ”¹é€²ã€‚在調試é‹å‹•åƒæ•¸çš„éŽç¨‹ä¸ï¼Œå¯ä»¥é€šéŽä¸Šä½æ©Ÿè»Ÿä»¶æ”¹è®Šå¦‚Kpã€Kiã€Kd ç‰åƒæ•¸ï¼Œè€Œä¸ç”¨é‡æ–°ç‡’寫程åºï¼Œè¿…速而方便。
5 軟件è¨è¨ˆ
智能車控制系統程åºçµæ§‹å¦‚圖5æ‰€ç¤ºï¼Œé€™æ˜¯ä¸€å€‹å…©å±¤çš„åˆ†ç´šæŽ§åˆ¶ç³»çµ±ã€‚åº•å±¤æŽ§åˆ¶ç³»çµ±åŒ…æ‹¬â€œè½‰å‘æŽ§åˆ¶ç³»çµ±â€å’Œâ€œè»Šé€ŸæŽ§åˆ¶ç³»çµ±â€ ,上層主控程åºé€šéŽæ”¹è®Šåº•層控制系統的è¨å®šå€¼ã€æŽ§åˆ¶åƒæ•¸å’Œç´„æŸæ¢ä»¶çš„æ–¹æ³•ï¼Œå°æ•´å€‹æŽ§åˆ¶ç³»çµ±é€²è¡Œèª¿åº¦ã€‚è¨è¨ˆé€™ç¨®åˆ†å±¤çµæ§‹çš„æŽ§åˆ¶ç³»çµ±æ˜¯åƒç…§äº†é›†æ•£æŽ§åˆ¶ç³»çµ±DCSçš„çµæ§‹ç‰¹é»žï¼Œç¨‹åºå„部分功能明確ã€çµæ§‹æ¸…晰,便于調試和ç¶è·ã€‚為了調試方便,主控程åºä¸æ·»åŠ äº†åŸºäºŽç„¡ç·šä¿¡é“çš„MODBUS通訊å”è°ï¼Œå°æ™ºèƒ½è»Šè¡Œé§›åƒæ•¸çš„監視和調整æä¾›äº†å¾ˆå¤§çš„便利。

軟件所實ç¾çš„功能有:
â‘ åˆå§‹åŒ–。
â‘¡æ•¸æ“šé‡‡é›†åŠæ¿¾æ³¢è™•ç†ã€‚ç‚ºäº†ç›¡é‡æ¸›å°‘å¼•å…¥çš„ç´”æ»¯åŽæ™‚間,本文æå‡ºäº†ä¸€ç¨®ç¨ç‰¹çš„å…·æœ‰å‰µæ–°æ€§çš„è¦–é »ä¿¡è™Ÿé‡‡é›†æ–¹æ³•ï¼Œå³ç”¨MC9S12DG128 單片機æä¾›çš„SPI å£ç›´æŽ¥è®€å–ç¶“éŽäºŒå€¼åŒ–處ç†çš„è¦–é »ä¿¡è™Ÿã€‚å¤§è³½è¦å‰‡ä¸æŒ‡å®šäº†è³½é“上黑色引導線的寬度為2.5 厘米,故æ”åƒé ä¸é‡‡é›†åˆ°çš„引導線寬度在æ£å¸¸æƒ…æ³ä¸‹ä¹Ÿæ‡‰ç•¶è½åœ¨ä¸€å®šèŒƒåœå…§ã€‚å¯ä»¥ç”¨å¯¦é©—çš„æ–¹æ³•æ¸¬å¾—å¼•å°Žç·šå°æ‡‰çš„åƒç´ 寬度,然åŽåœ¨æ¿¾æ³¢ç¨‹åºä¸å°é‡‡é›†åˆ°çš„引導線線寬進行控制,如果超出æ£å¸¸èŒƒåœå³èªç‚ºæ˜¯ç„¡æ•ˆæ•¸æ“šã€‚å¯¦é©—è‰æ˜Žï¼Œé€™ç¨®æ–¹æ³•å¯ä»¥æœ‰æ•ˆåœ°å°‡å¹²æ“¾æ¿¾é™¤ã€‚
â‘¢é“è·¯è˜åˆ¥ã€‚æ™ºèƒ½è»Šåˆ†å±¤æŽ§åˆ¶ç³»çµ±çš„æ ¸å¿ƒæ˜¯è³½é“çš„è˜åˆ¥ã€‚實際測試發ç¾ç”±äºŽCMOSæ”åƒé çš„å¯è¦–èŒƒåœæ¯”較å°è€Œä¸”視野范åœå‘ˆæ¢¯å½¢ï¼Œåœ¨å¿«é€Ÿé‹å‹•ä¸ç¶“常發生賽é“部分甚至全部脫離視野范åœçš„æƒ…æ³ï¼Œçµ¦è³½é“è˜åˆ¥å¸¶ä¾†å¾ˆå¤§çš„å›°é›£ï¼Œå› æ¤å®Œæ•´è˜åˆ¥è³½é“模å¼å¹¾ä¹Žæ˜¯ä¸å¯èƒ½çš„。為了簡化å•題,本方案åªè˜åˆ¥è³½é“ä¸çš„ç›´ç·šæ®µï¼Œæ ¹æ“šç›´ç·šæ®µçš„æ•¸é‡å’Œé•·åº¦å°‡è³½é“分割æˆä¸åŒçš„å€åŸŸï¼Œåœ¨ä¸€å€‹å€åŸŸä¸å°æŽ§åˆ¶åƒæ•¸é€²è¡Œå„ªåŒ–。
â‘£é›»æ©ŸæŽ§åˆ¶ã€‚å–®ç‰‡æ©Ÿé€šéŽæŽ¥æ”¶æ—‹è½‰ç·¨ç¢¼å™¨æª¢æ¸¬æ™ºèƒ½è»ŠåŽè¼ªè½‰å‹•所產生的脈沖數,采用ä½ç½®å¼PIDæŽ§åˆ¶ç®—æ³•çš„éžæŽ¨å½¢å¼å°ç›´æµé›»æ©Ÿçš„轉速進行快速準確地控制。
ä½ç½®å¼PIDæŽ§åˆ¶ç®—æ³•çš„éžæŽ¨å½¢å¼ï¼š
Δu(k) =Kp[e(k) -e(k-1)] +Ki×e(k) +Kd[e(k) -2e(k-1) +e(k-2)],u(k) =u(k-1) +Δu(k)
å¼ä¸ï¼šu(k)為k時刻控制器的輸出; e(k)為k時刻的åå·®;Kpã€Kiã€Kd分別為ä½ç½®å¼PID控制算法的比例系數ã€ç©åˆ†å¸¸æ•¸å’Œå¾®åˆ†å¸¸æ•¸[sup][7][/sup]。
⑤舵機控制。單片機通éŽCMOSæ”åƒé 檢測到的路徑信æ¯,采用ä¸å®Œå…¨å¾®åˆ†PD控制算法控制舵機的轉角,實ç¾è·¯å¾‘跟蹤。

6 çµèªž
本文介紹了一種智能車控制系統的è¨è¨ˆèˆ‡å¯¦ç¾ã€‚圖5為已制作完æˆçš„æ™ºèƒ½è»Šå¯¦ç‰©ç…§ç‰‡ã€‚通éŽå¤§é‡å¯¦é©—æ¸¬è©¦è‰æ˜Žè©²æ™ºèƒ½è»Šèƒ½å¿«é€Ÿå¹³ç©©åœ°åœ¨åˆ¶ä½œçš„è³½é“上跟蹤黑色引導線行駛,尋跡效果良好,速度控制響應快,動態性能良好,穩態誤差較å°,系統的穩定性和抗干擾能力強。在2008舉辦的全國大å¸ç”Ÿâ€œé£›æ€å¡çˆ¾æ¯â€æ™ºèƒ½æ±½è»Šç«¶è³½ä¸å–得了è¯åŒ—è³½å€äºŒç‰çŽçš„好æˆç¸¾ï¼Œ
å……åˆ†è‰æ˜Žäº†è¨è¨ˆæ–¹æ¡ˆçš„æœ‰æ•ˆæ€§å’Œç©©å®šæ€§ã€‚
åƒè€ƒæ–‡ç»ï¼ˆReferences):
[1]http://www.smartcar.org.cn
[2]ã€€å“æ™´,王çŽ, 王磊. 基于é¢é™£CCD è·¯å¾‘åƒæ•¸æª¢æ¸¬æ–¹æ³•[J].é›»å產å“世界.2006 å¹´4 月
[3] 黃開å‹,é‡‘è¯æ°‘,蔣狄å—.韓國智能模型車技術方案分æž[J].é›»å產å“世界.2006 å¹´3 月
[4] MC9S12DT128 Device User Guide[Z] 9S12DT128DGV2/D V02.15 2005
[5] 王京起,陳慧巖,é„培.æ‡‰ç”¨æ¨¡ç³Šè‡ªé©æ‡‰PID å’Œé çž„ç–ç•¥çš„è‡ªä¸»è»Šè¼›è½‰å‘æŽ§åˆ¶[J].25(4)
汽車工程.2003
[6] 王志ä¸,王榮本,å¼µå‹å¤,æŽå…µ.自動引導車輛轉å‘系統的辨è˜å»ºæ¨¡[J].è¾²æ¥å·¥ç¨‹å¸å ±15(2).1999
[7]  賴壽å®.微型計算機控制技術[M].北京.機械工æ¥å‡ºç‰ˆç¤¾.2000å¹´5月
[8]  陳宋,æŽç«‹åœ‹,黃開å‹.智能模型車底盤淺æž[J]. .é›»å產å“世界.2006å¹´6月