Đề tài Bộ điều khiển Parallel Robot

Bộ ĐIềU KHIểN PARALLEL ROBOT KS. Từ Diệp Công Thành, PGS. TS. Đặng Văn Nghìn Bộ Môn Cơ Điện Tử, Khoa Cơ Khí, Đại Học Bách Khoa Tp Hồ Chí Minh Email: tdcthanh@dme. hcmut. edu. vn Tóm tắt Khác với loại Robot nối tiếp (Serial Robot), Robot song song (Parallel Robot) có những −u điểm v−ợt trội nh− độ cứng vững, khả năng thay đổi vị trí và định h−ớng linh hoạt, độ chính xác và ổn định cao, v. v.. đ−ợc ứng dụng trong nhiều lĩnh vực. Bài báo giới thiệu loại Robot song song - Parallel Robot có cấu trúc khép kín đ−ợc tạo bởi 6 chân và điều khiển độc lập. Tuy nhiên nếu dùng những ph−ơng pháp điều khiển thông th−ờng thì tính đáp ứng của robot sẽ chậm. ở đây, chúng tôi trình bày kết quả nghiên cứu về bộ điều khiển song song kết hợp với giải thuật điều khiển song song để làm tăng tính đáp ứng và linh hoạt cho Robot. Abstract Different from many Serial Robots, Parallel Robot has some advantages such as: rigidity, changing position ability and flexible navigation, accuracy and high stability... They are applied in a lot of fields. The Paper introduce the Parallel Robot with closed-loop structure constructed by 6 dof and controlled independently. However, if we use the control medthod as usual the respond of robot will slow. Hereby, we talk about the research results about the Parallel Controller compacted with Parallel Algorithm in order to increase the respond and flexibility for Robot. 1. ĐặT VấN Đề Ngày nay, các kỹ thuật Robot với sự hỗ trợ của máy tính đã đáp ứng đ−ợc độ chính xác cao, thời gian thu nhận và xử lý các tín hiệu nhanh chóng, tin cậy, đã làm tăng năng suất lao động, hạn chế các tai nạn và độc hại cho con ng−ời, v. v... Tuy nhiên với loại Serial Robot hiện nay trong rất nhiều lĩnh vực đã bộc lộ rõ những nh−ợc điểm nh− tính linh hoạt thấp, tốc độ xử lý và khả năng đáp ứng không cao, độ cứng vững cũng nh− tính chính xác ch−a đảm bảo. Để khắc phục phần nào các khuyết điểm trên một loại Robot mới ra đời đó là Parallel Robot. Serial Robot là loại Robot liên tiếp có kết cấu hở đ−ợc liên kết với các khâu động học và đ−ợc điều khiển tuần tự hoặc song song. Khác hẳn với Serial Robot, theo J-P. Merlet, Parallel Robot là cơ cấu vòng kín trong đó khâu tác động cuối đ−ợc liên kết đến nền bởi ít nhất hai chuỗi động học độc lập. Trên hình 1 giới thiệu một loại Parallel Robot . Hình 1: Một loại Parallel Robot Do nhu cầu của thực tế, Parallel Robot đã phát triển theo nhiều h−ớng khác nhau nh−: - Theo bậc tự do Parallel Robot có thể có 3, 4, 5 hoặc 6 bậc tự do. - Theo vận tốc dịch chuyển có các loại vận tốc trung bình và vận tốc cao (v /5m/s) và còn nhiều kiểu phân loại khác nữa. Tuy nhiên nhìn chung tất cả các loại Parallel Robot đều có những −u điểm nh−: khả năng chịu tải cao, gia tốc lớn, độ cứng vững cơ khí cao, khối l−ợng động thấp, tần số riêng cao, kết cấu đơn giản và các cơ cấu chấp hành đều có thể định vị trên tấm nền Với những −u điểm trên, Parallel Robot đã đ−ợc ứng dụng trong rất nhiều lĩnh vực nh−: Y học, thiên văn học, trắc địa, các máy công cụ, v.v. Parallel Robot là chuỗi nhiều khâu khép kín cho nên nó hết sức đa dạng và điều khiển rất phức tạp, để thực hiện một tác động điều khiển cho khâu động học cuối, các khâu động học phải đ−ợc điều khiển đồng thời. Đây là một đòi hỏi khó khăn cho thiết kế bộ điều khiển. 2. Bộ ĐIềU KHIểN SONG SONG Nh− đã giới thiệu, để thực hiện việc điều khiển cho Parallel Robot, cần có một bộ điều khiển sao cho đảm bảo đ−ợc tính đồng thời, khả năng nhớ và quản lý từng khâu động học độc lập. ở đây, chúng tôi giới thiệu một bộ điều khiển dùng cho Parallel Robot có 6 bậc tự do (hình 2). Hình 2: Sơ đồ khối của bộ điều khiển Parallel Robot Bộ điều khiển Parallel Robot là hệ thống phức tạp, gồm một tập hợp các phần tử xử lý độc lập liện lạc với nhau bằng cách trao đổi các thông tin. Mỗi một bộ xử lý độc lập sẽ thực hiện một loạt các chỉ thị của chính nó và làm việc trên một tập các dữ liệu riêng biệt. Giới thiệu các ph−ơng pháp điều khiển song song Các nghiên cứu đã đ−ợc triển khai nhằm tìm kiếm ph−ơng pháp tạo ra những ch−ơng trình có thể thực thi đồng thời trên những ch−ơng trình song song. Các nghiên cứu triển khai việc song song hoá có thể đ−ợc phân thành 4 mức : Máy tính Khối điều khiển trung tâm Khối điều khiển động học khâu 1 Khối điều khiển động học khâu 2 Khối điều khiển động học khâu 3 Khối điều khiển động học khâu 4 Khối điều khiển động học khâu 6 Khối điều khiển động học khâu 5 Khối mạch khuếch đại công suất - ở mức ứng dụng: Các ch−ơng trình đ−ợc thực thi đồng thời trên những bộ xử lý khác nhau hoặc những máy khác nhau và có thể có sự trao đổi thông tin lẫn nhau. Chúng thực hiện việc phân phối các ứng dụng cho các bộ xử lý theo không gian và thậm chí theo thời gian. ở mức này, mỗi ch−ơng trình ứng dụng vẫn thực thi tuần tự. - ở mức ch−ơng trình: Ng−ời lập trình sẽ tìm kiếm giải thuật có thể thực thi đồng thời cho vấn đề cần giải quyết. Do đó, trách nhiệm song song hoá ch−ơng trình sẽ do ng−ời lập trình thực hiện. Bằng t− duy của con ng−ời cũng nh− tùy theo đặc thù của mỗi bài toán, ng−ời lập trình có thể tìm ra cách thức song song hoá khác nhau sao cho ch−ơng trình có thể thực thi đồng thời một cách hiệu quả nhất. - ở mức phát biểu: Ch−ơng trình dịch sẽ đảm nhiệm vai trò song song hoá ch−ơng trình. Nó sẽ tìm kiếm trong một ch−ơng trình tuần tự từ những khả năng song song hoá, thực hiện các biến đổi để tạo ra mã ch−ơng trình song song, sinh thêm các mã đồng bộ và trao đổi thông tin. −u điểm chính của mức này là khó khăn của ng−ời lâp trình đ−ợc giảm nhẹ và ch−ơng trình có tính linh hoạt và có thể áp dụng trên những mô hình máy khác nhau vì ch−ơng trình dịch sẽ thực hiện việc tạo mã thích hợp cho mô hình máy mà nó đang dịch sang. - ở mức lệnh máy: Các bộ xử lý sẽ tìm cách thực hiện nhiều lệnh máy đồng thời theo các cơ chế khác nhau. Qua phân tích khả năng công nghệ và tính kinh tế, chúng tôi lựa chọn ph−ơng pháp giả lập song song từ máy tính ở mức ch−ơng trình. Thiết kế bộ điều khiển song song Bộ điều khiển song song đ−ợc thiết kế dựa trên giải thuật giả lập song song từ máy tính và giao tiếp với máy tính thông qua Slot chuẩn ISA. Từ đó để đảm bảo tính nhớ và khả năng quản lý các khâu động học độc lập thì ứng với từng khâu yêu cầu phải có địa chỉ riêng, ngoài ra phải có khả năng mở rộng port điều khiển và giám sát quá trình điều khiển. Chúng tôi đã lựa chọn IC 8255 làm nhiệm vụ quản lý và lập trình điều khiển cũng nh− xác định 6 địa chỉ port và điều khiển cho các khâu động học (hình 3). Hình 3: Bộ điều khiển Parallel Robot 3. GIảI THUậT ĐIềU KHIểN GIả LậP SONG SONG Trên các hệ thống lập trình song song, khi thiết kế cần phải đảm bảo các đặc tính nh−: khả năng mở rộng (scalability), khả năng hoạt động cục bộ (locality) và có tính module (modularity). - Tính đồng thời là khả năng thực hiện nhiều hành động đồng thời, thực chất là để ch−ơng trình thi hành cùng lúc trên nhiều processor. VCC P A 1 1 P A 1 2 P A 1 3 P A 1 4 P A 1 5 P A 1 6 P A 1 7 P A 1 8 P B 1 1 P B 1 2 P B 1 3 P B 1 4 P B 1 6 P B 1 7 P B 1 8 P C 1 1 P C 1 2 P C 1 3 P C 1 4 P C 1 5 P C 1 6 P C 1 7 P C 1 8 P A 3 1 P A 3 2 P A 3 3 P A 3 4 P A 3 5 P A 3 6 P A 3 7 P A 3 8 P B 3 1 P B 3 2 P B 3 3 P B 3 4 P B 3 5 P B 3 6 P B 3 7 P B 3 8 P C 3 1 P C 3 2 P C 3 3 P C 3 4 P C 3 5 P C 3 6 P C 3 7 P C 3 8 P A 6 1 P A 6 2 P A 6 3 P A 6 4 P A 6 5 P A 6 6 P A 6 8 P B 6 1 P B 6 2 P B 6 3 P B 6 4 P B 6 7 P B 6 8 P C 6 1 P C 6 4 P C 6 5 P C 6 6 P C 6 7 P C 6 8 P A 6 7 P B 5 5 P C 5 6 P A 2 7 P A 2 3 P A 5 8 P A 5 7 P A 5 1 P B 2 8 P B 2 4 P A 2 5 P C 5 1 P B 5 2 P A 5 4 P C 2 7 P C 2 5 P B 2 6 P C 5 3 P A 5 6 P B 2 1 P C 2 2 P C 2 4 P B 5 8 P B 5 4 P C 5 5 P B 5 6 P A 2 2 P C 5 7 P B 2 3 P A 2 4 P B 5 7 P B 5 1 P A 5 3 P B 2 5 P A 2 6 P C 5 8 P C 5 2 P B 5 3 P A 5 5 P C 2 8 P C 2 6 P B 2 7 P C 5 4 P A 2 8 P A 2 1 P C 2 1 P B 2 2 P A 5 2 P C 2 3 P A 2 1 P C 2 8 P A 2 5 P B 1 5 P C 2 2 P B 2 2 P A 2 3 P A 2 2 P B 2 3 P A 2 4 P C 2 1 P B 2 4 P A 2 7 P A 2 6 P C 2 6 P B 2 1 P C 2 3 P A 2 8 P C 2 7 P B 2 5 P B 2 6 P B 2 8 P B 2 7 P C 2 5 P C 2 4 P B 6 5 P B 6 6 P C 6 2 P C 6 3 P A 1 4 P A 1 5 P A 1 1 P A 1 6 P C 1 4 P A 1 7 P A 1 8 P B 1 1 P C 1 6 P C 1 8 P B 1 8 P A 1 2 P B 1 2 P B 1 6 P C 1 3 P C 1 5 P B 1 5 P B 1 7 P B 1 3 P C 1 7 P C 1 1 P A 1 3 P B 1 4 P C 1 2 P A 3 1 P C 3 3 P B 3 4 P C 3 6 P A 3 2 P A 3 4 P A 3 5 P B 3 5 P C 3 1 P A 3 6 P C 3 4 P C 3 5 P A 3 8 P B 3 2 P B 3 3 P B 3 6 P C 3 7 P A 3 7 P B 3 1 P C 3 2 P C 3 8 P A 3 3 P B 3 7 P B 3 8 P A 5 8 P C 5 3 P C 5 8 P C 5 6 P C 5 2 P B 5 6 P B 5 5 P C 5 5 P B 5 7 P C 5 1 P B 5 8 P C 5 4 P C 5 7 P C 6 2 P A 4 1 P C 6 3 P A 4 2 P A 6 5 P B 6 2 P B 4 3 P A 6 3 P B 6 6 P C 6 6 P B 4 5 P A 6 7 P A 6 8 P C 6 5 P B 6 5 P B 6 4 P B 6 3 P B 4 6 P A 6 1 P C 6 7 P B 6 1 P C 4 7 P B 6 7 P C 6 1 P A 6 2 P C 6 4 P C 6 8 P A 6 4 P A 6 6 P B 6 8 P B 5 4 P B 5 1 P A 5 6 P B 5 3 P B 5 2 P A 5 7 P A 5 4 P A 5 2 P A 5 5 P A 5 3 P C 4 5 P C 4 6 P B 4 1 P C 4 2 P C 4 3 P A 4 6 P B 4 4 P A 4 4 P B 4 8 P B 4 5 P B 4 8 P A 4 5 P B 4 7 P B 4 6 P C 4 4 P C 4 8 P B 4 2 P C 4 1 P C 4 4 P B 4 7 P C 4 6 P A 4 7 P C 4 2 P C 4 7 P C 4 8 P A 4 8 P A 4 1 P C 4 1 P B 4 3 P A 4 3 P C 4 3 P C 4 5 P A 4 2 P B 4 1 P A 4 7 P A 4 3 P B 4 4 P A 4 6 P B 4 2 P A 4 8 P A 4 4 P A 4 5 D 1 D 1 D 4 D 3 D 7 D 5 D 7 D 4 D 5 D 0 D 6 D 2 D 3 D 0 D 6 D 2 A 7 A 8 A 5 A 6 A 9 U1 8255 3 4 3 3 3 2 3 1 3 0 2 9 2 8 2 7 4 3 2 1 4 0 3 9 3 8 3 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 2 5 1 4 1 5 1 6 1 7 1 3 1 2 1 1 1 0 2 6 75 3 6 9 8 3 5 6 D 0 D 1 D 2 D 3 D 4 D 5 D 6 D 7 P A 0 P A 1 P A 2 P A 3 P A 4 P A 5 P A 6 P A 7 P B 0 P B 1 P B 2 P B 3 P B 4 P B 5 P B 6 P B 7 P C 0 P C 1 P C 2 P C 3 P C 4 P C 5 P C 6 P C 7 V C C G N D R D W R A 0 A 1 R E S E T C S U8A 74HC00 1 2 3 74HC00 9 10 8 U2 8255 3 4 3 3 3 2 3 1 3 0 2 9 2 8 2 7 4 3 2 1 4 0 3 9 3 8 3 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 2 5 1 4 1 5 1 6 1 7 1 3 1 2 1 1 1 0 2 6 75 3 6 9 8 3 5 6 D 0 D 1 D 2 D 3 D 4 D 5 D 6 D 7 P A 0 P A 1 P A 2 P A 3 P A 4 P A 5 P A 6 P A 7 P B 0 P B 1 P B 2 P B 3 P B 4 P B 5 P B 6 P B 7 P C 0 P C 1 P C 2 P C 3 P C 4 P C 5 P C 6 P C 7 V C C G N D R D W R A 0 A 1 R E S E T C S 74HC00 4 5 6 u5 8255 3 4 3 3 3 2 3 1 3 0 2 9 2 8 2 7 4 3 2 1 4 0 3 9 3 8 3 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 2 5 1 4 1 5 1 6 1 7 1 3 1 2 1 1 1 0 2 6 75 3 6 9 8 3 5 6 D 0 D 1 D 2 D 3 D 4 D 5 D 6 D 7 P A 0 P A 1 P A 2 P A 3 P A 4 P A 5 P A 6 P A 7 P B 0 P B 1 P B 2 P B 3 P B 4 P B 5 P B 6 P B 7 P C 0 P C 1 P C 2 P C 3 P C 4 P C 5 P C 6 P C 7 V C C G N D R D W R A 0 A 1 R E S E T C S P1 CONNECTOR DB25 1 3 2 5 1 2 2 4 1 1 2 3 1 0 2 2 9 2 1 8 2 0 7 1 9 6 1 8 5 1 7 4 1 6 3 1 5 2 1 4 1 R1 10k u3 8255 3 4 3 3 3 2 3 1 3 0 2 9 2 8 2 7 4 3 2 1 4 0 3 9 3 8 3 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 2 5 1 4 1 5 1 6 1 7 1 3 1 2 1 1 1 0 2 6 75 3 6 9 8 3 5 6 D 0 D 1 D 2 D 3 D 4 D 5 D 6 D 7 P A 0 P A 1 P A 2 P A 3 P A 4 P A 5 P A 6 P A 7 P B 0 P B 1 P B 2 P B 3 P B 4 P B 5 P B 6 P B 7 P C 0 P C 1 P C 2 P C 3 P C 4 P C 5 P C 6 P C 7 V C C G N D R D W R A 0 A 1 R E S E T C S U7 74HC138 8 1 5 1 4 1 3 1 2 1 1 1 0 9 7 1 2 3 5461 6 G N D Y 0 Y 1 Y 2 Y 3 Y 4 Y 5 Y 6 Y 7 A B C G 2 B G 2 A G 1 V C C R2 10k u6 8255 3 4 3 3 3 2 3 1 3 0 2 9 2 8 2 7 4 3 2 1 4 0 3 9 3 8 3 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 2 5 1 4 1 5 1 6 1 7 1 3 1 2 1 1 1 0 2 6 75 3 6 9 8 3 5 6 D 0 D 1 D 2 D 3 D 4 D 5 D 6 D 7 P A 0 P A 1 P A 2 P A 3 P A 4 P A 5 P A 6 P A 7 P B 0 P B 1 P B 2 P B 3 P B 4 P B 5 P B 6 P B 7 P C 0 P C 1 P C 2 P C 3 P C 4 P C 5 P C 6 P C 7 V C C G N D R D W R A 0 A 1 R E S E T C S R3 10k R4 10k R5 10k JP1 HEADER 12X2 1 2 3 4 5 6 7 8 9 1 0 1 1 1 2 1 3 1 4 1 5 1 6 1 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 JP2 HEADER 12X2 1 2 3 4 5 6 7 8 9 1 0 1 1 1 2 1 3 1 4 1 5 1 6 1 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 JP6 HEADER 12X2 1 2 3 4 5 6 7 8 9 1 0 1 1 1 2 1 3 1 4 1 5 1 6 1 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4JP3 HEADER 12X2 1 2 3 4 5 6 7 8 9 1 0 1 1 1 2 1 3 1 4 1 5 1 6 1 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 JP5 HEADER 12X2 1 2 3 4 5 6 7 8 9 1 0 1 1 1 2 1 3 1 4 1 5 1 6 1 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 JP4 HEADER 12X2 1 2 3 4 5 6 7 8 9 1 0 1 1 1 2 1 3 1 4 1 5 1 6 1 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 R6 10k P2 CONNECTOR DB25 1 3 2 5 1 2 2 4 1 1 2 3 1 0 2 2 92 1 82 0 71 9 61 8 51 7 41 6 31 5 21 4 1 74HC688 1 1 0 1 9 2 0 3 5 7 9 1 2 1 4 1 6 1 8 2 4 6 8 1 1 1 3 1 5 1 7 O E G N D P = Q V C C Q 0 Q 1 Q 2 Q 3 Q 4 Q 5 Q 6 Q 7 P 0 P 1 P 2 P 3 P 4 P 5 P 6 P 7 R7 10K SW4 SW DIP-8/SM R8 10k u10 74HC245 2 3 4 5 6 7 8 9 1 9 1 1 8 1 7 1 6 1 5 1 4 1 3 1 2 1 1 2 0 1 0 A 0 A 1 A 2 A 3 A 4 A 5 A 6 A 7 O E D IR B 0 B 1 B 2 B 3 B 4 B 5 B 6 B 7 V C C G N D u4 8255 3 4 3 3 3 2 3 1 3 0 2 9 2 8 2 7 4 3 2 1 4 0 3 9 3 8 3 7 1 8 1 9 2 0 2 1 2 2 2 3 2 4 2 5 1 4 1 5 1 6 1 7 1 3 1 2 1 1 1 0 2 6 75 3 6 9 8 3 5 6 D 0 D 1 D 2 D 3 D 4 D 5 D 6 D 7 P A 0 P A 1 P A 2 P A 3 P A 4 P A 5 P A 6 P A 7 P B 0 P B 1 P B 2 P B 3 P B 4 P B 5 P B 6 P B 7 P C 0 P C 1 P C 2 P C 3 P C 4 P C 5 P C 6 P C 7 V C C G N D R D W R A 0 A 1 R E S E T C S P A 5 1 D 0 D 1 D 2 D 3 D 4 D 5 D 6 D 7 D 2 D 1 D 3 D 4 D 5 D 6 D 7 D 0 D 0 D 3 D 4 D 5 D 6 D 7 D 2 D 1 D 3 D 5 D 6 D 7 D 0 D 2 D 1 D 4 D 3 D 4 D 5 D 6 D 7 D 0 D 2 D 1 C S 2 C S 1 C S 5 C S 6 C S 4 C S 3 C S 2 C S 1 C S 5 C S 6 C S 4 C S 3 A 0 A 1 A 0 A 1 A 0 A 1 A 0 A 1 A 0 A 1A 0 A 1 R D R D R D R D R D R D W R W R W R W R W R W R R E S E T R E S E T R E S E T R E S E T R E S E T R E S E T A E NA 2 A 3 A 4 A 2 A 4 R D W R A 0 2 A 0 3 A 0 4 A 0 5 A 0 6 A 0 7 A 0 8 A 0 9 A 1 A 0 A 3 A 5 A 6 A 7 A 8 A 9 A E NR D W R R E S E T V C C G N D V C C G N D V C C G N D V C C G N D V C C G N D V C C G N D V C C G N D A 0 9 A 0 5 A 0 6 A 0 7 A 0 4 A 0 3 A 0 2 A 0 8 R D V C C G N D V C C V C C G N D G N D G N D V C C G N D G N D G N D G N D P A 4 1 P A 4 2 P A 4 3 P A 4 4 P A 1 1 P A 1 2 P A 1 3 P A 1 4 P A 2 1 P A 2 2 P A 2 3 P A 2 4 P A 3 1 P A 3 2 P A 3 3 P A 3 4 P A 6 1 P A 6 2 P A 6 3 P A 6 4 P A 5 1 P A 5 2 P A 5 3 P A 5 4 - Tính mở rộng nhằm đạt đ−ợc vấn đề quan trọng là cài đặt ch−ơng trình một lần, nh−ng có thể hoạt động trên các hệ thống khác nhau không phụ thuộc vào số processor. Nói cách khác, ch−ơng trình có thể cài đặt mà không quan tâm đến số processor sẽ thi hành. - Tính cục bộ đ−ợc thoả mãn thì chi phí của thuật giải giảm đáng kể bởi việc truy cập đến dữ liệu cục bộ xảy ra th−ờng xuyên hơn việc truy cập đến dữ liệu ở xa. - Thuộc tính modularity đ−ợc mong đợi giống với sự mong đợi trong lập trình tuần tự. Đây chính là sự phân chia của những thực thể phức tạp thành các thành phần đơn giản hơn. Ph−ơng pháp thiết kế giải thuật giả lập song song có thể đ−ợc xây dựng nhờ một tiến trình thiết kế tổng quát qua 4 giai đoạn riêng biệt : - Sự phân chia: Việc tính toán đ−ợc thực hiện trên những vùng dữ liệu nhỏ hơn và các thao tác đ−ợc đ−a về thành những nhiệm vụ nhỏ hơn. - Sự thông tin: Xác định các cấu trúc và thuật giải truyền thông giữa các nhiệm vụ để có sự hoạt động phù hợp. - Sự kết hợp: Nhiệm vụ và các cấu trúc truyền thông đ−ơc xác định trong hai giai đoạn đầu đ−ợc đánh giá đối với những yêu cầu của việc thực hiện và chi phí của việc cài đặt. Nếu cần thiết, những nhiệm vụ kết hợp lại để có những nhiện vụ lớn hơn từ đó tăng hiệu suất thực hiện hoăc giảm chi phí của thuật giải. - Sự sắp xếp: Mỗi nhiệm vụ đ−ợc gán đến một processor sao cho tận dụng tối đa số processor và tối thiểu về chi phí truyền thông. Những đặc tính đ−ợc yêu cầu cho việc thiết kế các giải thuật song song và đồng thời 4 giai đoạn trong ph−ơng pháp thiết kế giải thuật giả lập song song là cơ sở cho việc thiết kế ch−ơng trình điều khiển giả lập song song đ−ợc ứng dụng cho mô hình song song Parallel. Robot. Ch−ơng trình điều khiển giải lập song song đ−ợc thiết kế trên những ứng dụng với mỗi mức ứng dụng là một ch−ơng trình điều khiển cho một cơ cấu chấp hành nhằm thực hiện một tác vụ có liên quan, đó là thay đổi chiều dài của các chân nhằm định h−ớng, vị trí của tấm di chuyển trong không gian. Trình tự các b−ớc tiến hành cho việc thiết kế ch−ơng trình điều khiển giả lập song song theo cơ chế phân chia thời gian thực nh− sau: - Xây dựng mô hình toán học nhằm xác định thời gian thực yêu cầu của từng ứng dụng - Kiểm soát hệ thống các dữ liệu liên quan đến từng mức ứng dụng và đồng thời tổ chức sắp xếp trình tự yêu cầu của mỗi mức ứng dụng - Xác định bit địa chỉ t−ơng ứng với trình tự yêu cầu của mỗi mức ứng dụng - Tiến hành phân chia khe thời gian t−ơng ứng với trình tự yêu cầu của mỗi mức ứng dụng, nhằm đáp ứng khả năng song song hoá các ch−ơng trình điều khiển của mỗi mức ứmg dụng. Giải thuật điều khiển giả lập song song đ−ợc trình bày trên hình 4. Hình 4: Giải thuật điều khiển giả lập song song 4. Kết luận Chúng tôi đã triển khai chế tạo bộ điều khiển Parallel Robot và qua quá trình nghiên cứu lý thuyết cũng nh− thực hiện một số thử nghiệm bộ điều khiển Parallel Robot hiện đang đ−ợc ứng dụng để điều khiển mô hình HEXAPOD-2001. Kết quả là ban đầu đã chứng tỏ nó có khả năng đảm bảo tính giả lập song song, quản lý đ−ợc các khâu động học độc lập, tính ổn định và nâng cao đ−ợc khả năng đáp ứng thời gian thực trong quá trình điều khiển Parallel Robot. H−ớng nghiên cứu phát triển tiếp tục là nâng cao tính ổn định, khả năng đáp ứng thời gian thực và kỹ thuật lập trình giả lập song song của loạI bộ điều khiển này và ứng dụng trong các mô hình Parallel Robot khác hiện đang đ−ợc triển khai tại Bộ môn Cơ Điện Tử – Khoa Cơ Khí - Đại học Bách Khoa TP. Hồ Chí Minh. TàI LIệU THAM KHảO [1] Trần Nguyên Duy Ph−ơng, Thiết kế và điều khiểnHexapod, Luận án cao học, Đại học Bách Khoa TPHCM 2000. [2] LUNG WEN TSAI - Robot Analysis - Department of Mechanical Engineering and Institute for Systems Research University of Maryland - 1999. [3] T. D. BURTONM, Introduction to Dynamic Systems Analysis, McGraw-Hill, Inc 1994. [4] FRANCIS C. MOON, Applied Dynamics With Applications to Multibody and Mechatronics Systems, John Willey& Sons, Inc 1998. [5] K.S. FU, R.C. GONZALEZ, C.S.G. LEE, Robotics Control, Sensing, Vision, And Intelligene, McGraw-Hill, Inc 1987. [6] LORENZO SCIAVICCO, BRUNO SICILIANO, Modeling And Control of Robot Manipulators, McGraw-Hill, Inc 1996. [7] DEVDAS SHETTY, RICHARD A. KOLK, Mechatronics System Design, PWS Publishing Company, 1997. [8] www.parallemic.org [9] www.hexapod.com