1 ÁP DNG LOGIC M TRONGBÀITOÁNTRÁNH VT CN CHOROBOT T HÀNHBÁM MC TIÊUDI NG Fuzzy Logic Application in Obstacle Avoidance Problem for Mobile Robot Tracking the Moving Target Trn Vn Tùng * - Lê Hoài Quc ** * môn C s Thit k máy, ** B môn K thut u khin tng Khoa C Khí – Trng i Hc Bách Khoa – i Hc Quc Gia HCM Tóm tt Bài báo gii thiu nhng kt qu ban u trong vic nghiên cu gii thut và phn mm u khin logic m áp dng trên mô hình robot t hành vi hai bánh chng phía trc và c trang b camera nhn dng và bám mc tiêudi ng, các cm bin siêu âm và hng ngoi nhn bit và tránh các vt cn ngu nhiên xut hin trên ng di chuyn ca robot. Abstract This paper introduces the initial achievements in performing the controller using fuzzy logic applied in the mobile robot equiping two front – wheels steering, camera for indentification of the mobile target knowing in advance, sonar and infra-red sensors for avoidance of random obstacles. 1. Gii thiu bàitoán và mô hình nghiên cu có th t hành, robot phi có kh nng nhn bit c u kin a hình và kh nng nh hng i n mc tiêu. a hình robotdi chuyn có thã bit trc hoc hoàn toàn cha bit. ng thi a hình có th thay i a dng nh: b mt di chuyn không ng phng, có vt cn cnh hoc xut hin ngu nhiên trên ng i, s thay i ca h ma sát … Trongbài báo này, chúng tôi ngh mt gii thut và phn mm u khin robottránh t cn bng phng pháp u khin m vi d liu thu nhn c t cm bin siêu âm và ng ngoi. Vic bám mc tiêudi ng cho trc c thc hin nh digital camera lp trên pan-til hai trc dn ng và u khin bi hai ng c bc. t s gi thit ban u t ra chobài toán: - a hình hot ng tng i bng phng. - Vt cn có th cnh hoc xut hin ngu nhiên 2 9 8 76 5 4 3 2 1 - Mc tiêudi ng vi vi vn tc nh và có th b che khut tm thi bi các vt n. - Khong cách gia các vt cn ≥ 1m Mô hình nghiên cu mô phng kt qu nghiên cu, chúng tôi ã ch to mt mô hình robot t hành vi hai bánh dn ng c lp bng các ng c AC servo c b trí phía trc, mt bánh tùy ng phía sau vi kích thc bao 500mm x 700mm c mô t nh trên hình 1 di ây. 1. Các b thu phát hng ngoi 2. Motor quay cm bin siêu âm trong mt phng m ngang 3. Cm bin siêu âm 4. Motor quay camera trong mt phng nm ngang 5. Camera bám mc tiêucho trc 6. Bánh t la phía sau 7. Hai bánh chng phía trc 8. Motor AC servo 9. Các b truyn ai quay camera và cm bin siêu âm trong mt phng thng ng phn cm nhn trên robot bao gm: 1. 01 camera k thut s JVC c t trên khung hai bc t do bám theo mc tiêudi ng cho trc. 2. 01 cm bin siêu âm E4PA–LS400–M1 vi tm phát hin t 0,5m ÷ 4m cng c t trên khung mt bc t do nhn bit vt cn khong cách xa. 3. 05 b thu phát hng ngoi BX700 vi tm phát hin 0,7 m c b trí phía trc nhn bit vt cn khong cách gn và giúp tránh va chm trong quá trình di ng ca robot. 2. NG DNG LOGIC M TRONGBÀITOÁNTRÁNH VT CN m bin siêu âm s thc hin nhim v phát hin vt cn t xa. D liu thu nhn c cm bin này có th cho bit c kích thc ca vt cn, góc ca vt cn so vi vect phng chính ca robot . Các d liu này s là bin u vào cho bu khin m. Ngoài ra, robot phi nhn dng và bám theo mc tiêucho trc nh camera, nên góc quay ca Hình 1: b trí thit b trên mô hình robot hành . ÁP DNG LOGIC M TRONG BÀI TOÁN TRÁNH VT CN CHO ROBOT T HÀNH BÁM MC TIÊU DI NG Fuzzy Logic Application in Obstacle Avoidance Problem for Mobile Robot. vt cn khong cách gn và giúp tránh va chm trong quá trình di ng ca robot. 2. NG DNG LOGIC M TRONG BÀI TOÁN TRÁNH VT CN m bin siêu âm s