Giao diện thủ công này sẽ giúp người dùng có thể điều chỉnh robot thủ công bằng tay theo ý muốn để có thể lựa chọn được các vị trí mà robot có thể đi qua , kiểm tra xem vị trị mà muốn thực hiện quỹ đạo có thể đáp ứng được robot không trước khi lập trình quỹ đạo tự động.Ngoài ra giao diên hỗ trợ lưu lại được các vị trí mà ta đã đi qua.
Ở giao diện chính mà ta nhấn vào nút điều khiển thủ công thì màn hình sẽ hiện ra như dưới đây. Giao diện tay cầm được lấy ý tưởng từ tay cầm của robot Nachi MC-2001 nó bao gồm gần hết các nút điều khiển mà ta có thể sử dụng để vận hành robot.
Hướng dẫn sử dụng giao diện:
Bảng 3.5. Các bước thực hiện với giao diện thủ công
Bước Phím Ý nghĩa
1 Nút Khởi động
Là phím bắt đầu để ta có thể hiện thị và thực hiện các chức năng khác.
2 Panel Màn hình
Có chắc năng giúp ta biết được vị trí của robot hiện tại đã ở vị trí nào theo hệ tọa độ robot và hệ tọa độ khớp.
3 Panel Phím điều khiển
Bao gồm 12 nút chia với 2 nút điều khiển một khớp robot theo hai chiều âm và dương.
4 Panel Tốc độ
Gồm 3 nút radio button điều khiển khả năng nhanh hay chậm của robot thông qua Panel phím điều khiển.
5 Nút Record Có chức năng lưu lại tọa độ vị trí của robot vào table bên dưới.
6 Table Khi nhấn nút record thì bảng sẽ hiện thông tin vị trí x,y,z mà ta đã lưu.
7 Nút trở lại Có chức năng quay lại về màn hình giao diện chính. 3.2.3. Giao diện điều khiển tự động
Giao diên này sẽ giúp người dùng có thể nạp vào một số chương trình để robot có thể thực hiện theo đúng yêu cầu mà người dùng muốn, ngoài ra có thể thay đổi các giá trị của bài toán đặt ra . Ngoài ra thì giao diện cũng sẽ hỗ trợ người dùng xem được quỹ đạo vị trí tọa độ mà robot thực hiện, và một số thông tin kết quả mà quỹ trình chuyển động của robot tạo ra.
Ở giao diện chính mà ta nhấn vào nút điều khiển tự động thì màn hình sẽ hiện ra như dưới đây.
Hướng dẫn sử dụng giao diện:
Bảng 3.6. Các bước thực hiện với giao diện tự động
Bước Phím Ý nghĩa
1 Pop-up Menu
Giúp ta lựa chọn các chế độ đã được lập trình săn để robot có thể hoạt động tự động mà ta không thể can thiện vào hình dạng quỹ đạo . ở đây nhóm đã thiết kế ra ba chế độ là chạy đường thẳng, chạy tam giác và chạy đường tròn.
2 Check box
Có chắc năng giúp ta thay đổi vị trí tọa độ các điểm hoặc là để nguyên theo mặc định sẵn của chương trình mà không cần phải thay đổi bất kỳ các giá trị nào.
3 Panel tham số
Giúp người dùng có thể hiệu chỉnh các tham số theo yêu cầu như vị trí , thời gian dịch chuyển, bán kính ,….
4 Nút chạy Sau khi có hết các thông số thì nhấn nút chạy sẽ tác động các bộ xử lý để robot làm theo đúng yêu cầu. 5 Axes1 Hiện thị ra hình dạng , vị trí mà robot đã thực hiện
được lên màn hình.
6 Nút dừng
Do chương trình thiết kế chỉ cho phép chạy một chương trình mỗi lần hoạt động nên sau khi chạy xong một chương trình thì ta sẽ cần phải nhấn nút dừng để máy hiểu được.
7 Nút kết quả Xem kết quả chuyển động của các khớp, vận tốc gia tốc của các khớp khi thực hiện quỹ đạo.
3.2.4. Giao diên thuật toán dò đường RRT*
Giao diện RRT* sẽ giúp người dùng tự tạo ra không gian làm việc, điểm đầu, điểm đích, các chướng ngại vật trong không gian để từ đó tìm ra được quỹ đạo đường đi.
Ở giao diện chính mà ta nhấn vào nút thuật toán dò đường RRT* thì màn hình sẽ hiện ra như dưới đây.
Hướng dẫn sử dụng giao diện:
Bảng 3.7. Các bước thực hiện với giao diện RRT*
Bước Phím Ý nghĩa
1 Panel không gian làm
Tạo ra không gian làm việc tối đa mà vật có thể di chuyển. Trong đó chứ toàn bộ các vật trong không gian.
2
Panel điểm đầu và điểm cuối
Có chức nặng tạo ra tọa độ vị trí điểm đầu và tọa độ điểm đích.
3
Panel
chướng ngại vật
Tạo vật cản trong không gian làm việc bằng các cho vị trí điểm đầu tiền sau đó độ dài được tính từ điểm đó theo chiều dương của hệ tọa độ.
4
Panel thông số điều chỉnh
ở đây là các tham số điều chỉnh để giúp quá trình dò đường được tối ưu nhất.
5 Nút chạy Sau khi có đầy đủ các thông tin thì máy tính sẽ tự động sử dụng thuật toán để tìm đương.
6 Axes1 Hiện thị ra hình dạng , vị trí quãng đường đã thực hiện được lên màn hình.
7 Panel kết quả
Hiện thị tra kết quả mà thuật toán đã tìm ra đượng có chiều dài quãng đường đã thực hiện và thời gian mà thuật toán đã thực hiện trong bao lâu.
8 Nút trở lại Có chức năng quay lại về màn hình giao diện chính. 3.3. Tối ưu hóa quỹ đạo chuyển động robot
Sử dụng thuật toán RRT (Rapidly Exploring Random Tree) để tìm kiếm một điểm trong không gian bằng cách tạo ra tạo ngẫu nhiên các điểm trong bản đồ, tìm điểm đích sau đó nội suy ngược lại ra được vị trí ban đầu. Từ đó tạo ra một quỹ đạo chuyển động từ điểm đầu đến điểm cuối.
3.3.1. Đặt vấn đề
Cho bài toán tối ưu như sau: Ta có không gian làm việc xmax = 150: ymax =150: zmax =100.Giả sử không gian làm việc này robot có thể hoạt động ở mọi vị trí trong không gian.Vị trí ban đầu có tọa độ 0x0x0, vị trí đích có tọa độ
110x110x50. Vật cản có vị trí 50x90x10 có độ dài dx=50,dy=50,dz=60. Động cơ sử dụng trong robot là HF-KN23B.
3.3.2. Nguyên lý hoạt động
Chọn ngẫu nhiên một điểm trên bản đồ với điều kiện không được nằm trong vùng vật cản.
Kẻ một đường thẳng từ điểm đã tạo từ bước một đến nút cha với điều kiện đường thẳng không được đi qua vật cản.
Tạo ra nút con bằng các lấy 1 điểm thuộc đường thẳng ở bước 2 cách nút cha một khoảng cho trước.
Lắp đi lặp lại 3 bước đầu cho đến khi xác định điểm đích.
Sau khi tìm ra được điểm đích thì thuật toán sẽ nội suy ngược lại từ điểm đích ngược lại điểm đầu theo đường dẫn đã được tìm thấy.
Đối với thuật toán RRT* thì ở bước này sau khi nội suy ngược lại thì từ điểm con cuối cùng ta sẽ vẽ ra một đường tròn với bán kính R đã được xác định. trong đó sẽ có các nút cha trước sẽ lựa chọn nút cha gần đường tròn nhất để tạo đường dẫn, còn các nút cha khác bên trong đường tròn sẽ được loại bỏ để tạo ra quỹ đạo chuyển động di chuyển ngắn nhất.
3.3.3. Điều kiện tiên quyết
Không gian làm việc: Bản đồ của môi trường được phân chia thành vùng có chướng ngại vật và vùng không có chướng ngại vật.
Vị trí bắt đầu: Vị trí bắt đầu của robot trong môi trường của nó.
Vị trí đích mục tiêu: Vùng mục tiêu của robot trong môi trường của nó. Số nút: Số nút được tạo ngẫu nhiên thực hiện bởi RRT.
Khoảng cách giữa hai nút: Khoảng cách tối đa đối với hai nút cha và con có thể nhận.
3.3.4. Chỉ tiêu tối ưu
Ở đây thì ta có 2 chỉ tiêu có thể để tối ưu đó là quãng đường di chuyển và thời gian xử lý thuật toán.
+Về quãng đường di chuyển: Đây là chỉ tiêu mang ý nghĩa về kinh tế cũng như hạ giá thành sau mỗi lần hoạt động.
+Về thời gian xử lý thuật toán: Đây là chỉ tiêu mang ý nghĩa thời gian xử lý của robot cũng như tăng năng suất làm việc.
Ở trong bài báo cáo này thì nhóm sẽ thực hiện tối ưu theo chỉ tiêu thời gian xử lý thuật toán.
3.3.5. Các hàm giới hạn
3.3.5.1. Giới hạn về động cơ
Từ quỹ hoạch quỹ đạo đường thẳng ta biết được robot chạy quãng đường s=150mm trong vòng t= 2s.
Động cơ HF-KN23B ta có:
Độ phân giải R là 131072 xung/vòng
Tốc độ quay trục n là 3000 vòng/phút
Tốc độ quay tối đa nmax là 5000 vòng/phút Trường hợp động cơ chạy tốc độ bình thường: Tần số:
f = = = 6553600 xung/giây (3-1)
Một xung chạy được:
s1 = / = 0,0000114 𝑚𝑚 (3-2) Kích thước độ phân giải:
Rs= R * s1= 1,5mm (3-3)
Trong vi điều khiển , hay PLC tần số lấy mẫu thường là 100ms. Kích thước độ phân giải theo 100ms:
S100= ∗ = 7,5 𝑚𝑚 (3-4) Số nút cần tạo:
Toàn không gian làm việc: Nmap = ( ) ( ) ( ) = 6321 𝑛ú𝑡 (3-5) Vật cản Nobject =( ) ( ) ( )=529 nút (3-6) Giới hạn số nút cần tạo: Số nút tối thiểu: NMin= = 100 𝑛ú𝑡 (3-7) Số nút tối đa:
NMax = Nmap - Nobject = 5792 nút (3-8) Trường hợp động cơ chạy tốc độ tối đa:
Tần số. Sử dụng (3-1) ta được: f = 10922667 xung/giây
Một xung chạy được.Sử dụng (3-2) ta được: s1 = 0,0000069 𝑚𝑚
Kích thước độ phân giải.Sử dụng (3-3) ta được: Rs=0,9 mm
Trong vi điều khiển , hay PLC tần số lấy mẫu thường là 100ms. Kích thước độ phân giải theo 100ms.Sử dụng (3-4) ta được: S100= 7,5 𝑚𝑚
Số nút cần tạo:
Nmap = 6321 𝑛ú𝑡
Vật cản.Sử dụng (3-6) ta được:Nobject =529 nút
Số nút tối thiểu .Sử dụng (3-7) ta được:NMin= 166 𝑛ú𝑡 Số nút tối đa. Sử dụng (3-8) ta được: NMax = 5792 nút
3.3.5.2. Giới hạn về khoảng cách các nút Lmin = 0,9 mm. Lmax = 7,5 mm. 3.3.5.3. Giới hạn số nút cần tạo NMin= 166 𝑛ú𝑡. NMax = 5792 nút. 3.3.5.4. Giới hạn về bán kính đường tròn RRT* Rmin =0 mm. Rmin =150 mm. 3.3.6. Tạo thí nghiệm
Để tạo thí nghiệm ta vào start/DOE/factorial/ create factorial design Type of design: general full factorial design.
Number of factors: 3.
Khoảng cách: 0,9 - 4,2 - 7,5. Số nút: 166 – 2979 – 5792. Bán kính: 0 – 75 – 150.
Bảng 3.8. Tạo thí nghiệm với DOE
StdOrder RunOrder PtType Blocks khoang cach nut so nut ban kinh
15 1 1 1 4.2 2979 150
5 2 1 1 0.9 2979 75
16 3 1 1 4.2 5792 0
11 5 1 1 4.2 166 75 4 6 1 1 0.9 2979 0 9 7 1 1 0.9 5792 150 3 8 1 1 0.9 166 150 7 9 1 1 0.9 5792 0 14 10 1 1 4.2 2979 75 12 11 1 1 4.2 166 150 1 12 1 1 0.9 166 0 13 13 1 1 4.2 2979 0 25 14 1 1 7.5 5792 0 18 15 1 1 4.2 5792 150 27 16 1 1 7.5 5792 150 22 17 1 1 7.5 2979 0 21 18 1 1 7.5 166 150 10 19 1 1 4.2 166 0 26 20 1 1 7.5 5792 75 6 21 1 1 0.9 2979 150 24 22 1 1 7.5 2979 150 2 23 1 1 0.9 166 75 8 24 1 1 0.9 5792 75 23 25 1 1 7.5 2979 75 20 26 1 1 7.5 166 75 17 27 1 1 4.2 5792 75 3.3.7. Thực hiện thí nghiệm
Sau khi tạo được thí nghiệm thì ta bắt đầu thí nghiệm từng trường hợp theo thứ tự mà minitab sắp xếp ngẫu nhiên để có thể hạn chế được các yếu tố khác mà ta không đề cập vào xét.
Bảng 3.9. Kết quả thực hiện thí nghiệm
Khoảng cách nút Số nút Bán kính Quãng đường Thời gian
4.2 2979 150 174.749 1194.39 0.9 2979 75 164.651 812.319 4.2 5792 0 241.961 2705.66 7.5 166 0 172.483 4.713 4.2 166 75 201.13 5.349 0.9 2979 0 318.789 703.285 0.9 5792 150 164.95 3490.9 0.9 166 150 183.401 6.495 0.9 5792 0 173.381 3086.42 4.2 2979 75 178.736 881.967 4.2 166 150 170.601 5.8 0.9 166 0 246.462 4.841 4.2 2979 0 223.926 701.795 7.5 5792 0 222.562 3366.18 4.2 5792 150 167.589 4013.41 7.5 5792 150 174.345 5563.34 7.5 2979 0 293.845 852.831 7.5 166 150 183.841 5.742 4.2 166 0 225.379 4.76 7.5 5792 75 168.474 2677.24 0.9 2979 150 162.98 1168.7 7.5 2979 150 171.057 1060.96
0.9 166 75 179.266 5.531 0.9 5792 75 168.074 3408.19 7.5 2979 75 175.641 716.647 7.5 166 75 165.069 5.053 4.2 5792 75 168.392 2699.19 3.3.8. Đánh giá nhận xét
Sau khi để minitab phân tích thì ta nhận thấy được một số các yếu tố ảnh hưởng là không đáng như AA,A,AC,AB,CC từ đó ta có thể loại bỏ để có thể làm bài toán trở lên đơn giản hơn.
Đánh giá độ ảnh hưởng của các yếu tố.
Hình 3.9. Mức độ ảnh hưởng của các yếu tố
Sau khi loại bỏ các yếu tố ảnh hưởng không đáng kể thì ta được hàm hồi quy như sau:
Thời gian = 67 – 0,126.B- 0,83.C+ 0,000104.B2+ 0,001543.B.C (3-9) Ta cũng thấy được sự ảnh hưởng của 3 yếu tố khoảng cách nút, số nút, bán kính theo đường bậc 2.
Hình 3.10. Đồ thị ảnh hưởng của các yếu tố Tối ưu hóa các yếu tố:
Sau khi sử dụng DOE/response surface/ response optimization thì minitab đã khuyến cáo giá trị để ta có thể lựa chọn ra giá trị của yếu tố sao cho thời gian xử lý thuật toán là nhanh nhất.
Khoảng cách: 4,7. Số nút: 166.
Bán kính: 77.
Kết luận chương 3
Sau khi thiết kế được cánh tay robot 6 bậc tự do thì cần xây dựng điều khiển. Các giao diện điều khiển tạo ra nhằm giúp người dùng có thể vận hành robot một cách đơn giản và dễ dàng. Ở chương này ngoài việc đưa ra các giao diện nhóm nghiên cứu đã xây dựng và đưa ra hàm tối ưu hóa về thời gian chuyển động của cánh tay robot.
Chương 4. Quy trình công nghệ chế tạo robot 4 bậc tự do
Phần chế tạo mô hình được chia thành hai phần, thiết kế phần cơ khí và phần cơ khí lắp đặt. Trong thiết kế của phần cơ khí, bản vẽ của các bộ phận được sử dụng trong chế tạo cánh tay robot đã được thực hiện thông qua phần tính toán thiết kế cánh tay robot bên trên. Trong việc lắp đặt bộ phận, việc sử dụng động cơ cho các khâu của cánh tay cần được xác định và lựa chọn. Lựa chọn động cơ servo với những ưu điểm về điều khiển, hoạt động của cánh tay robot trong quá trình robot làm việc. Việc này bao gồm một số bước như sau:
Xác định các vật liệu cần thiết để chế tạo.
Xác định bộ vi điều khiển và phần mềm sẽ được sử dụng.
Chọn động cơ servo sẽ dùng cho cánh tay robot một cách thích hợp.
Lựa chọn phù hợp các bộ phận cơ khí.
Thực hiện lắp ráp cánh tay robot.
Kiểm tra hệ thống để xem nó có hoạt động đúng với bộ vi điều khiển đã chọn hay không.
Các lỗi có thể xảy ra trong quá trình lắp đặt và vận hành.
Khi các bước này đã được hoàn thành thì việc chế tạo robot đã hoàn thành 4.1. Sơ đồ thiết kế
Sơ đồ thiết kế là một phần quan trọng mỗi khi bắt đầu thiết kế. Dựa vào đó người thiết kế có thể đưa ra các phương án phù hợp với yêu cầu. Không chỉ vậy, dựa vào sơ đồ việc sửa chữa khi gặp lỗi cũng rất dễ dàng.
Sơ đồ được thiết kế ở dạng 4 khâu. Thông qua các bộ truyền đai – hộp giảm tốc.
4.2. Lựa chọn động cơ
Chọn động cơ AC servo Model: HF-KN23B cho cả 4 khâu của mô hình. Hình 4.1. Sơ đồ thiết kế thực
Bảng 4.1. Thông tin động cơ dùng Mã Công suất (kW) Momem quán tính (x10-4 kg.m2) Cân nặng (kg) Momen xoắn (N.mm) HF-KN23B 0.2 0.31 1.4 1900 4.3. Xác định sơ bộ các khâu 4.3.1. Khâu 3-4 Vật liệu chế tạo: thép C45 Gồm một động cơ và thanh 4.
Cân nặng tổng của cả khâu là: 1,4 + 1,78 = 3,18 kg Bảng 4.2. Thông tin khâu 34
Tên Giá trị Đơn vị
Khối lượng tải 3,18 Kg
Hệ số an toàn 1.5
Hình 4.2. Phân tích lực khâu 34 Momen tải là 0.4995 N.m
Do động cơ 3 đi qua bộ truyền đai,khớp nối và ổ nên ta có hiệu suất:
Hiệu suất của các bộ truyền và các cặp ổ lăn tra bảng(2.3)-[1]