1 Danh mục hình vẽ. 2 LỜI NÓI ĐẦU Khi xét về vấn đề Robot chúng ta đặt ra các bài toán: động học Robot, động lực học Robot và điều khiển Robot. Đây là những bước cơ sở ban đầu hết sức quan trọng trước khi thiết kế Robot. Với sự phát triển như vũ bão của công nghệ thông tin như ngày này, rất nhiều các lĩnh vực trong cơ khí đã tận dụng được sự phát triển này để tạo ra những bước nhảy vọt, rong đó có công nghiệp Robot. Trên cơ sở đó, môn học Robotics đã mang lại cho sinh viên những kiến thức vô cùng quan trọng cho sinh viên chúng em. Bên cạnh đó, nó cũng tạo ra một cơ hội để sinh viên được tiếp cận với những phần mềm tính toán, mô phỏng phổ biến trên thế giới hiện nay như Maple và Matlab. Để thực hiện được bài tập lớn này, em xin chân thành cảm ơn thầy giáo, PGS.TS Phan Bùi Khôi đã tận tình, chu đáo dạy học trên lớp. Em xin chân thành cảm ơn thầy. 3 CHƯƠNG I . GIẢI BÀI TOÁN ĐỘNG HỌC 1.1. Giải bài toán động học thuận 1.1.1. Cơ sở lý thuyết Vị trí mỗi khâu trong không gian được xác định bởi vị trí một điểm định vị và hướng của khâu đó đối với một hệ quy chiếu đã chọn. Điểm định vị là một điểm xác định nào đó của khâu, thông thường trong động lực học ta hay lấy khối tâm của khâu đó làm điểm định vị. Hướng của khâu được xác định bằng ma trận cosin chỉ hướng hoặc bằng các tọa độ suy rộng xác địnhvị trí của vật rắn quay quanh một điểm. Động học robot nghiên cứu chuyển động của các khâu của robot về phương diện hình học, không quan tâm đến các lực và momen gây ra chuyển động.Động học robot là bài toán qua trọng phục vụ tính toán và thiết kế robot.Nhiệm vụ chủ yếu của bài toán động học thuận là xác định vị trí và hương của bàn kẹp dưới dạng hàm của biến khớp. Các phương pháp ma trận 4x4 và các phương pháp ma trận 3x3 hay được sử dụng trong phân tích động học robot. Hai phương pháp ma trận 4x4 phổ biến là phương pháp ma trận Denavit-Hartenberg và phương pháp ma trận Craig. Trong báo cáo này chúng em trình bày và áp dụng phương pháp ma trận Denavit-Hartenberg để tính toán động học robot. Giải bài toán động học thuận robot công nghiệp bằng phương pháp ma trận Denavit- Hartenberg Cách xác định các trục cuả hệ tọa độ khớp. Đối với robot công nghiệp ,Denavit-Hartenberg đã đưa ra cách chọn các hệ trục tọa độ có gốc tại khớp thứ i như sau: Trục 1i z − được chọn dọc theo hướng của trục khớp động thứ i. Trục 1i x − được chọn dọc theo đường vuông góc chung của 2 trục 2i z − và 1i z − hương đi từ trục 2i z − sang trục 1i z − . Nếu trục 1i z − cắt trục 2i z − thì hướng của trục 1i x − được chọn tùy ý miễn là vuông góc với trục 1i z − .Khi 2 trục 2i z − và 1i z − song song với nhau, giữa 2 trục này có nhiều đường vuông góc chung , ta có thể chọn trục 1i x − hướng theo pháp tuyến chung nào cũng được. Gốc tọa độ 1i O − được chọn tại giao điểm cuả trục 1i x − và trục 1i z − . 4 Trục 1i y − được chọn sao cho hệ 1 ( x ) i O yz − là hệ quy chiếu thuận. Hệ tọa độ 1 ( x ) i O yz − được xác định như trên trong một số tài liệu được quy ước là hệ tọa độ khớp. Chú ý: Với cách chọn hệ tọa độ như trên , đôi khi hệ tọa độ khớp 1 ( x ) i O yz − không được một cách duy nhất. vì vậy, ta có một số bổ sung thích hợp như sau. Đối với hệ tọa độ 0 ( x )O yz theo quy ước trên ta mới chỉ chọn được trục 0 z , còn trục 0 x chưa có trong quy ước trên.Ta có thể chọn trục 0 x một cách tùy ý, miễn là 0 x vuông góc với 0 z . Đối với hệ tọa độ ( x ) n O yz , do không có khớp (n+1) nên theo quy ước trên ta không xác định n z . Trục n z không được xác định duy nhất, trong khi trục n x lại được chọn theo đường pháp tuyến của trục 1n z − . Trong trường hợp này, nếu khớp n là khớp quay, ta có thể chọn trục n z song song trục 1n z − . Ngòai ra ta có thể chọn tùy ý sao cho hợp lý. Khi khớp thứ i là tịnh tiến, về nguyên tắc ta có thể chọn trục 1i z − một cách tùy ý. Tuy nhiên trong nhiều trường hợp người ta thường chọn trục 1i z − dọc theo trục cuả khớp tịnh tiến này. 5 Hình 1. 1. Diễn các thông số Denavit-Hartenberg giữa các trục hệ tọa độ Các tham số động học Denavit-Hartenberg Vị trí của hệ toạ độ khớp (Oxyz) i đối với hệ tọa độ khớp (Oxyz) i-1 được 4 tham số Denavit-haartenderg d i ,a i , như sau: i d dịch chuyển tịnh tiến dọc theo trục 1i z − để gốc tọa độ 1i O − chuyển đến ' i O giao điểm của trục i x và trục 1i z − . i θ : góc quay quanh trục 1i z − để trục 1i x − chuyển đến trục ' i x ( ' i x // i x ). i a : dịch chuyển tịnh tiến theo dọc trục i x để điểm ' i O chuyển đến điểm i O . i α : góc quay quanh trục i x sao cho trục ' 1i z − ( ' 1i z − // 1i z − ). Chuyển đến trục i z . Do hệ trục tọa độ 1 ( xyz) i O − gắn liền vào khâu thứ i-1 , còn hệ trục tọa độ ( xyz) i O gắn liền vào khâu thứ i , cho nên vị trí cuả khâu thứ i đối với khâu thứ i-1, được xác định bới 4 tham số Denavit-hartenberg. Trong 4 tham số trên, các tham số i a và i α luôn luôn là các hằng số , độ lớn của chúng phụ thuộc vào hình dáng và sự ghép nối các khâu thứ i-1 và thứ i. Hai tham số còn lại i θ và i d một là hằng số, một là biến số phụ thuộc vào khớp i là khớp quay hay khớp tịnh tiến.Khi khớp i là khớp quay thì i θ là biến, còn i d là hằng số. Khi khớp i là khớp tịnh tiến thì i d là biến, còn i θ là hằng số. Chú ý về việc xác định hệ tọa độ khớp tại khớp tịnh tiến.Trong trường hợp khớp i là khớp tịnh tiến, về nguyên tắc ta có thể chọn trục 1i z − một cách tùy ý, do đó việc xác định các tham số Denavit-Hartenberg phụ thuộc vào việc chọn hệ trục tọa độ. Ma trận của phép biến đổi, kí hiệu là i H , là tích của 4 na trận biến đổi cơ bản,và có dạng như sau: 6 cos( ) sin( )cos( ) sin( )sin( ) cos( ) sin( ) cos( )cos( ) cos( )sin( ) sin( ) 0 sin( ) cos( ) 0 0 0 1 i i i i i i i i i i i i i i i i i θ θ α θ α a θ θ θ α θ α a θ α α d −     −   =       H 11Equation Section (Next)212\* MERGEFORMAT (.) Ma trận i H được xác định bởi công thức (1.1) được gọi là ma trận Denavit-Hartenberg địa phương. Phương trình xác định vị trí khâu thao tác (bàn kẹp) cuả robot. Xét mô hình cơ học của một robot n khâu động như hình vẽ: Hình 1. 2. Robot n khâu Theo nguyên tắc nêu trên, ta thiết lập được hệ trục tọa độ gắn liền với giá cố định và hệ tọa độ gắn liền với các vật.Gọi 0 R là hệ quy chiếu 0 ( xyz)O gắn liền với giá cố định, hệ quy chiếu ( xyz) i i R O = gắn liền với khâu thứ i.Ma trận 1i i H − cho ta biết vị trí và hướng của khâu i đối với hệ quy chiếu 1i R − gắn vào khâu thứ i-1. Từ đó suy ra ma trận Denavit-Hartenberg i H cho biết vị trí của hệ quy chiếu ( xyz) i i R O= đối với hệ quy chiếu 1 1 ( xyz) i i R O − − = .Áp dụng liên tiếp các phép biến đổi đối với robot n khâu, ta có: 7 0 1 2 3 n = =D H H H H 313\* MERGEFORMAT (.) ( ) 0 0 1 n E T n   =     A r D `414\* MERGEFORMAT (.) Ma trận n D cho biết vị trí của điểm tác động cuối E và hướng cuả khâu thao tác (bàn kẹp) của robot đối với hệ quy chiếu cố định 0 R Như vậy khi biết được các đặc tính hình học cuả các khâu và quy luật chuyển động của các khớp là ta có thể xác định được vị trí và hướng của bàn kẹp. Xác định vận tốc, gia tốc điểm tác động cuối và vận tốc góc, gia tốc góc các khâu cuả robot bằng phương pháp trực tiếp. Vận tốc và gia tốc dài của bàn kẹp có thể dễ dàng suy ra từ đạo hàm vector tọa độ (0) E r Vận tốc điểm thao tác: ( ) ( ) ( ) ( ) ( ) ( ) ( ) ( ) 0 0 0 0 0 0 0 0 0 , : E R E E Ex Ey E Ez E d x dt v d d hay v y dt dt v d z dt                               = =v r 515\* MERGEFORMAT (.) Gia tốc điểm thao tác: ( ) ( ) ( ) ( ) ( ) ( ) ( ) ( ) 0 0 0 0 0 0 0 0 0 , : Ex R E Ey Ez Ex E Ey Ez d v dt a d d hay a v dt dt a d v dt                             = =a v 616\* MERGEFORMAT (.) Ta có thể tính trực tiếp vận tốc góc khâu thứ i của robot dựa trên công thức tính vận tốc góc vật rắn thông qua ma trận cosin chỉ hướng như sau: ° ( ) ° ( ) 0 0 T i i i T i i i = = ω A A ω A A & & 717\* MERGEFORMAT (.) Từ (1.6) suy ra biểu thức vận tốc góc khâu thứ i của robot. 8 Áp dụng định nghĩa gia tốc góc của vật rắn, khi biết vận tốc góc của các khâi của robot ta có thể tính gia tốc góc các khâu của robot theo công thức sau: 0 0 0 R R B R B d dt =α ω ur uur 818\* MERGEFORMAT (.) 1.1.2. Thiết lập phương trình động học thuận cho robot RRR. Hình 1. 3. Đặt các trục tọa độ cho robot RRR Thiết lập bảng động học DH. Từ hình vẽ ta tìm được bảng động học: i d , i θ , i a , i α Khâu i θ i d i a i α 1 1 q 0 1 a 2 π 2 2 q 0 2 a 0 3 3 q 0 3 a 0 a. Tìm các ma trận biến đổi Dựa vào công thức (1.1) ở trên ta thiết lập các ma trận Denavit-Hartenberg H i như sau: 9 1 1 1 1 1 1 1 1 1 0 0 0 1 0 0 0 0 0 1 C S a C S C a S     −   =       H 2 2 2 2 2 2 2 2 2 0 0 0 1 0 0 0 0 0 1 C S a C S C a S     −   =       H 3 3 3 3 3 3 3 3 3 0 0 0 1 0 0 0 0 0 1 C S a C S C a S     −   =       H Dựa vào (1.2) ta có ma trận Denavit-Hartenberg của khâu thao tác đối với khâu 0 như sau: 1 23 1 23 1 1 3 23 2 2 1 1 23 1 23 1 1 3 23 2 2 1 3 23 23 3 23 2 2 ( ) ( ) 0 0 0 0 1 C C C S S C a C a C a S C S S C S a C a C a S C a S a S − + +     − − + +   =   +     D (1.8) b. Xác định vị trí và hướng của bàn kẹp Vị trí của khâu thao tác (bàn kẹp) được xác định trong hệ tọa độ cố định R 0 được xác định bởi điểm E (điểm tác động cuối) và hướng của khâu thao tác. Theo (1.8) ta có: 1 3 23 2 2 1 1 3 23 2 2 1 3 23 2 2 ( ) ( ) E C a C a C a S a C a C a a S a S + +     = + +     +   x (1.9) Ma trận cosin chỉ hướng (xác định hướng của bàn kẹp) xác định từ ma trận 3 T như sau: 1 23 1 23 1 3 1 23 1 23 1 23 23 0 C C C S S S C S S C S C −     = − −       A (1.10) Xác định hướng của bàn kẹp: Sử dụng phép quay Roll-Pitch-Yaw trong phép quay hệ quy chiếu cố định 0 R sang hệ quy chiếu n R thì ta có ma trận cosin chỉ hướng RPY, như sau: 10 [...]... CHUYỂN ĐỘNG CHO ROBOT Chọn 2 điểm A, B bất kỳ trong không gian làm việc của Robot Thiết kế quỹ đạo chuyển động Robot ( có thể chọn quỹ đạo của đa thức bậc 1, 2, 3) 3.1 Giới thiệu và cơ sở thiết kế quỹ đạo Thiết kế quỹ đạo chuyển động của robot có liên quan mật thiết đến bài toán điều khiển robot di chuyển từ vị trí này đến vị trí khác trong không gian làm việc Đường đi và quỹ đạo được thiết kế là các đại... đạo dạng đa thức bậc 3 để thiết kế 3.2 Tính toán thiết kế quỹ đạo chuyển động 3.2.1 Thiết kế quỹ đạo trong không gian khớp Chọn 2 điểm A, B bất kỳ trong không gian làm việc, biết tọa độ (xE, yE, zE) và hướng của khâu thao tác Thiết kế quỹ đạo chuyển động bất kỳ từ A đến B Theo bài toán động học ngược ta xác định được các biến khớp θ1 ,θ 2 ,θ3 tại A và B Chọn quỹ đạo thiết kế là đa thức hàm bậc 3 theo... điều kiện về toán học…để đưa bài toán về bài toán cấu trúc động học cân bằng, giải bài toán bằng phương pháp ma trận tựa nghịch đảo, trong đó số phương trình nhỏ hơn số ẩn - Khi m > n , robot có số toạ độ suy rộng khớp ít hơn số toạ độ suy rộng khâu thao tác, phương trình (2.1) không giải được Để bài toán có nghiệm, ta cần đưa thêm vào các điều kiện ràng buộc, tuy nhiên đây là bài toán không có nhiều... t (s) 6 7 8 9 10 Hình 1 11 Đồ thị mối quan hệ giữa các tọa độ suy rộng với thời gian 20 CHƯƠNG II GIẢI BÀI TOÁN TĨNH HỌC ROBOT 2.1 Cơ sở lý thuyết Cho trước các thông số: Coi các khâu là thanh đồng chất , tiết diện ngang không đáng kể, khối lượng các khâu là m1, m2, m3 Cho lực tác dụng vào khâu thao tác tại điểm E, 0F = [ Fx, Fy, Fz ]T Chọn một vị trí của robot theo bài toán động học:  Fx   70 ... thiết kế là các đại lượng đặt cho hệ thống điều khiển vị trí của robot Do đó độ chính xác của quỹ đạo sẽ ảnh hưởng đến chất lượng di chuyển của robot Yêu cầu thiết kế quỹ đạo chuyển động của robot là: + Khâu chấp hành phải đảm bảo đi qua lần lượt các điểm trong không gian làm việc hoặc di chuyển theo một quỹ đạo xác định + Quỹ đạo của robot phải là đường liên tục về vị trí trong một khoảng nhất định... của robot) , m là số toạ độ suy rộng của bàn kẹp ( m = 6) Có 3 trường hợp xảy ra : - Khi m = n , robot có cấu trúc động học cân bằng hay cấu trúc chuẩn.Phương trình (2.1) có thể có nghiệm duy nhất phụ thuộc vào cấu trúc của robot - Khi m < n , robot có cấu trúc dư dẫn động Số toạ độ suy rộng khớp qi lớn hơn số tọa độ suy rộng khâu thao tác xj cần xác định Bài toán có nhiều nghiệm, để giải bài toán có... q3,q3dot,q3dotdot 0 -1 -2 -3 -4 -5 0 20 40 60 Thoi gian (s) 80 100 120 Hình 3 3 Đồ thị góc khớp thứ 2 3.2.2 Thiết kế quỹ đạo trong không gian làm việc Để phục vụ cho tín hiệu vào cho bộ điều khiển trong không gian làm việc nên chỉ xét quỹ đạo di chuyển của robot RR giữa hai điểm A(x0,y0,z0), B(xc,yc,zc ) là đường thẳng và đường tròn ( ta thiết kế ở đây đó là đường tròn nhận AB làm đường kính) 29 a Quỹ đạo của điểm... − x0 xc − x0 ; xc − x0 xc − x0 y (t ) = Khi thiết kế x=x(t) và • Cần thiết kế quỹ đạo để Robot đi từ điểm (30, 0, 0) đến điểm (-25, -15, 10) trong 5(s) Dựa vào (3.4) và (3.3) ta tìm được các hệ số như sau: x(t ) = 30 + 0 + -6.6t 2 + 0.88t 3 ; y (t ) = 0.273x(t)-8.0578; z(t)=-0.182x(t)+5.3719 Sử dụng các phương trình vừa tìm được, sử dụng Matlab ta vẽ các đồ thị sau: 250 14 fx fy fz 200 fx d fy d fz... CHƯƠNG IV ĐỘNG LỰC HỌC ROBOT 4.1 Cơ sở lý thuyết Trong tính toán động học robot, để xác định vị trí của các khâu ta chỉ cần sử dụng hệ tọa độ cố định và hệ tọa độ khớp Trong bài toán động lực học robot ta cần thêm một hệ tọa độ nữa là hệ tọa độ khâu Hệ tọa độ khâu là hệ quy chiếu gắn với vật rắn, thường có gốc trùng với khối tâm Ci của vật rắn, các trục hướng theo các trục quán tính chính của vật rắn... Sau khi thiết kế xong, ta vẽ đồ thị của các biến khớp trên miền thời gian như sau: Do thi goc quay, van toc goc , gia toc goc theta 1 Do thi goc quay, van toc goc, gia toc goc theta 2 6 9 q1 q1d q1dd 5 q2 q2d q2dd 8 7 4 6 q2,q2dot,q2dotdot q2,q2dot,q2dotdot 3 2 1 5 4 3 2 0 1 -1 -2 0 0 20 40 60 Thoi gian (s) 80 100 120 -1 0 Hình 3 1 Đồ thị góc khớp thứ 1 20 40 60 Thoi gian (s) 80 100 120 Hình 3 2 Đồ thị . xét về vấn đề Robot chúng ta đặt ra các bài toán: động học Robot, động lực học Robot và điều khiển Robot. Đây là những bước cơ sở ban đầu hết sức quan trọng trước khi thiết kế Robot. Với sự. robot nghiên cứu chuyển động của các khâu của robot về phương diện hình học, không quan tâm đến các lực và momen gây ra chuyển động.Động học robot là bài toán qua trọng phục vụ tính toán và thiết. Denavit-Hartenberg để tính toán động học robot. Giải bài toán động học thuận robot công nghiệp bằng phương pháp ma trận Denavit- Hartenberg Cách xác định các trục cuả hệ tọa độ khớp. Đối với robot công nghiệp