1
Xây dựng hệ thí nghiệm Điều khiển Rô bốt
với quá trình nhận dạng vật thể động
trên cơ sở Camera

TS Lê Bá Dũng
Ths Hà Mạnh Đào
KS Nguyễn Thanh Tùng
Viện CNTT
Tóm tắt:

Bài báo trình bầy quá trình xây dựng, thiết kế hệ thí nghiệm điều khiển Rô bốt với quá trình nhận dạng
vật thể động trên cơ sở Camera. Với quá trình nhận dạng động các vị trí và hớng của vật thể thông qua ảnh
vật thể từ thời điểm cắt mẫu, một thuật toán ớc lợc vị trí đợc xây dựng. Với các vị trí đã ớc lợng, thuật
toán điều khiển đợc thiết kế để đa đầu tay nắm đến vị trí đã đợc ớc lợng và di chuyển vật thể đến
một vị trí xác định trong không gian làm việc và không gian quan sát đợc của Camera.

Abstract:

The paper presents a process to create a robot control system with dynamic recognition of image
object based on Camera. With the position and orientation of object is determined on the sampling time via
image recognition, an estimation algorithm is created. By the position and orientation are determined, an
robot control algorithm is constructed to move the end effectors to estimated position and orientation of the
object and take the object to other position and orientation on the working space and camera space.

1. Mở đầu



Hình 1 Sơ đồ hệ thí nghiệm
Các thông tin từ các đầu đo đợc chính xác hoá thông qua các phép nhận dạng. Các vật
thể chuyển động đợc xác định bằng các phơng pháp ảnh trôi (optic flow method), ở đây
không xét cụ thể các điểm ảnh mà vị trí và tốc độ ảnh coi nh là các giá trị gián tiếp. Nếu vị trí
của vật thể chuyển động đợc xác định từ ảnh, thì giá trị vị trí đó khi tính toán đã là giá trị cũ
của một vài thời điểm cắt mẫu trớc đó. Do đó để có thể có đợc giá trị tính toán vị trí và tốc
độ một cách chính xác, hay ta còn gọi là vị trí và tốc độ của vật thể tơng đối với camera, trong
trờng hợp này chúng ta cần phải xây dựng một mô hình dự báo. Thông số dự báo đợc xác
định thông qua chuyển động của vật thể. Từ đó có thể thiết kế đợc quỹ đạo theo thời gian thực
tế của chuyển động Robot và thiết kế thuật điều khiển
Giả sử vật thể với vị trí và tốc độ đợc xác định liên tục. Nếu ở thời điểm kT
V
có vị trí là
P
0
(kT
V


0
x
(kT
v
),


0
y
(kT
v
),

0
z
(kT
v
)]
T
(1)

Với T
V
thời gian quan sát
x,y,z là toạ độ Đề Các của hệ
T.... miêu tả chuyển vị

ở đây có thể hiểu là:
Vector vị trí bao gồm vị trí và hớng của Robot

T
c
là chu kỳ cắt mẫu của vòng điều khiển (T
v
>T
c
) và m = 1....T/T
v
là số nguyên

Tốc độ chuyển động vật thể đợc tính toán qua vị trí tâm điểm của vật thể đợc xác
định ở thời điểm hiện tại và thời điểm trớc đó. Gọi v
0
(kT
v
) là vận tốc của vật thể ở thời điểm k
T
c
đợc xác định bằng

v

v
) v
0
y
(kT
v
) v
0
z
(kT
v
),
0
x
(kT
v
)
0
y
(kT
v
)
0
z
(kT
v
) ]
T

3 thành phần đầu là tốc độ chuyển động thẳng.

2
10
1
1
...)(
(4)
Ma trận vuông A
0
i
, i=1,2,...,n chứa các giá trị cha biết, z
-1
là toán tử trễ liên quan đến
chu kỳ cất mẫu quan sát và z
-1
v
0
(kT
i
)=v
0
[(k-1)T] ; n- số nguyên là độ lớn của Ma trận với i=1,2,...,6
T- chu kỳ cắt mẫu

Để ớc lợng các thông số cha biết của (3) ta sử dụng phơng pháp trong [5]

nkvkvkvkM
0
6
0
1
10
6
10
1
0
0
6
0
2
0
1
00
2
0
1
0
0000
.........
......
))(.....())2(())1(()1(
=
==
=



0
)(
0
0
0000
0000
0
0
0
0000
<








+

=










3.2 Thiết kế bộ điều khiển:
3.2.1 Một số vấn đề cơ bản của động học vị trí
Một vật thể trong không gian thờng đợc mô tả bằng sáu tham số sau nh [8]:
- 3 tham số về vị trí (position): x, y, z hoặc p
x
, p
y
, p
z
, nh biểu diễn ở (1)
- 3 tham số về hớng (orientation):

x
,

y
,

z
.
Xét robot trong hệ toạ độ Đềcác với loại robot nối khớp (chỉ có khớp quay mà không có
khớp tịnh tiến) với giả thiết robot co 6 khớp quay



z
là vị trí hình học của tay nắm robot.
- x, y, z là toạ độ của tay nắm robot.
-

x
,

y
,

z
là các góc quay của tay nắm robot quanh các trục x, y, z.
x
y
z

6

5


4

3

2

1












x
y
z
x
y
z














4
,

5
,

6
) của các khớp
và điều khiển các khớp quay của robot theo các góc đã tính toán để di chuyển tay nắm robot
đến đúng vị trí và hớng của vật. Việc tính toán bộ thông số các góc quay (

1
,

2
,

3
,

4
,

5
,

6
) của các khớp tuỳ thuộc vào hệ phơng trình động học ngợc đã xây dựng có tối u hay
không. Nhiều khi phải giải hệ phơng trình siêu việt trong bài toán ngợc với thời gian rất lâu,
đôi khi lời giải không đạt sự hội tụ. Điều này không đảm bảo thời gian thực trong điều khiển

0
O
y
1

3

z
2

y
2
x
2
O
2
x
1

1

z
3
y
3
x
3
O
3