Bài giảng Hệ thống cơ điện tử 1: Chương 6 - TS. Dương Quang Khánh
lượt xem 4
download
Bài giảng "Hệ thống cơ điện tử 1" Chương 6 được biên soạn gồm các nội dung chính sau: lập trình quỹ đạo động học; mô tả các đường cong không gian; prôphin của vận tốc quỹ đạo; tạo quỹ đạo tổng quát bằng đa thức nội suy;...Mời các bạn cùng tham khảo!
Bình luận(0) Đăng nhập để gửi bình luận!
Nội dung Text: Bài giảng Hệ thống cơ điện tử 1: Chương 6 - TS. Dương Quang Khánh
- ĐẠI HỌC CÔNG NGHỆ GTVT Chương 6 LẬP TRÌNH QUỸ ĐẠO 1 Giảng viên: TS. Dương Quang Khánh Bộ môn: Cơ điện tử Năm học: 2018-2019
- LẬP TRÌNH QUỸ ĐẠO (TRAJECTORY PLANNING) ➢ Lập trình quỹ đạo là việc xác định các quỹ đạo của hệ thống cơ điện tử theo các tiêu chuẩn xác định. Các tiêu chuẩn được xác định thông qua chức năng của hệ và có thể thể hiện qua các tọa độ của khâu thao tác hoặc qua các tọa độ suy rộng. ➢ Phân loại lập trình quỹ đạo: ▪ Xác định hình học của quỹ đạo phụ thuộc vào một tham số quỹ đạo s (độ dài cung) môt cách liên tiếp, tức là x = x s ( t ) hay q = q s ( t ) ▪ Xác định sự thay đổi theo thời gian của quỹ đạo, tức là chọn vận tốc quỹ đạo s = s ( t ) 2 Hình 6.1: Ví dụ về lập trình quỹ đạo
- LẬP TRÌNH QUỸ ĐẠO (TRAJECTORY PLANNING) ➢ Các dạng chuyển động: ▪ Điểm tới điểm (Point To Point) ▪ Quỹ đạo chuyển động liên tục (Continuous Path) ➢ Các tiêu chuẩn được sử dụng: ▪ Các quỹ đạo tối ưu về độ dài ▪ Các quỹ đạo tối ưu về thời gian ▪ Các quỹ đạo tối ưu về chi phí, về năng lượng ➢ Các điều kiện phụ: ▪ Các phương trình động học x = J (q) q ▪ Các phương trình động lực học ➢ Các giới hạn ràng buộc các đại lượng chuyển động qmin q qmax qmin q qmax qmin q qmax ➢ Các giới hạn ràng buộc các đại lượng phát động Qmin Q Qmax 3
- 6.1 LẬP TRÌNH QUỸ ĐẠO ĐỘNG HỌC ➢ Tọa độ điểm thao tác: x = x s ( t ) hay q = q s ( t ) , s0 s s1 = L dx dq x= s = xs .s, q= s = qs .s ds ds Bảng 6.1: Về lập trình quỹ đạo ( J p 1 là ma trận nghịch − đạo của ma trận Jacobi) 4
- 6.1.1 MÔ TẢ CÁC ĐƯỜNG CONG KHÔNG GIAN ➢ Trong hệ tọa độ quán tính, đường cong không gian được xác định bởi vector định vị r(s) trong đó s là tham số: r = r (s), 0 s L ➢ Các khái niệm ( s p : tham số xác định) ▪ Vector đơn vị tuyến tính: t = r ' ( s p ) ▪ Độ cong: k = r '' ( s ) p ▪ Vector pháp tuyến chính: n = r '' ( s p ) 1 k ▪ Vector trùng pháp tuyến: b = t n s r ( s ) = r ( 0 ) + t ( s )ds 0 5 Hình 6.2: Các khái niệm của đường cong không gian
- 6.1.1 MÔ TẢ CÁC ĐƯỜNG CONG KHÔNG GIAN ➢ Ví dụ 6.1: ▪ Đoạn thẳng giữa hai điểm Pi và Pi +1 ri +1 − ri t = ri +1 − ri s r ( s ) = ri + st = ri + ( ri +1 − ri ) ri +1 − ri ▪ Một đoạn đường tròn trong không gian (bán kính r): (H ) x cos cos ( s r ) s = r : độ dài dây cung r ( s ) = ( H ) y = r sin = r sin ( s r ) (H ) RH R : ma trận quay (H ) z 0 0 ( R ) r ( s ) = ( R ) r0 + R( H ) r ( s ) ( R ) r0: vector định vị điểm giữa cung tròn RH cos ( s r ) s 0, L : xác định một đoạn cung tròn ( R) r ( s ) = ( R ) r0 + RH R( H ) sin ( s r ) 6 0
- 6.1.2 PRÔPHIN CỦA VẬN TỐC QUỸ ĐẠO Hình 6.3: Các profin vận tốc quỹ đạo điển hình ➢ Prôphin vận tốc hình thang đối xứng (Hình 6.3b) t s1 = t s , t s 2 = T − t s ▪ Các điều kiện biên: s ( 0 ) = s0 , s (T ) = s1 s ( 0 ) = 0, s (T ) = 0 + am 0 t ts 7 ▪ Prôphin gia tốc: a = 0 ts t T − ts −a T − ts t T m
- 6.1.2 PRÔPHIN CỦA VẬN TỐC QUỸ ĐẠO 1 s0 + amt 2 0 t ts 2 1 s ( t ) = s0 − amts2 + amtst ts t T − ts 2 1 1 s1 − amT 2 + amTt − amt s2 T − ts t T 2 2 T T 2 s1 − s0 ts = − 2 4 am Prôphin hình thang suy biến thành tam giác khi: T s1 − s0 ts = khi T =2 2 am Hình 6.3: Prôphin vận tốc dạng hình 8 thang đối xứng
- 6.1.3 TẠO QUỸ ĐẠO TỔNG QUÁT BẰNG ĐA THỨC NỘI SUY Hình 6.4: Xấp xỉ q(t) bằng đa thức p(t) ➢ Các q ( s ) và x ( s )có prôphin vận tốc s ( t ) được cho dưới dạng các điểm rời rạc, do đó bài toán lập trình quỹ đạo có thể giải quyết dựa trên xấp xỉ các hàm tại các điểm đã cho. Chia đoạn thời gian [0, T] thành N đoạn nhỏ bằng nhau ➢ Ngoài yêu cầu liên tục của q(t) còn yêu cầu của q ( t ) , q ( t ) 9
- 6.1.3 TẠO QUỸ ĐẠO TỔNG QUÁT BẰNG ĐA THỨC NỘI SUY ➢ Tạo dựng các quỹ đạo liên tục C 0 : quỹ đạo được xấp xỉ bằng các đa thức bậc nhất. ▪ Các điều kiện biên: q ( ti ) = qi q ( ti +1 ) = qi +1 ▪ Dạng xấp xỉ: pi ( t ) = a0i + a1i t ▪ Các hệ số của đa thức bậc nhất: 1 ti a0 = qi 1 ti +1 a1 qi +1 ➢ Tạo dựng quỹ đạo liên tục C 1 : quỹ đạo được đặc trưng bằng các tính chất liên tục của hàm q(t) và đạo hàm q ( t ) ▪ Các điều kiện biên: q ( ti ) = qi q ( ti +1 ) = qi +1 q ( ti ) = qi q ( ti +1 ) = qi +1 ▪ Dạng xấp xỉ: pi ( t ) = a0i + a1i t + a2i t 2 + a3it 3 pi ( t ) = a1i + 2a2it + 3a3it 2 1 ti ti2 ti3 a0 qi ▪ Các hệ số của đa thức bậc 3: 0 1 2ti 3ti2 a1 qi = 1 ti +1 ti2+1 ti3+1 a2 qi +1 10 0 1 3ti2+1 a3 i qi +1 2ti +1
- 6.1.3 TẠO QUỸ ĐẠO TỔNG QUÁT BẰNG ĐA THỨC NỘI SUY ➢ Tạo dựng các quỹ đạo liên tục C 2 (Quỹ đạo không giật) ▪ Các điều kiện biên: q ( ti ) = qi q ( ti +1 ) = qi +1 q ( ti ) = qi q ( ti +1 ) = qi +1 q ( ti ) = qi q ( ti +1 ) = qi +1 ▪ Đa thức tối thiểu: pi ( t ) = a0i + a1it + a2it 2 + a3it 3 + a4it 4 + a5it 5 pi ( t ) = a1i + 2a2it + 3a3it 2 + 4a4it 3 + 5a5it 4 pi ( t ) = 2a2i + 6a3it + 12a4it 2 + 20a5it 3 ▪ Các hệ số của đa thức tối thiểu: 1 ti ti2 ti3 ti4 ti5 a0 qi 0 1 2ti 3ti2 4ti3 5ti4 a1 qi 0 0 1 6ti 12ti2 20ti3 a2 qi 2 2 2 2 = 1 ti +1 ti +1 ti +1 ti +1 ti +1 a3 qi +1 0 1 2t 3ti2+1 4ti3+1 5ti4+1 a4 qi +1 11 i +1 3 0 0 2 1 6ti +1 12ti +1 20ti +1 a5 qi +1
CÓ THỂ BẠN MUỐN DOWNLOAD
-
Bài giảng Hệ Thống Điều Khiển Số P4
13 p | 298 | 91
-
Giáo trình cơ điện tử - Các thành phần cơ bản 4
9 p | 246 | 86
-
Bài giảng môn học Phần điện trong nhà máy điện và trạm biến áp: Chương 6 - Tự dùng trong nhà máy điện và trạm biến áp
10 p | 304 | 69
-
Bài giảng Cấu tạo và sửa chữa thông thường xe ô tô: Bài 4 - Hệ thống điện trên xe ô tô
12 p | 285 | 68
-
Bài giảng Chương 1: Hệ thống cung cấp điện
16 p | 360 | 65
-
Bài giảng Kỹ thuật cao áp: Chương 7 Quá điện áp nội bộ trong hệ thống điện
15 p | 419 | 56
-
Bài giảng Hệ thống điều khiển động cơ - ĐH Công nghệ Đồng Nai
19 p | 221 | 50
-
Bài giảng Hệ thống điện: Lưới điện nhỏ - TS. Trương Việt Anh
14 p | 196 | 46
-
Bài giảng hệ thống cung cấp điện - Trần Tấn Lợi - Chương 10
8 p | 113 | 11
-
Bài giảng Cơ sở tự động học: Chương 5 - Phạm Văn Tấn
20 p | 125 | 9
-
Bài giảng Thiết kế hệ thống cơ điện tử: Chương 4 - Ổn định hệ thống
17 p | 6 | 4
-
Bài giảng Thiết kế hệ thống cơ điện tử: Chương 1 - Tổng quan về hệ thống cơ điện tử
20 p | 26 | 4
-
Bài giảng môn Kỹ thuật điện – Chương 5: Khái niệm chung về máy điện
7 p | 35 | 4
-
Bài giảng Thiết kế hệ thống cơ điện tử: Chương 7 - Cơ cấu chấp hành
18 p | 9 | 4
-
Bài giảng Hệ thống cung cấp điện: Chương 9 - Bạch Quốc Khánh
13 p | 11 | 3
-
Bài giảng Hệ thống cung cấp điện: Chương mở đầu - Bạch Quốc Khánh
12 p | 18 | 2
-
Bài giảng Điều khiển máy điện: Tổng quan về điều khiển máy điện - Nguyễn Ngọc Tú
19 p | 32 | 2
Chịu trách nhiệm nội dung:
Nguyễn Công Hà - Giám đốc Công ty TNHH TÀI LIỆU TRỰC TUYẾN VI NA
LIÊN HỆ
Địa chỉ: P402, 54A Nơ Trang Long, Phường 14, Q.Bình Thạnh, TP.HCM
Hotline: 093 303 0098
Email: support@tailieu.vn