THUAT TOAN TRANH VAT CAN CHO ROBOT TlT HANH TRONG BAI TOAN DAN DUOTNG CUC BO TREN CO SOf DIEU KHIEN MO Phan Qudc Thdng, Ngo Vdn Chung,Biii Manh Dung Hoc vien Ky thugt Qudn sir Tdm tdt: Bdi bdo trinh bdy gidi phdp ddn duong cue bg cho robot tic hdnh dua trin ca sa logic ma ket hgp vai cdc bg cdm hicn sieu dm, bg thu tin hiiu vi tinh GPS gdn trin robot Bdi bdo cung giai thieu mgt so ket qud dgt diigfc ciia nhdm di tdi thuc ti xd\ dimg hi thong robot tu hdnh, to chiec chuang trinh xir ly die lieu vd dieu khiin, ciing cdc ket qud thir nghiem tren thirc dia trdnh vdt cdn dica tren phirang phdp diiu khiin dirge neu Abstract: This paper presents a solution of local guiding for self moving robot on the base of ultrasound sensors, data information from Global Positioning System GPS equipped on the robot This paper also introduces results in building in practice a self-moving robot, organizing program processing data, and test robot on the field to avoid roadblock based on the mentioned method I DAT VAN DE Bdi tdan xay dimg robot tu hdnh cd kha nang nhan biet va tu ddng trdnh cdc vat cdn luon thu hut su quan tam cua gidi khoa hgc Da cd khdng ft nhirng cdng trinh nghien ciiu giai quyet van de ndy dua tren cdc ly thuyet dieu khien truyen thdng Mac dii vay, thai gian gan day, ciing vdi sir phdt trien cua ky thuat cdng nghf, da xuat hifn cdc thiet bj hifn dai, cdc bo vi dieu khien rat manh cimg cdc bd cdm bien tien tien cho phep xay dung dugc cdc thuat toan thdng minh hon dieu khien cdc robot tu hdnh trdnh vat can Tir thuc te do, nhdm tdc gid de xuat thuat todn trdnh vat can cho robot tu hdnh bai todn dan dudng cue bd sii dung logic md ket hgp vdi cdc dau dd sieu am, cdc bd thu thong tin vf tin GPS vd la bdn difn tir Rieng bai todn dan dudng toan cue dieu khien robot tu hdnh trinh den diem dfch dinh trudc dugc trinh bay mdt bdi bdo rieng IL G I I THIEU BAI TOAN VA MO HINH NGHIEN ClTU Cd hai ldp bai todn dieu khien robot tu hanh la bai todn todn cue vd bdi todn todn cue bai todn todn cue, ban dd dudng di ciia robot co ban da dugc xdc djnh trudc Khi do, van de dat Id can xa^ dung hf thdng dieu khien de dan dudng robot tu hanh di dugc din dilm dfch da xdc djnh Doi vdi bdi todn cue bg, mdi trudng lam vifc cua robot khdng bilt trudc hdacchi biet dugc mdt phan Khi do, robot cin tu nhan bilt mdi trudng thdng qua hf thdng cdc cam bien trang bj tren robot Bai todn dan dudng cue bg Id nhdm dieu khien robot trdnh dugc cdc vat can ngau nhien hay bat ngd tren dudng di chuyen cua robot Trong bdi bdo ndy chiing tdi tap tmng vao gidi quylt Idp bdi todn thii hai - trdnh vat can cho ,0 robot tu hdnh Cd nhilu thuat todn dk thuc hien bai todn trdnh vat can cho robot Nhung cu the d day nhdm de tdi xay dung mdt bd dilu khien md v6i thdng tin dau vdo Id cdm biln sieu am dugc gan u^ - V ^ , tren robot De cho phep robot tilp tuc thuc hien Hinh Mo hinh nghien cuu i. ^ u^ A ^ i u - » - ^ f V -' Akthi I Bg thu GPS 2.Bdnh chit ddng Ddng ca ^f '"^^ bam duong sau da tranh vat can de 11 La bdn dien tic Bdnh ddn ddng sau Ba ^^ ^"^,^^^8 ^^em cac thong tin tu bd thu GPS va la ^^" ^° ^^ ^'"^ \\uang cho bai todn dan dudng cdm bien sieu dm Dai truyen dgng 750 Md hinh nghien ciiii Mi,ic tieu cua de tdi la xay dung robot vugt dja hinh, vi vay md hinh nghien cuu dirge xay dung cd cau tao de robot cd kha nang di chuyen tren dja hinh tuong doi go ghe Thiet ke robot dugc thvrc hien gom: Banh dai xfch, Dgng co truyen dgng bdng xfch, Bf mdy vd he truyen dong De truyen ddng cho banh xe can cd hai ddng co cdng suat du Idn de dilu khiln hai banh xfch trdi vaphdi Cdc cam bien dugc trang bj tren robot bao gdm: 01 bd thu tfn hifu ve tinh GPS eXplorist 500, dugc ddt cao ban thdn xe mgt chut, va d chfnh giira than robot, dk cho bilt thdn^ tin vl vj trf cua robot 01 la ban difn tir CMPS03 cho biet gdc Ifch ciia dudng di so vdi hudng Bdc dugc r,, , dat chi'nh giira tren ddu xe, trdnh xa tii da Len Medium hai dgng co phfa sau de giam nhilu toi da 03 cam bien sieu am SRF05 vdi tim phdt hifn tu 1cm 4m dugc dat phfa trudc robot de nhan biet vat can phfa trudc y r * * III THUAT T O A N T R A N H VAT CAN SC DVNG LOGIC M ti^A De robot cd khd ndng trdnh vat can xuat hifn tren dudng, tren robot bd tri cam bien Hinh B6 tri cam bien sieu am tren robot sieu am nhu hinh Thuc hien m& mat hoa cdc dai lurang: Cdc gid trj khoang cdch trd ve cua cam bien sieu am (0-40bcm) Id biln dau vao (Left, Ahead, Right) ciia bd dieu khien md vd dugc md hda thdnh: {Near, Medium, Far} MniWe-Alwid- Hinh 3: Md hoa gia tri khoang each ciia cam Men Trong trudng hgp cd cam biln khdng thu dugc tfn hifu d dau vdo (khdng cd vat cdn phfa trudc cam biln dd), do, ta gid thilt la dang cd vat can d khoang cdch xa ngodi 4m Gia thilt nhu vay nhdm dan gian qud trinh xir ly ma khdng dnh hudng din khd ndng trdnh vat can ciia robot Bk thuc hifn trdnh vat cdn, cd thi md hda cdc gid trj cdng suit ciia ddng co tap md (Lui nhanh (LN); Lui cham (LC); Dimg (D); Tiln cham (TC); Tiln nhanh (TN)} 751 Ludt md Ngay mot liong cam bien sieu am phiil hicn vat can, robot se chuyen tu' bui toan bam dudng sung bai toiin tranh vat can De xuc dinh phirang an tranh vat can tii uu phai duu vuo ylu tl: bien dang cuu vat can (dugc md 4y ' :' hinh hoa duu vuo thong tin id cam output y»ri«6te CCTrar bien sieu um); vu hirdng lech hien tai Hinh 4: Md hoa dap liiig cua dfng co" cuu robot so vdi dfch den (duu vuo GPS va la ban sl) Trong tmdng hgp bien dang ciia vat can khdng doi xirng, robot se tranh vl ben ma bien cua vat can d xa hon (di ve ben ft bj can hon) Trong cdc tinh huong d hinh 5, robot chgn phuong an tranh vl phfa ben trdi vi ben ft bi can ban Hinh 5: Mot so tinh huong tieu bieu trudng hgp vat can co bien khdng doi xirng Trudng hgp bien vat can ddi ximg, robot se sir dung them thdng tin tir GPS va la ban so de quyet djnh xem nen trdnh ve ben trdi hay ben phdi cua vat can Dua vao thiet bj GPS, co the xdc djnh dugc vj tri hien tai cua robot, cimg vdi vj tri dfch den ciia robot (cho trudc) thi se tfnh dugc hudng di mong muon cua robot so vdi phuang Bac La ban difn tir cho biet hudng lech hien tai ciia robot so vdi phuang Bdc tir (trong bai toan su sai Ifch giua phuang Bac dja ly va phuang Bdc tir la nhd va bd qua dugc) Tir nhung thdng tin dd, hdan todn xdc djnh dugc dfch den nam d ben phdi hay ben trdi so vdi budng hien tai ciia robot va chgn dd lam ben uu tien de robot trdnh ve ben dd cua vat can Hinh 6: Mot so tinh huong tieu bieu cua truong hpp vat can co bien dang doi xirng Td hgp dau vao tir cdc cam bien sieu am va hudng uu tien chung ta cd thi xay dung dugc 36 luat md (18 luat cho cac tiudng hgp ddi ximg vd 18 luat cho cdc trudng hgp khong ddi xiing) Trong mdt so tiirdng hgp, neu biet trudc ve hinh dang, kfch thudc ciia vat can chimg ta cd the loai bo bdt mdt so ludt khdng cd kha ndng hodc ft cd kha nang xay Nhung 752 de dam bao rolbot cd the phan irng vdi mgi tinh huong (ke ca vdi cac vat can di dgng) thi can xay dung day dii 36 luat md Vf du luat md tiirdng hgp bien vat can doi xu'ng (khoang each den vat can d ben deu la Far, vao phfa uu tien la right hay left ma chgn ben tranh cho robot): If (Left is Far) and (Ahead is Fur) und (Right is Far) and (uutien is right) then (DCTrai is TN) and (DCPhai is TC) If (Left is Far) and (Ahead is Far) and (Right is Far) and (uutien is left) then (DCTrai is TC) and (DCPhai is TN) Vf du luat md trudng hgp bien vat can la khdng doi xirng (ben trai la Far va ben phai la Medium), dd ta khdng can quan tam den ben uu tien ma se cho robot tranh ve ben ft bj can ban la ben trai : If (Left is Far) and (Ahead is Far) and (Right is Medium) then (DCTrai is TC) and (DCPhai isTN) Trong vf du tren, khoang cdch den vat can cdn xa nen robot chi can chinh hudng khong nhieu bang cdch giam tdc cua mgt ben dgng co Cdn cac tmdng hgp vat can d gan robot cd the phai be lai Idn hom tham chf liii lai neu vat can d qud gan Hgp thdnh vd gidi ma 400 l.ert Hinh : Moi quan he giira bien Left, Ahead Hinh : Moi quan he giira bien Left, Ahead va dong cor trai va dong cff phai \i-':.' J f^'i': ••'^'- " • '' ^ ^ RiCN Hinh 9: M6i quan he giua bien Right, Left va done ca trai Hinh 10: Moi quan he giua bien Right, Left va done co" phai Sir dung luat hgp thdnh max-min vd gidi md bdng phuang phdp diem trgng tam Mdi quan hf giii-a cdc biln vdo dugc md phdng tren Matlab nhu gidi thieu tren hinh 79: 753 IV TO CHlTC HE THONG DIEU KHIEN So dd khdi tl chirc hf dilu khiln cua robot vd sa dd gidi thuat dilu khien: Modul thu phdt khdng ddy La bhn s6 CMPS03 w May thu GPS Khii xirly trung tam vi dilu khi^n (vi dieu khien LPC Cdc cum bien 2294) 1f Match cdng sudt di^u khiln d$ng ca DC r End ) Hinh 11 To chirc phan cung, phan mem hf thong dieu khien robot Mdt so module chirorng trinh dieu khien Modul xdc djnh tga cua robot: int tinh_kinli_do(void) { char toado[5]; int ij; i=0; while (buf_kinhdo[i] !='.') i++; i++; for(j=0;j'5')i++; return i; int tinh_vi_do(void) { char toado[S]; int i j ; i=0; while (buf_vido[i] !='.') i-H-; i-H-; for(j=0;j'5')i++; return i; inlNear (signed intS d ) inl Far (sisned intS d ) I ( if{d=350) returndOO); ) } int Medium (signed intS d) I if(d50)&&(d 150)&&(d=250)&&(d=350) return(O); } V THU" NGHIEM THl/C TE VA MQT S KET QUA Nhdm de tai da tien hanh thOr nghifm boat ddng cua robot tren san van dgng Cho robot thuc hien nhifm vu tien den dfch djnh tmdc, tren dudng bd trf sdn cdc tinh huong vat can khac Ket gud thu dugc rat kha quan Trong cdc lan thir nghifm robot deu tranh dugc vat cdn va sau dd tiep tuc hanh trinh tien tdi muc tieu Tmdng hgp vat can cd hinh khdi vdi kfch thudc Idn, hodc cd hai vat can xep lien tiep, robot deu cd the trdnh dugc va sau di tiep den dfch Qud trinh chuyen trang thdi dieu khien tu trdnh vat can sang bam muc tieu xay khd mem va em, khdng cd su thay ddi dot ngdt ve hudng hay tdc cua robot > Tmdng hgp vat can di dgng, robot chi tranh dugc vdi dieu kifn vat can dugc phat hifn d khodng cdch khdng qua gan vd di chuyen vdi tdc cham Neu vat cdn di chuyen nhanh hay dugc phdt hifn d khoang cdch gud gdn thi robot khdng the phdn ling kjp Cd the khdc phuc tinh hudng tren bdng each tdng sd tap md qud trinh md hda dau vao tir tap (Far, Medium, Near) len hodc tap de tdng khd ndng phan loai cdc tinh hudng vat can va kha ndng kiem sodt viing khdng gian phfa tmdc ciia robot Nhung nhu vay, bd dieu khien md se phirc tap len rat nhieu lam tdng gdnh ndng xii ly vd cd the dnh hudng tdi kha ndng phdn iing nhanh ciia robot VI KET LUAN Vdi bdi todn dan dudng cue bd trdnh vat cdn, mdt sd ket qud dat dugc nhu sau: - Tren co sd ung dung ly thuyet logic md, de tdi da xay dung thuat tdan dan dudng cue bg dieu khien robot tu hanh trdnh cdc vat can hifu gud tdt Xay dung robot tu hdnh vugt dja hinh va tien hdnh thii nghifm tren thuc dja Ket qua thu dugc la rat khd quan Cdc lan thu deu cho ket qua robot ludn tu ddng trdnh dugc vat cdn de den dugc muc tieu djnh tmdc Tmdng hgp vat can cd phiirc tap Idn hoac vat can di chuyen vdi van tdc nao dd, de tai can dugc tiep tuc nghien ciiru, hoan thif n f * y y TAI LIEU THAM KHAO [1] Pham Xuan Minh, Nguyin Doan Phudc Ly thuylt dilu khiln md NXBKH&KT 2006 [2] Nguyen Thuang Ngd Ly thuylt dilu khiln tu ddng thdng thudng vd hifn dai NXBKH&KT 2005 [3} Passino K.M & S Yurkovich, Fuzzy Control, Addison Wesley, 1998 [4J Tdi lieu ciia hang NXP.com va Cdc trang web ve Fuzzy logic 755 ... dfch den ciia robot (cho trudc) thi se tfnh dugc hudng di mong muon cua robot so vdi phuang Bac La ban difn tir cho biet hudng lech hien tai ciia robot so vdi phuang Bdc tir (trong bai toan su sai... uu tien chung ta cd thi xay dung dugc 36 luat md (18 luat cho cac tiudng hgp ddi ximg vd 18 luat cho cdc trudng hgp khong ddi xiing) Trong mdt so tiirdng hgp, neu biet trudc ve hinh dang, kfch... dugc ddt cao ban thdn xe mgt chut, va d chfnh giira than robot, dk cho bilt thdn^ tin vl vj trf cua robot 01 la ban difn tir CMPS03 cho biet gdc Ifch ciia dudng di so vdi hudng Bdc dugc r,, , dat