1
Á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 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êu di 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ài toá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 robot di 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 …
Trong bài báo này, chúng tôi ngh mt gii thut và phn mm u khin robot trá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êu di 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.
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êu di 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 TRONG BÀI TOÁN TRÁ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êu cho trc nh camera, nên góc quay ca
Hình 1: b trí thit b trên mô hình robot
hành