Professional Documents
Culture Documents
• Giúp sinh viên hiểu và nắm rõ hơn quá trình tính toán động học cho robot
• Trên cơ sở lý thuyết đã được học, sinh viên liên hệ được với việc tính toán động học
Robot trên thực tế mà cụ thể ở đây là Robot trên phòng TN Scobot-ER9
• Giúp sinh viên thực hành được các thao tác điều khiển Robot Scobot ER9 thông qua
dụng cụ Teach Pendant và phần mềm điều khiển Robot Scobase - Phần mềm cung cấp
công cụ cần thiết cho người sử dụng trong quá trình vận hành và lập trình cho Robot
• Giúp sinh viên hiểu sâu hơn phần lý thuyết điều khiển Robot đã học ở trên lớp
- Giới thiệu chung về thiết bị phòng thực hành – thí nghiệm:
• Scorbot ER9: là loại robot dạng cánh tay người, bộ phận thân cơ khí của robot được nối
bằng các khớp thẳng đứng, có 5 khớp quay. Với bàn kẹp được gắn vào thì robot có 6 bậc
tự do. Mỗi khớp của robot được điều khiển bởi một động cơ điện một chiều nam châm
vĩnh cửu qua hộp truyền động bánh răng và dây cu roa
• Máy tính
• Bộ điều khiển Controller B: Là thiết bị trung gian kết nối giữa máy tính và robot để thực
hiện việc điều khiển robot. Việc truyền thông giữa máy tính và bộ điều khiển thông qua
cổng COM hoặc RS 232 cho phép chương trình được viết trên PC để điều khiển
ROBOT.
• Thiết bị Teach Pendant cho phép thực hiện điều khiển robot độc lập với máy tính .
- Bảng tiến độ và thời lượng triển khai các bài thực hành thí nghiệm
Tuần thứ 6 Tuần thứ 7 Tuần thứ 8 Tuần thứ 9 Tuần thứ Tuần thứ 11
ượngThời
10
Bài 1 Bài 2 Bài 3
3h Nhóm Nhóm Nhóm Nhóm Nhóm Nhóm Nhóm Nhóm Nhóm Nhóm Nhóm Nhóm
1 2 3 4 1 2 3 4 1 2 3 4
- Phương pháp đánh giá kết quả thực hành thí nghiệm của sinh viên:
Bản báo cáo thí nghiệm
- Công tác chuẩn bị của sinh viên:
• SV phải ôn lại thật kỹ cơ sở toán học trong tính toán động học robot
• Sinh viên phải nắm rõ được quá trình tính toán động học thuận và động học ngược cho
Robot để đưa ra được các toạ độ mà Robot sẽ làm việc theo.
• Tìm hiểu về ngôn ngữ lập trình SCOBASE (phần mềm chuyên dụng) cho Robot.
- Cán bộ phụ trách, hướng dẫn thực hành thí nghiệm môn học:
Scorbot ER9 là loại robot dạng cánh tay người, bộ phận thân cơ khí của robot được nối
bằng các khớp thẳng đứng, có 5 khớp quay. Với bàn kẹp được gắn vào thì robot có 6 bậc tự do.
Việc thiết kế này cho phép end-effector có thể di chuyển tuỳ ý trong không gian làm việc rộng.
Mỗi khớp của robot được điều khiển bởi một động cơ điện một chiều nam châm vĩnh cửu qua
hộp truyền động bánh răng và dây cu roa. Sự chuyển động của các khớp được mô tả theo bảng
sau
Hình 1: Các khớp chính của tay Robot
a. Bàn kẹp
Bàn kẹp là một phần tử được gắn vào robot để thực hiện một công việc nào đó. Hoạt
động của bàn kẹp khác hoạt động của các trục, nhưng ngược lại người ta có thể đưa một lệnh
để xác định lượng chuyển động của các trục, từ đó chỉ dẫn bàn kẹp đóng hay mở hoàn toàn.
Tuy nhiên nếu bàn kẹp kẹp vật thể lên thì nó sẽ dừng chuyển động của nó. Bàn kẹp trong robot
này có thể là bàn kẹp chạy bằng khí nén hoặc động cơ điện servo 1 chiều .
- Điều khiển bằng phần mềm thông qua máy tính điều khiển hệ thống. Chủ yếu sử dụng
phần mềm chuyên dụng SCORBASE, là phần mềm điều khiển robot được sử dụng trên nền của
Window 98. Dễ sử dụng, có thể sử dụng trên bất kì hệ thống PC nào và thông tin với ACL,
ngôn ngữ bên trong của bộ điều khiển bởi kênh RS232
- Qua thiết bị cầm tay Teach Pendant: Nó là một thiết bị đầu cuối điều khiển bằng tay sử
dụng để điều khiển Scorbot er9 và các thiết bị ngoại vi. Trong thực tế Teach Pendant dùng để
di chuyển các hệ trục, ghi lại vị trí, gửi các hệ trục để ghi lại vị trí và chạy chương trình .
Chuyển động của Scorbot được thực hiện nhờ 3 phần tử chính ( Hình 2).
Hình trên là hệ thống truyền động của Scorbot cho các hệ trục từ 1 – 4. Riêng hệ trục 5
hệ truyền động không bao gồm dây cu roa và puly mà chỉ có hộp truyền động được sử
dụng( Hộp số ).
* Động cơ : Cánh tay robot được truyền động bởi động cơ điện 1 chiều. Các bộ tác động biến
đổi tín hiệu từ bộ điều khiển ( Điện năng ) thành sự quay của trục động cơ ( Cơ năng ).
Scorbot – ER9 sử dụng các động cơ một chiều nam châm vĩnh cửu để chuyển động các
trục. Các chuyển động của robot được thực hiện thông qua động cơ như hình dưới .
Encoder sử dụng trên Scorbot – ER9 bao gồm một diot ( LED) quang như một nguồn
sáng. Trước đèn led là một mạch tổ hợp đo sóng ánh sáng. IC này bao gồm một vài bộ thu tách
sóng quang và một mạch điện để tạo ra một tín hiệu số. Một lỗ khoan trên đĩa quay được đặt
vào giữa mạch tổ hợp bộ phát và bộ thu sóng .
Khi đĩa quay tròn giữa đèn LED và bộ thu ánh sáng bị ngắt bởi các vạch trên đĩa, kết
quả là một chuỗi xung nhận được bởi IC thu sóng .
Encoder có 512 rãnh cắm như hình trên, mỗi khe bổ xung trên đĩa được sử dụng để phát
ra một xung kim ( Xung C) cho mỗi vòng quay của đĩa. Dựa trên xung kim này để xác định vị
trí gốc của các trục .
Bộ thu sóng phải được sắp xếp sao cho khi thay đổi có thể phát hiện toàn bộ ánh sáng. Đầu ra
các diode quang được đưa vào mạch xử lí tín hiệu, kết quả cho ra các tín hiệu như hình 9
Các bộ so sánh nhận tín hiệu và tạo ra các tín hiệu số ở các kênh A, B, và I. Đầu ra các
kênh A lệch pha với kênh B một góc 90 o. Khi chiều quay của đĩa ngược với chiều quay kim
đồng hồ, kênh A sẽ sớm pha hơn kênh B, và ngược lại khi chiều quay của đĩa theo chiều kim
đồng hồ thì kênh B sẽ sớm pha hơn kênh A.
Là thiết bị trung gian kết nối giữa máy tính và robot để thực hiện việc điều khiển robot.
Việc truyền thông giữa máy tính và bộ điều khiển thông qua cổng COM hoặc RS 232 cho phép
chương trình được viết trên PC để điều khiển ROBOT. Ngoài ra thông qua thiết bị teach
Pendant cho phép thực hiện điều khiển robot độc lập với máy tính .
Nói chung bộ điều khiển bao gồm những phần tử điện với hệ thống vi xử lí. Các hệ
thống này điều khiển chuyển động của các end – effector thông qua việc điều khiển chuyển
động của các biến khớp. Trong một số trường hợp có thể lưu trữ các chương trình trong bộ nhớ
của chúng .
+ Loại điều khiển: Bao gồm điều khiển độc lập, thời gian thực, đa nhiệm, PID ( Tỉ lệ ,
tích phân và vi phân ), PWM điều khiển độ rộng xung
+ Điều khiển đường: gồm CP ( đường liên tục ), đường nối, đường thẳng, đường tròn,
đường hình sin, đường được định nghĩa bởi người sử dụng toạ độ của thiết bị .
+ Điều khiển quỹ đạo: Bao gồm điều khiển quỹ đạo kiểu Parabonoit, quỹ đạo đường
hình sin.
+ Các tham số điều khiển: Điều khiển servo, tốc độ, vận tốc trượt, sai lệch vị trí trục,
hoạt động của bàn kẹp, bảo vệ nhiệt, va chạm, giới hạn, dẫn đường, giao diện encorder, và các
phép tính .
Ngoài ra còn nhiều các thông số khác như: Cấp nguồn vi phân, trọng lượng kích thước,
dải nhiệt độ hoạt động, chíp, bộ nhớ card vào ra ...
Hình dạng bên ngoài của Controller – B
+ Thông báo thoát khỏi dừng sự cố được xuất hiện trên máy tính .
+ Nếu tồn tại thì chương trình sử dụng bắt đầu chạy.
- Công tắc khởi động lại: Giống như nút ấn khởi động lại trên PC, khi ấn nút này thì sẽ
khởi động lại bộ điều khiển, nếu nó đang được cấp nguồn. Khi ấn nút này sẽ xuất hiện :
+ Vị trí gốc HOME sẽ bị xoá đi từ bộ nhớ trong suốt quá trình khởi động lại .
- Cấp nguồn cho các ngắt cuối: Sử dụng cấp nguồn cho các phần tử bên ngoài trong ứng
dụng của người sử dụng để nhận được nguồn từ bộ điều khiển. Sử dụng cấp nguồn của bộ điều
khiển có 4 điểm cuối là + 24VDC 2A, 12 VDC 2A, cấp nguồn di động chung, nối đất an toàn .
- Các điểm đầu ra: Có tất cả 16 đầu ra trong hệ thống robot để chuyển các tín hiệu đến
các phần tử bên ngoài trong môi trường của robot. Controller- B có 2 loại đầu ra, 4 rơle đầu ra
và 12 tiếp điểm thường mở.
- Các tiếp điểm đầu vào: Có 16 đầu vào trong hệ thống robot để nhận các tín hiệu từ các
phần tử bên ngoài trong môi trường hoạt động của robot .
- Các đèn LED vào ra: Có 16 led màu xanh tương ứng với đầu ra từ 1 đến 16, Đèn Led
này sáng lên khi đầu ra được kích hoạt. Có 16 đèn Led đầu vào tương ứng với 16 đầu vào từ 1
đến 16 đèn này sáng lên khi đầu vào được kích hoạt .
* , Mặt sau bộ điều khiển :
4. Cổng RS 232
- CPU: Loại motorola 68020. Đây là bộ xử lý trung tâm chứa tất cả các mạch điện cho
phép điều khiển, định thời , lưu trữ và truyền tải dữ liệu địa chỉ, thuật toán thực hiện .
- RAM: 512 KB, có thể mở rộng tới 2 mB trong đó có 150 KB dành riêng cho hệ thống
còn 350 KB thay đổi đối với người sử dụng .
- PIN: Có một pin 3(V) sử dụng cho việc phục hồi bộ nhớ, có tuổi thọ 2 năm
- INPUT: Bộ điều khiển robot Scorbot có 16 đầu vào được chia thành 2 khối cách ly
quang
Mỗi khối được đặt ở chế độ luôn nổi và có thể được tham chiếu tới các thiết bị ngoại vi
khác nhau hoặc tới trạng thái tiếp đất của bộ điều khiển. Các mạch đầu vào bộ điều khiển sử
dụng cách li quang để đảm bảo cách ly về điện giữa bộ điều khiển và các thiết bị điện tử khác
trong hệ thống .
- OUTPUT : Gồm 16 đầu ra , được chia thành 2 khối cách li quang .
- Giúp sinh viên hiểu và nắm rõ hơn quá trình tính toán động học cho robot
- Trên cơ sở lý thuyết đã được học, sinh viên liên hệ được với việc tính toán động học
robot trên thực tế mà cụ thể ở đây là Robot trên phòng TN Scobot-ER9
2. Công tác chuẩn bị của sinh viên:
- SV phải ôn lại thật kỹ cơ sở toán học trong tính toán động học robot
- Phải nắm được cơ bản các bước tính toán động học của robot
- Tính được các định thức, từ đó tính ra được vị trí của bàn kẹp robot Scobot-ER9.
3. Trang thiết bị cần thiết:
- Scorbot ER9
- Máy tính
- Bộ điều khiển Controller B
- Thiết bị Teach Pendant
4. Các nội dung, quy trình:
Bài toán động học thuận vị trí của robot là bài toán xác định mối quan hệ giữa vị trí của
bàn kẹp ( End_enffector) so với khung toạ độ gốc. Tức là biết trước các biến khớp, từ đó đi xác
T
định ma trận vị trí bàn kẹp RH .
Xét một tay máy có n+1 khớp tự do, được nối với nhau bởi n khớp. Mục đích của tính
toán động học là xác định được vị trí bàn kẹp. Theo hệ toạ độ gốc thì ma trận biểu diễn động
học thuận của bàn kẹp có dạng như sau :
nx ox ax px
n oy ay py
R
TH = [n, o, a, p] = y
nz oz az pz
0 0 0 1
X3Y3Z3....................................................4
X4Y4Z4....................................................5
X5Y5Z5....................................................6
Chọn các trục toạ độ cho các khớp ta có khung toạ độ Robot Scorbot –ER9 như sau:
nz oz az pz
0 0 0 1
5. Kết luận, các yêu cầu cần đạt được đối với sinh viên sau khi thực hành:
- Nắm được phương pháp tính toán động học trong điều khiển Robot
- Phương pháp đưa tọa độ để xác định vị trí của tay nắm Robot
Bài 3:
SCOBOT – ER9 LÀM VIỆC TRONG KỸ THUẬT HÀN
1. Mục tiêu:
- Giúp sinh viên thực hành được các thao tác điều khiển Robot Scobot ER9 thông qua
dụng cụ Teach Pendant và phần mềm điều khiển Robot Scobase - Phần mềm cung cấp công cụ
cần thiết cho người sử dụng trong quá trình vận hành và lập trình cho Robot.
- Giúp sinh viên hiểu sâu hơn phần lý thuyết điều khiển Robot đã học ở trên lớp
2. Công tác chuẩn bị của sinh viên:
- Sinh viên phải nắm rõ được quá trình tính toán động học thuận và động học ngược
cho Robot để đưa ra được các toạ độ mà Robot sẽ làm việc theo.
- Hiểu và lập trình được với ngôn ngữ SCOBASE (phần mềm chuyên dụng) cho
Robot.
3.Trang thiết bị cần thiết:
- Scorbot ER9
- Máy tính
- Bộ điều khiển Controller B
- Thiết bị Teach Pendant
4.Các nội dung, quy trình:
Hàn chữ theo yêu cầu
Vì không có súng hàn nên quá trình hàn một mối hàn được đặc trưng bởi việc đóng bàn
kẹp. Kết thúc mỗi một mối hàn bằng việc mở bàn kẹp. Sau khi hàn xong một chữ cái thì có độ
trễ và tiếp tục hàn các chữ cái tiếp theo. Kết thúc một chu kỳ hàn có tiếng chuông báo hiệu.
Ví dụ: Hàn chữ V
Bằng việc tính toán động học để tìm ra toạ độ chính xác của Robot, ta nạp toạ độ của
robot, ghi lại số vị trí mà robot phải thực hiện
Ta có bảng toạ độ vị trí dưới dạng toạ độ Đecac như sau:
STT X (mm) Y(mm) Z(mm) Pitch (deg) Roll (deg)
1 37.33 -418.96 58.85 -106.29 0.76
2 -2.05 -328.42 51.15 -128.43 0.76
3 -64.07 -450.29 35.91 -96.12 0.76
Tất cả các thao tác trên phải được tính toán rất cẩn thận và kiểm tra trước khi thao tác
trên máy tính. Sau đó để có thể điều khiển Robot hoạt động thì phải thao tác theo trình tự sau:
- Kiểm tra tất cả các đầu nối giữa bộ điều khiển và Robot, máy tính và bộ điều
khiển…
- Cấp nguồn 220VAC vào bộ điều khiển và máy tính
- Bật công tắc ở bộ điều khiển bởi nút ON/OFF
- Ấn nút cấp nguồn cho các động cơ một chiều ở mặt trước của bộ điều khiển
- Khởi động máy tính
- Trên thiết bị Teach Pendant, chuyển nút chế độ AUTO/TEACH ở chế độ auto
- Mở phần mềm Scobase trong máy tính (Trên Desktop)
- Đưa robot về vị trí gốc (Home) bằng cách chọn Run Search Home-all axis
- Sau khi đã đưa robot về vị trí gốc xong thì vào menu File/new để mở một file mới
bằng cách lập trình và nạp các vị trí cho chương trình.
- Sau khi nạp các vị trí mới xong, cho chạy chương trình bằng cách vào menu Run.
+ Nếu muốn Robot chạy theo từng dòng lệnh một thì chon Run Single line.
+ Nếu muốn Robot chạy theo chu kỳ thì chọn Run Single cycle
+ Nếu muốn Robot chạy liên tục thì chọn Run Continuosly.
- Sau khi robot hoàn thành xong công việc hàn của mình, ta phải đưa robot về vị trí
gốc
5. Kết luận, các yêu cầu cần đạt được đối với sinh viên sau khi thực hành:
- Nắm được các trình tự thao tác điều khiển Robot Scobot ER9
- Lập trình cho Robot Scobot ER9 đi theo một quỹ đạo cho trước