MỞ ĐẦU Khoa học kỹ thuật và công nghệ ở các nước trong khu vực và trên thế giới đang trong thời kỳ phát triển như vũ bão đã đưa Việt Nam đứng trước rất nhiều thời cơ vận hội và thách thức mới trên con đường hội nhập với nền kinh tế thế giới. Hiện nay sự xuất hiện của các Robot trong các ngành công nghiệp, cũng như trong đời sống sinh hoạt đã trở nên phổ biến. Chúng được ứng dụng rộng rãi trong nhiều lĩnh vục khác nhau, đặc biệt trong các ngành sản xuất có tính dây truyền và công nghệ cao. Robot đóng vai trò quan trọng, chúng vừa đảm bảo độ chính xác vừa đảm bảo tính liên tục của dây truyền mà với con người hay những máy móc thông thường khó có thể đạt được. Đồng thời nó có thể thay thế con người làm việc trong những môi trường độc hại, nơi con người khó có thể đặt chân tới như vũ trụ… Nói chung, ứng dụng của Robot là hết sức to lớn, vì vậy mà trong tương lai đây là nhân tố rất quan trọng trong sự phát triển của các ngành sản xuất của nền kinh tế hiện đại. Do vậy việc nghiên cứu các vấn đề về Robot mang tính thời sự. Để Nghiên cứu điều khiển tối ưu cho cánh tay Robot bằng phương pháp Quy hoạch phi tuyến, luận văn của tôi gồm bốn chương: Chương 1: Giới thiệu chung về điều khiển tối ưu Chương 2: Robot công nghiệp và giới thiệu bài toán điều khiển động học ngược robot Chương 3 Giải bài toán điều khiển tối ưu cho cánh tay robot Chương 4: Kết luận và kiến nghị 1 CHƯƠNG 1 : GIỚI THIỆU CHUNG VỀ ĐIỀU KHIỂN TỐI ƯU 1.1. Định nghĩa Điều khiển tối ưu là một chuyên ngành cơ bản trong điều khiển tự động, nó có vai trò xác định và tạo lập những luật điều khiển cho hệ thống để hệ thống đạt được chỉ tiêu về tính hiệu quả đã được định trước dưới dạng ( phiếm) hàm mục tiêu Q. Trong thực tế tồn tại các bài toán điều khiển tối ưu như sau: - Bài toán tối ưu cực tiểu: - Bài toán tối ưu cực đại. 1.2. Bài toán điều khiển tối ưu Bài toán tối ưu được xây dựng dựa trên các giả thiết sau: + Có một mô hình toán học. + Không có nhiễu tác động. + Biết các điều kiện biên của mô hình như : điểm làm việc, thời gian làm việc của hệ thống. + Biết miền giá trị cho phép của các đầu vào u. + Biết hàm mục tiêu Q mô tả tính hiệu quả mà hệ thống cần đạt được. Mục đích của điều khiển tối ưu là tìm tín hiệu tối ưu u * để hàm mục tiêu Q đạt giá trị cực đại hoặc cực tiểu. Với những giả thiết này có rất nhiều phương pháp giải bài toán điều khiển tối ưu khác nhau. Trong nội dung của Luận văn sẽ giới thiệu các phương pháp cơ bản nhất của lĩnh vực điều khiển tối ưu, được chia thành hai nhóm chính như sau: + Điều khiển tối ưu tĩnh. + Điều khiển tối ưu động. 2 1.2.1. Điều khiển tối ưu tĩnh Bài toán điều khiển tối ưu tĩnh là bài toán trong đó quan hệ vào, ra và biến trạng thái của mô hình không phụ thuộc vào thời gian. Giá trị đầu ra tại một thời điểm chỉ phụ thuộc vào các đầu đầu vào và trạng thái tại thời điểm đó. 1.2.1.1. Một số phương pháp tìm nghiệm a. Phương pháp không dùng đạo hàm riêng b. Phương pháp Newton-Raphson c. Phương pháp sử dụng hàm phạt và hàm chặn c.1. Hàm phạt c.2. Hàm chặn 1.2.2. Điều khiển tối ưu động Bài toán điều khiển tối ưu động là bài toán trong đó mô hình toán học có ít nhất một phương trình vi phân. Với bài toán điều khiển tối ưu động, chỉ nghiên cứu các phương pháp sau: 1.2.2.1. Phương pháp biến phân 1.2.2.2. Phương pháp quy hoạch động của Bellman 1.2.2.3. Nguyên lý cực đại 3 CHƯƠNG 2: GIỚI THIỆU ROBOT CÔNG NGHIỆP VÀ BÀI TOÁN ĐIỀU KHIỂN ĐỘNG HỌC NGƯỢC ROBOT 2.1. Tổng quan về robot công nghiệp • Robot và Robotics. Sơ lược quá trình phát triển của robot công nghiệp (IR : Industrial Robot) Vào những năm 40 nhà viết văn viễn tưởng người Nga Issac Asimov mô tả Robot là một chiếc máy tự động, mang diện mạo của con người, được điều khiển bằng một hệ thần kinh khả trình Pisitron, do chính con người lập trình. Asimov đặt tên cho ngành khoa học nghiên cứu về Robot là Robotics, trong đó có 3 nguyên tắc cơ bản sau: - Robot không được xúc phạm con người và không gây tổn hại cho con người. - Hoạt động của robot phải tuân theo các nguyên tắc do con người đặt ra. Các nguyên tắc này không được vi phạm nguyên tắc thứ nhất. - Một robot cần phải bảo vệ sự sống của mình và không được vi phạm hai nguyên tắc trước. 2.1.1. Tự động hóa và robot công nghiệp Tự động hóa ( Automation ) và kỹ thuật robot (Robotics) là hai lĩnh vực có liên quan mật thiết với nhau. Về phương diện công nghiệp, tự động hóa là một công nghệ liên kết với sử dụng các hệ thống cơ khí, điện tử và hệ thống máy tính trong vận hành và điều khiển quá trình sản xuất. Ví dụ, dây chuyền vận chuyển, các máy lắp ráp cơ khí, các hệ thống điều khiển phản hồi, các máy công cụ điều 4 khiển chương trình số và robot. Như vậy, có thể coi robot là một dạng của thiết bị tự động hóa công nghiệp. 2.1.2. Các đặc tính của robot công nghiệp 2.1.2.1. Tải trọng 2.1.2.2. Tầm với 2.1.2.3. Độ phân giải không gian 2.1.2.4. Độ chính xác 2.1.2.5. Độ lặp lại 2.1.2.6. Độ nhún 2.2. Chất lượng quá trình làm việc và các thông số điều khiển 2.2.1. Yêu cầu về chất lượng trong điều khiển Robot Chất lượng quá trình làm việc được dùng làm căn cứ, đánh giá ảnh hưởng theo những chiều hướng khác nhau khi can thiệp vào một thông số điều khiển. Quá trình làm việc có chất lượng tốt được hiểu theo những nghĩa sau: Sai lệch quỹ đạo trong giới hạn cho phép, đây là tiêu chí nói lên độ chính xác về mặt động học cơ cấu. Sai số quỹ đạo có hai nguyên nhân chính là cơ cấu không đáp ứng độ chính xác cần thiết, hoặc điều khiển không đáp ứng độ chính xác cần thiết. Nếu nguyên nhân thuộc về điều khiển thì cần được tiếp tục làm rõ do độ phân giải của thiết bị điều khiển không đủ (lí do về phần cứng), hoặc do giải thuật điều khiển không đáp ứng được (nguyên nhân do chuẩn bị điều khiển không đáp ứng yêu cầu gồm không đáp ứng được độ chính xác cần thiết hoặc không đáp ứng tốc độ tính toán cần thiết). 2.2.2. Giới thiệu bài toán điều khiển động học ngược Robot 5 Bài toán động học ngược được đặc biệt quan tâm vì lời giải của nó là cơ sở chủ yếu để xây dựng chương trình điều khiển chuyển động của robot bám theo quỹ đạo cho trước. Để giải bài toán ngược cần xác định thêm thông tin về phần chấp hành (vị trí và hướng), dữ liệu này do người sử dụng đưa ra trong bài toán ngược. • Bộ thông số Denavit-Hartenberg (DH). Một robot nhiều khâu cấu thành từ các khâu nối tiếp nhau thông qua các khớp động. Gốc chuẩn (Base) của một robot là khâu số 0 và không tính vào số các khâu. Khâu 1 nối với khâu chuẩn bởi khớp 1 và không có khớp ở đầu mút của khâu cuối cùng. 6 x Động học ngược Khối điều khiển Khối chấp hành Tay máy Khối đo lường q _ Hình 2.5 : Sơ đồ điều khiển trong không gian khớp Hình 2.7 : Chiều dài và góc xoắn của một khâu Thông thường, người ta gọi a n là chiều dài và α n là góc xoắn của khâu (Hình 2.7). Phổ biến là hai khâu liên kết với nhau ở chính trục của khớp (Hình 2.8). Mỗi trục sẽ có hai pháp tuyến với nó, mỗi pháp tuyến dùng cho mỗi khâu (trước và sau một khớp). Vị trí tương đối của hai khâu liên kết như thế được xác định bởi d n là khoảng cách giữa các pháp tuyến đo dọc theo trục khớp n và θ n là góc giữa các pháp tuyến đo trong mặt phẳng vuông góc với trục. d n và θ n thường được gọi là khoảng cách và góc giữa các khâu. Các thông số a n , α n , d n và θ n được gọi là bộ thông số DH. 7 Hình 2.8 : Các thông số của khâu θ, d, a và α CHƯƠNG 3: GIẢI BÀI TOÁN ĐIỀU KHIỂN TỐI ƯU CHO CÁNH TAY ROBOT 3.1. Thành lập bài toán điều khiển 3.1.1. Mô hình đối tượng Bất kỳ một robot nào cũng có thể coi là một tập hợp các khâu (links) gắn liền với các khớp (joints). Ta hãy đặt trên mỗi khâu của robot một hệ toạ độ. Sử dụng các phép biến đổi thuần nhất có thể mô tả vị trí tương đối và hướng giữa các hệ toạ độ này. Denavit. J. đã gọi biến đổi thuần nhất mô tả quan hệ giữa một khâu và một khâu kế tiếp là một ma trận A. Nói đơn giản hơn, một ma trận A là một mô tả biến đổi thuần nhất bởi phép quay và phép tịnh tiến tương đối giữa hệ toạ độ của hai khâu liền nhau. A 1 mô tả vị trí và hướng của khâu đầu tiên; A 2 mô tả vị trí và hướng của khâu thứ hai so với khâu thứ nhất. Như vậy vị trí và hướng của khâu thứ hai so với hệ toạ độ gốc được biểu diễn bởi ma trận : T 2 = A 1 .A 2 Cũng như vậy, A 3 mô tả khâu thứ ba so với khâu thứ hai và : T 3 = A 1 .A 2 .A 3 ; v.v Theo phép chuyển đổi thuần nhất thế của khâu chấp hành là hàm của các biến khớp, mô tả bằng ma trận tổng hợp của phép chuyển đổi : 0 1 1 n i n i i A A − = =Π (3.1) Chỉ số trên chỉ hệ toạ độ tham chiếu tới, bỏ qua chỉ số trên nếu chỉ số đó bằng 0. Chỉ số dưới thường dùng để chỉ khâu chấp hành cuối. Nếu một robot có 6 khâu ta có : T 6 = A 1 .A 2 .A 3 .A 4 .A 5 .A 6 T 6 mô tả mối quan hệ về hướng và vị trí của khâu chấp hành cuối đối với hệ toạ độ gốc. Một robot 6 khâu có thể có 6 bậc tự do và 8 có thể được định vị trí và định hướng trong trường vận động của nó ( range of motion ). Ba bậc tự do xác định vị trí thuần tuý và ba bậc tự do khác xác định hướng mong muốn. T 6 sẽ là ma trận trình bày cả hướng và vị trí của robot. Tổng quát, ma trận T 6 có thể biểu diễn gọn hơn như sau: (3.2) Trong đó ( ) o n q T = f (q 1 ,q 2 ,…,q n ); q 1 ÷ q n các biến khớp; n, s, a là các véc tơ chỉ phương; p là véc tơ chỉ vị trí; oxyz là hệ trục tọa độ gốc. Ma trận chuyển đổi tổng hợp có dạng: (3.3) Các thành phần a ij với i, j= 1÷ 3 là các cosin chỉ phương của n, s, a; a 14 , a 24 , a 34 lần lượt là các thành phần chiếu lên hệ Oxyz của p. Do tính chất trực giao của các vec tơ chỉ phương, cho nên chỉ có ba thành phần trong các cosin chỉ phương độc lập. Vì vậy kết hợp (3.2) và (3.3) nhận được: 9 ( ) 0 0 0 1 x x x x o y y y y n z z z z n s a p n s a p q n s a p T       =       11 12 13 14 21 22 23 24 0 31 32 33 34 0 0 0 1 n a a a a a a a a A a a a a       =                  = = = = = = 34 24 14 23 13 12 ap ap ap aa aa as z y x y x x (3.4) Giải hệ phương trình này nhận được giá trị các biến khớp. Khi giải có thể gặp các trường hợp sau: - Hệ phương trình (3.4) có thể phi tuyến hoặc phải xác định biến từ hàm siêu việt vì vậy kết quả không chính xác hoặc có nhiều lời giải. - Hệ (3.4) có thể vô định vì số bậc tự do thừa. - Các kết quả có thể không thoả mãn được các điều kiện ràng buộc về mặt kết cấu. 3.1.2. Phiếm hàm mục tiêu 3.1.2.1. Bài toán tối ưu về độ chính xác về vị trí và hướng của khâu chấp hành Mục tiêu của điều khiển động học là đạt được độ chính xác về vị trí và hướng của khâu chấp hành. Như vậy chỉ cần xác định các giá trị của các biến khớp sao cho đảm bảo sai số vị trí và hướng là nhỏ nhất đồng thời thoả mãn các điều kiện ràng buộc về mặt kết cấu. - Gọi q = {q 1 ,q 2 ,…q n } : là véc tơ các biến khớp. Q = f(q) : Hàm mô tả sai lệch vị trí và hướng của khâu chấp hành. Bài toán xác định giá trị các biến khớp được viết: Q = f (q 1 ,q 2 ,…,q n ) → min (3.5) 10 [...]... hướng nghiên cứu sử dụng phương pháp khai triển thành đa thức để giải bài động học ngược Robot - Phát triển phương pháp tối ưu hoá giải bài toán động học cho robot song song, theo định hướng ghép bài toán xác định các nghiệm toán học và nghiệm điều khiển làm một bài toán duy nhất nhằm giảm thời gian chuẩn bị dữ liệu - Phát triển phương pháp tối ưu giải bài toán động học ngược robot hở để giải quy t... học ngược của Robot cơ cấu 3 khâu phẳng (3 khớp quay) với điều kiện giới hạn của các biến khớp - Tìm hiểu về phương pháp giải thuật di truyền, áp dụng phương pháp di truyền để giải bài toán động học ngược Robot cơ cấu 3 khâu phẳng (3 khớp quay) - Đưa ra hướng nghiên cứu sử dụng phương pháp nội suy đa thức Lagrange để giải bài toán động học ngược Robot 4.2 Một số kiến nghị cho hướng nghiên cứu tiếp theo:... vế trái bằng không, tương đương với hệ phương trình (3.4) được thỏa mãn Đặt Q là hàm số ở vế trái : Q = (sx–a12)2 +(ax–a13)2 +(ay–a23)2 +(px–a14)2+(py –a24)2 +(pz –a34)2 (3.7) Trên cơ sở bài toán đặt ra là điều khiển tối ưu cánh tay robot, với việc xác định khoảng thời gian để cánh tay robot di chuyển tới vị trí cần thiết là ngắn nhất, tức là ta đi tìm nghiệm tối ưu của hàm mục tiêu (3.7) sao cho Q →... để giải bài toán 3.4.3.1 Giới thiệu phương pháp giải thuật di truyền (GA) 3.4.3.2 Các kỹ thuật trong giải thuật di truyền (GA) a Kỹ thuật mã hóa b Khởi tạo quần thể c Hàm thích nghi d Phép chọn lọc e Phép lai ghép f Phép đột biến 3.4.3.3 Giải bài toán bằng phương pháp di truyền (GA) Bảng 3.4: Kết quả giải bài toán ngược cơ cấu 3 khâu phẳng bằng phương pháp Giải thuật di truyền GA q1(rad) q2(rad) q3(rad)... 0.2633 0.0043 19 CHƯƠNG 4 KẾT LUẬN VÀ KIẾN NGHỊ 4.1 Các kết quả nghiên cứu của Luận văn - Chỉ ra các dạng thức khác nhau của bài toán tối ưu - Làm rõ các khái niệm trong lĩnh vực động học và động học ngược Robot công nghiệp - Đưa ra được bài toán tối ưu về độ chính xác về vị trí và hướng của khâu chấp hành - Thành lập mô hình đối tượng và phi m hàm mục tiêu của một số loại Robot - Sử dụng hàm fmincon... tiêu và các điều kiện hạn chế phải được khai báo dưới dạng hàm function viết thành m-File hay inline object Các điều kiện hạn chế thường được mô tả dưới dạng phương trình , hoặc bất phương trình , hoặc hỗn hợp cả hai Thuật ngữ mô tả việc tìm tối ưu dưới điều kiện hạn chế là constrained nonlinear optimization Optimization Toolbox cung cấp cho ta lệnh fmincon, nhằm tìm cực tiểu của f(x) với các điều kiện... d6=160(mm) 3.3.3.3 Điều kiện hạn chế Phạm vi biến thiên của biến khớp xác định từ kết cấu cụ thể của tay máy như sau: - 6(rad) ≤ q1 ≤ 6(rad) - 4(rad) ≤ q2 ≤ 4(rad) - 5.3(rad) ≤ q3 ≤ 5.3(rad) (3.16b) - 6(rad) ≤ q4, q6 ≤ 6(rad) - 2.5(rad) ≤ q5 ≤ 2.5(rad) 3.4 Lời giải bài toán điều khiển tối ưu cho Robot cơ cấu 3 khâu phẳng (3 khớp quay) 3.4.1 Khởi tạo một số ma trận thế ngẫu nhiên cho lời giải * * *... hao bé nhất Trên cơ sở giải được bài toán ngược với thời gian bé, việc xác định phương án di chuyển tối thiểu làm cho cấu trúc có thời gian đáp ứng ngắn nhất với tín hiệu điều khiển 3.1.3 Điều kiện giới hạn của các biến - Trong điều khiển chỉ đòi hỏi độ chính xác hướng của khâu chấp hành, bài toán tối ưu có dạng: Q1 = f (q1,q2,…,qn) → min (3.10) V ≤ Q2 ≤ U Ràng buộc : qi Є D; i=1÷n Trong đó: - Hàm mô... ràng buộc thường có dạng chung cho khớp tịnh tiến và quay 3.3 Thành lập bài toán điều khiển cho một số dạng robot 3.3.1 Robot cơ cấu 3 khâu phẳng (3 khớp quay) 3.3.1.1 Phương trình động học (Mô hình toán học) Sơ đồ động cơ cấu 3 khâu phẳng toàn khớp quay cho như hình vẽ: x3 y3 y0 y1 a2 q3 a3 y2 q2 x2 x1 a1 q1 x0 Hình 3.2: Sơ đồ động học cơ cấu 3 khâu phẳng (3 khớp quay) Hệ phương trình động học thuận... (3.12) U, V: Các sai lệch giới hạn xác định theo yêu cầu kỹ thuật - Tương tự nếu đòi hỏi độ chính xác vị trí của khâu chấp hành bài toán tối ưu có dạng: Q2 = f (q1,q2,…,qn) → min (3.13) V ≤ Q1 ≤ U Trong đó: qi Є D; i=1÷n Về bản chất các bài toán (3.5), (3.10), (3.13) là bài toán tối ưu hóa trên miền kín vì trên thực tế các khớp tịnh tiến hoặc quay của robot thường có không gian hoạt động bị giới hạn trong