SƠ ĐỒ CẤU TRÚC ROBOT OMNI 4
BÁNH
Vx:vận tốc của bánh thứ x ,vận tốc trong khoảng [-a,a]
Vd :Vận tốc tịnh tiến của robot, vận tốc trong khoảng [-a,a]
:góc chuyển động tịnh tiến ,giá trị [0,2π]
:Vận tốc xoay của robot
1 .sin( )
4
V V V
4
3 .cos( )
4
V V V
4 .sin( )
4
V V V
d
V
Trang 7 Trường hợp 1: Xét Robot chuyển động tịnh
tiến (Không quay quay tâm của nó) theo phương a nào đó
V[tt] = V[Att] + V[Btt] + V[Ctt]
Với: V[Xtt] = V[tt] * cos(a-góc của chiều vecto đơn vị tạo với trục Ox của bánh tương ứng)
Ví dụ góc tạo bới bánh A với trục Ox là 180
=>
V[Att] = V[tt] * cos(a-180)
tương tự:
V[Btt] = V[tt] * cos(a+60)
V[Ctt] = V[tt] * cos(a-60)
Trang 8 Trường hợp 2: Robot của chúng ta
quay quanh tại chỗ:
V[Aq] = Vquay * sai số góc
V[Bq] = Vquay * sai số góc
V[Cq] = Vquay * sai số góc
sai số góc = góc hiện tại của Robot - beta.
Trang 9TỔNG HỢP
V[ B] = V[Btt] + V[Bq]
V[C] = V[Ctt] + V[Cq]
Robot-180) + Vquay * sai số góc V[ B] = V[tt] * cos(a+Góc hiện tại của Robot+60) + Vquay * sai số góc
V[C] = V[tt] * cos(a+Góc hiện tại của Robot-60) + Vquay * sai số góc