Giải pháp điều khiển mờ cho hệ vận động của robot hỗ trợ người thiểu năng vận động

pdf 7 trang hapham 1690
Bạn đang xem tài liệu "Giải pháp điều khiển mờ cho hệ vận động của robot hỗ trợ người thiểu năng vận động", để tải tài liệu gốc về máy bạn click vào nút DOWNLOAD ở trên

Tài liệu đính kèm:

  • pdfgiai_phap_dieu_khien_mo_cho_he_van_dong_cua_robot_ho_tro_ngu.pdf

Nội dung text: Giải pháp điều khiển mờ cho hệ vận động của robot hỗ trợ người thiểu năng vận động

  1. Hội nghị toàn quốc lần thứ 7 về Cơ Điện tử - VCM-2014 Giải pháp điều khiển mờ cho hệ vận động của robot hỗ trợ người thiểu năng vận động Fuzzy Logic Control Solution for Motion System of an Assistive Robot for Mobile Disabled People Đào Văn Hiệp Đào Trung Kiên Tăng Quốc Nam HV Kỹ thuật Quân sự Viện MICA, ĐHBK Hà Nội HV Kỹ thuật Quân sự hdaovan@mta.edu.vn trung-kien.dao@mica.edu.vn tangquocnam@mta.edu.vn Tóm tắt 1. Đặt vấn đề Robot hỗ trợ người thiểu năng vận động là một loại Robot hỗ trợ người thiểu năng vận động, sau đây gọi robot sinh học. Vì vậy, phỏng sinh là hướng tiếp cận tắt là robot hỗ trợ (RBHT) là một loại robot - bộ tự nhiên trong thiết kế kết cấu cơ khí và điều khiển xương ngoài (Robot-Exoskeleton), nhưng chúng có loại robot này. Theo đó, hệ điều khiển vận động đã những điểm khác biệt về kết cấu, động lực học và được thiết kế bằng các phương pháp khác nhau, đặc điều khiển. Là robot - exoskeleton, chúng được mang biệt là các phương pháp dựa trên trí tuệ nhân tạo. trên người, hoạt động đồng bộ với cơ thể, như một bộ Bài báo này giới thiệu một trong những nghiên cứu phận mở rộng của cơ thể (Extender) [1][2]. Nhưng ứng dụng trí tuệ nhân tạo (logic mờ) vào điều khiển trong khi Robot-Exoskeleton hỗ trợ người lành đi bộ, hệ vận động của robot sinh học. So sánh đáp ứng của mang nặng, hầu như không chịu trọng lượng của cơ bộ điều khiển mờ với các bộ điều khiển được thiết kế thể, chỉ hỗ trợ một phần năng lượng cho người mang theo phương pháp truyền thống cho thấy bộ điều (Quasi-Passive Exoskeleton) [3] thì RBHT phải chịu khiển mờ có chất lượng tốt hơn, đồng thời thừa hưởng trọng lượng của cả robot lẫn của người mang và hỗ được các ưu thế vốn có của logic mờ. trợ toàn phần năng lượng cho người mang (Fully- Từ khóa: hệ chấp hành tuyến tính, logic mờ, robot hỗ Active Exoskeleton). Về khía cạnh điều khiển, robot trợ, trí tuệ nhân tạo hỗ trợ người lành hoàn toàn phụ thuộc người mang, Abstract: chỉ tác động vào từng thời điểm nhất định trong chu Assistive robot for people with disabilities is one kind kỳ bước, còn RBHT thì chủ động hoàn toàn, tác động of bio-robots. Therefore, bio-mimetic is a natural cả chu kỳ, người mang hoàn toàn bị động. Hơn nữa, approach in mechanical design and control of người TNVĐ thường không ổn định về thần kinh và assistive robots. Following this scheme, many motion thân thể nên robot phải đủ nhạy bén và vững vàng đề control systems have been designed by different chống trọi với những động thái bất định của người. Vì methods, especially artificial intelligence (AI) based vậy, thiết kế cơ khí và điều khiển RBHT là những ones. thách thức lớn. This paper investigates an application study of using Cơ hệ RBHT là một hệ động lực phức tạp, các tín AI (fuzzy logic) in the control of bio-robots. hiệu vào có tính phi tuyến và độ bất định cao (không Comparison of the designed fuzzy controller with ổn định, khó tính toán chính xác, bị nhiễu). Trong other ones designed by traditional methods shows that điều kiện đó, bộ điều khiển mờ thường ồn định và the fuzzy controller is of higher performance, while chống nhiễu tốt hơn so với các bộ điều khiển truyền reveals the advantages of fuzzy logic. thống. Keywords: linear actuator, fuzzy logic, assistive robot, Mong muốn của nhóm nghiên cứu (thuộc Đề tài artificial intelligence. KC.03.12/11-15) là thiết lập được một bộ điều khiển PD mờ đạt được chỉ tiêu chất lượng cơ bản như PID Chữ viết tắt: truyền thống, đồng thời có được những ưu điểm của AC Actuation Controller điều khiển mờ. Một bộ PD mờ (Fuzzy PD - FPD) đã AI Artificial Intelligence được thiết kế, chất lượng của nó được so sánh bộ PD ANFIS Adaptive Neural Fuzzy Inference System có lọc (PD with Filter - PDF), đã được chứng minh là ANN Artificial neural network tốt nhất trong số các bộ PID truyền thống [7]. FPD Fuzzy-Proportional-Derivative controller GPG Gait Pattern Generator 2. Hướng tiếp cận phỏng sinh trong điều MIT Massachusetts Institute of Technology khiển robot sinh học MP Motion Planner 2.1 Sơ lược về hệ thần kinh vận động của người PD Proportional-Derivative controller Đi bộ là một dạng vận động có tính tự động, theo chu PDF Proportional-Derivative with Filter controller kỳ của cơ thể, chủ yếu do chi dưới thực hiện dưới sự PID Proportional-Integral-Derivative controller điều khiển của hệ thần kinh vận động. Đó là một hệ TC Tracking Controller điều khiển phân cấp (xem H. 1). Cấp cao nhất là vùng TNVĐ Thiểu năng vận động vận động ở vỏ não, có chức năng hoạch định và kiểm RBHT Robot hỗ trợ soát chung quá trình vận động, như đích đến, hướng VCM-2014
  2. Hội nghị toàn quốc lần thứ 7 về Cơ Điện tử - VCM-2014 vận động, xử lý tình huống phát sinh, Các cấp dưới, trung nói về TC. Hệ chấp hành giữ vai trò như của cơ, trong đó tiểu não và tủy sống giữ vai trò chủ chốt, làm chuyển động các khớp. điều khiển trực tiếp quá trình. Tủy sống điều khiển f các hoạt động phản xạ, phát tín hiệu điều khiển đến Hoạch định Người các cơ, nhận các tín hiệu phản hồi trực tiếp từ các cơ vận động mang và các giác quan. Tiểu não không trực tiếp sinh ra vận Y(,,f) động, nhưng có nhiệm vụ tiếp nhận và tổng hợp các Tạo quỹ ref ĐK bám u Chấp , Khung tín hiệu từ các sensor vị trí, gia tốc, hướng, để định đạo mẫu quỹ đạo hành robot hướng, định vị cơ thể và hiệu chỉnh vận động cho , chính xác và mềm mại, ổn định tư thế, cũng như H. 2 Cấu trúc của hệ điều khiển vận động (cùng các bộ phận khác, như hạch cơ sở, nội đồi) tạo lập và hoàn thiện các chương trình vận động nhờ quá Hệ chấp hành của robot là các động cơ, tạo ra dịch trình học (Motor Learning). chuyển góc  hay mô-men  tại các khớp. Vì khớp ở Các cơ chân là phần tử chấp hành, tạo ra chuyển động chân robot và ở chân người đồng trục với nhau nên cơ học theo lệnh từ tủy sống. Trong cơ và gân có các chuyển động của robot được truyền trực tiếp sang sensor vị trí (Muscle Spindle) và sensor lực (Golgi người. Hệ chấp hành thường dùng là điện - cơ, thủy Tendon Organ), sinh tín hiệu phản hồi về vận động. lực hoặc khí nén. Bài báo này chỉ đề cập đến hệ chấp hành điện - cơ. Muốn bàn chân bám sát quỹ đạo mẫu thì mỗi khớp chân phải bám theo góc khớp ref và vận tốc góc khớp  tương ứng (xem H. 3). d (t) ref + e Bộ điều u Thiết bị , Khớp robot khiển bám chấp hành - H. 3 Cấu trúc của hệ điều khiển khớp Trên thực tế, đầu vào cho mỗi khớp thường chỉ dùng góc khớp ref, còn vận tốc được tính theo quan hệ   . Do đó, tín hiệu đo và phản hồi là góc khớp thực (t). 3. Điều kiện ban đầu cho thiết kế 3.1 Chuẩn bị dữ liệu đầu vào Dữ liệu đầu vào cho RBHT là góc khớp, thường được đo, ghi bằng thực nghiệm trên người khỏe, hiệu chỉnh cho phù hợp với tình trạng của người TNVĐ cụ thể. Một số bộ dữ liệu được sử dụng rộng rãi, như của H. 1 Điều khiển hệ vận động ở người Antonie Bogert (2003), Harman (2000) [2], Winter 2.2 Cấu trúc hệ điều khiển vận động của robot (Canada) [4]. Trên H. 4 là đồ thị góc khớp, đã được sử Cấu trúc hệ điều khiển của robot được thiết kế theo dụng tại MIT [2]. nguyên tắc phỏng sinh, bắt chước hệ điều khiển vận động của người, nhưng thực thi các nhiệm vụ đơn giản hơn, gồm 3 cấp: 1- bộ hoạch định vận động (Motion Planner - MP), 2- bộ tạo quỹ đạo mẫu (Gait Pattern Generator - GPG), và 3- bộ điều khiển hệ chấp hành bám quỹ đạo (Tracking Controller - TC) như trong H. 2. MP nhận biết ý định của người mang: đứng lên, ngồi xuống, đi hay dừng, CPG có nhiệm vụ chọn chương trình đi tương ứng theo ý định, tạo dữ liệu về quỹ đạo cho TC. TC có mặt ở từng khớp, điều khiển góc khớp bám theo góc mẫu do CPG tạo ra. Như vậy, phối hợp chuyển động các khớp để tạo ra bước đi theo ý muốn là nhiệm vụ của MP và CPG. TC đảm bảo điều kiện cần để có bước đi mong muốn. TC là tên gọi theo phương thức điều khiển (bám). Nó còn tên nữa, gọi theo chức năng, là bộ điều khiển hệ chấp H. 4 Đồ thị góc khớp khi đi bộ hành (Actuation Controller - AC). Bài báo này tập VCM-2014
  3. Hội nghị toàn quốc lần thứ 7 về Cơ Điện tử - VCM-2014 Với mục đích sử dụng làm tín hiệu vào ref cho bộ đảm bảo khả năng làm việc và an toàn, hệ thống được điều khiển sau khi thiết kế, dữ liệu góc khớp được thiết kế cho một khớp ảo, tập hợp các điều kiện làm chuyển thành giá trị số rời rạc như H. 5. việc khắt khe nhất trong 3 khớp: dải làm việc rộng nhất, vận tốc góc cao nhất, mô men lớn nhất, khối Do thi goc khop lượng tải trọng lớn nhất. Tuy nhiên, tính toán cho 60 thấy, tỷ số truyền của hệ chấp hành quá nhỏ (1:1880) 40 nên ngay cả khối lượng lớn nhất như của đùi (~10kg) 20 cũng chỉ gây ra mô men quán tính chuyển động quay 0 quy đổi về trục động cơ bằng 0,15% mô men quán tính của chính hệ chấp hành, có thể bỏ qua. Vì vậy mô -20 Goc khop khop (do) Goc men quán tính của tất cả các khớp được tính như nhau -40 và bằng mô men quán tính J của hệ chấp hành. -60 Trên cơ sở số liệu kỹ thuật do nhà sản xuất cung cấp, kết hợp tính toán điều kiện công tác như ở trên, bộ -80 0 5 10 15 20 25 30 35 40 45 50 55 60 65 70 75 80 85 90 95 0 thông số kỹ thuật của hệ chấp hành được tổng hợp K. hong 48 46 42 37 30 22 14 6 0 -6 -7 -3 2 7 15 25 35 42 46 47 48 K. goi 0 -7 -6 0 4 6 9 10 11 12 9 -1 -8 -12 -11 -4 -1 -2 -3 -3 0 trong B.1. Đó là cơ sở để xây dựng mô hình động lực K. co chan -12 -20 -27 -27 -24 -20 -12 -7 -4 -4 -7 -20 -37 -55 -64 -63 -58 -47 -35 -20 -12 học của đối tượng điều khiển. H. 5 Giá trị góc khớp được chuyển từ H. 3 B.1 Thông số kỹ thuật của hệ chấp hành 3.2 Chọn thiết bị chấp hành Thông số Giá trị Kết cấu cơ khí ở mỗi chân của RBHT có sơ đồ như H. Mô men quán tính J (kgm2) 0,022 6, trong đó mỗi chân có ba khớp chủ động. Hai loại Hệ số giảm chấn C (Nm/(rad/s)) 0,5.10-3 động cơ chấp hành đã được khảo sát, gồm xi lanh Hệ số mô men KT (Nm/A) 0,06 thủy lực (không trình bày ở đây) và động cơ điện 1 Hệ số điện động K (Vs/rad) 1,0 chiều. Để robot có kết cấu gọn nhẹ, chúng tôi đã chọn e Điện trở phần ứng R (Ω) 2,45 hệ chấp hành điện - cơ chuyển động thẳng, có tên Điện cảm L (H) 0,035 thương mại là Linear Actuator [5] như trong H. 7. 4. Thiết kế bộ điều khiển 4.1 Mô hình toán học của hệ thống Sau khi tính toán động lực học và quy đổi các thông số hệ thống về động cơ, mô hình hệ chấp hành có dạng như của động cơ điện một chiều, điều khiển bằng dòng điện phần ứng, được thể hiện bằng hệ phương trình cân bằng điện áp và cân bằng mô men: Li Ri K v a a e (1)   J C  KT i a T d trong đó, v - điện áp; Td - mô men tải; các đại lượng còn lại như trong B.1. Hệ có hai tín hiệu vào, hai tín hiệu ra nhưng với bài toán điều khiển bám vị trí, chỉ cần quan tâm đến hàm truyền ()/()s V s : ()s K H. 6 Sơ đồ kết cấu của một chân robot T (2) 2 V() s (Ls R )( Js cs ) KT K e s k=20:1 Mô hình hệ chấp hành có điều khiển trong H. 3 được cụ thể hóa trong H. 8, trong đó BĐK là bộ điều khiển 12V cần thiết kế. 45W Td - + E V + Ia Tm -  BĐK K 1/(Ls+R) K 1/(Js+c) 1/s  T + r Ve -  l=3mm 260+150 Ke Motor H. 8 Sơ đồ hệ chấp hành có điều khiển v=24mm/s 4.2 Thiết kế bộ điều khiển mờ H. 7 Hệ chấp hành chuyển động thẳng Cơ sở lý thuyết của điều khiển mờ là logic mờ, một Tính toán động lực học toàn hệ thống cho thấy mô nhánh của trí tuệ nhân tạo. Khác với mạng nơ ron men và công suất yêu cầu của các khớp không khác nhân tạo, bắt chước cấu trúc và quá trình vật lý của hệ nhau nhiều. Điều đó cho phép đơn giản hóa thiết kế, thần kinh, giải thuật gen [6] bắt chước quá trình tiến chế tạo và sử dụng thiết bị nhờ trang bị cùng một thiết hóa của sinh vật trong tự nhiên, logic mờ bắt chước bị chấp hành và bộ điều khiển cho tất cả các khớp. Để cách tư duy, phân tích, ra quyết định của con người. VCM-2014
  4. Hội nghị toàn quốc lần thứ 7 về Cơ Điện tử - VCM-2014 Về kỹ thuật tính toán, logic mờ là một nhánh của Bước 1: Thiết lập cấu trúc của hệ thống. Để dễ so phương pháp tính toán mềm. sánh và đánh giá hiệu quả của giải pháp mờ so với So với điều khiển truyền thống, các hệ mờ có những giải pháp truyền thống, hệ điều khiển mờ được thiết ưu điểm sau: kế với cấu trúc tương tự bộ điều khiển PD truyền - Dễ thiết kế, không đòi hỏi công cụ toán học trừu thống, các hệ số KP, KD sẽ được xác định khi thiết kế. tượng, tránh được một trong những nhiệm vụ khó Hệ được thiết kế trong Simulink, có sơ đồ như trong khăn nhất là thiết lập và giải các hệ phương trình vi H. 9. Các phần tử chính trong hệ thống, gồm: phân phức tạp. Có nhiều trường hợp, thậm chí không - Đối tượng điều khiển là hệ chấp hành điện - cơ, có cần để ý đến bản chất vật lý của các đại lượng; hàm truyền (2), dạng số như trong hình vẽ; - Công cụ thiết kế, phân tích hệ mờ rất vạn năng, linh - Bộ điều khiển PD mờ (FPD), điều khiển theo sai hoạt, dễ sử dụng. Ngôn ngữ diễn tả thuật toán mờ gần lệch góc khớp e và tốc độ biến thiên của e, được tạo với ngôn ngữ tự nhiên nên dễ hiểu; nhờ khâu vi phân du/ dt . - Do không đòi hỏi thông tin vào thật chính xác, cho - Các phần tử hiển thị, chuyển đổi tín hiệu để kiểm tra phép tín hiệu vào thay đổi trong phạm vi rộng, làm đáp ứng của hệ thống. việc dựa trên cơ chế suy luận linh hoạt, nên trong Tín hiệu vào cơ bản cho FPD là góc khớp cổ chân, nhiều trường hợp các hệ điều khiển mờ có tính bền như H. 5, tín hiệu ra là điện áp, giá trị có thể thay đổi vững, tin cậy, ổn định cao. được nhờ hệ số K1. Đáp ứng của toàn hệ thống là góc Phần sau đây trình bày các bước cơ bản và kết quả khớp thực (t) và vận tốc góc (t). thiết kế bộ điều khiển mờ cho hệ chấp hành điện cơ Nhờ một chuyển mạch bằng tay, có thể mô phỏng hệ trong H. 7. thống với tín hiệu vào Step hoặc góc khớp mẫu ref. du/dt y 1/K2 Signal 1 Van toc goc (rad/s)Derivative1 To Workspace Step Do-radian Goc co chan Manual K2 Switch Kp Goc khop co chan Rad-do Error 0.06 K1 0.00077s 3 +0.5392s 2 +0.6122s Transfer Fcn du/dt Kd FLC Derivative H. 9 Sơ đồ cấu trúc của bộ FPD Bước 2: Thiết kế hệ logic mờ, gồm thiết lập các modul mờ hóa, suy luận mờ và giải mờ. Hệ logic mờ ở đây sử dụng hệ suy luận Sugeno, có hai hàm thuộc đầu vào (Error e và Error-dot e ) kiểu hình thang (trapmf) và một hàm thuộc đầu ra (điện áp bù) kiểu tuyến tính output a e b e c (3) trong đó a, b, c là các hằng số. Các hệ số a, b, c được chọn tùy theo mức độ nhạy cảm cần có của hệ với sai số e, tốc độ biến thiên của e và độ mờ. Phương án Công cụ Rule Wiewer (H. 10) cho phép quan sát tổng được chọn là a = 0,5; b = 1. Giá trị c = (-2, -1, 0, 1, 2) hợp các hàm thuộc, quy tắc suy luận mờ, hợp thành tương ứng các giá trị hàm thuộc đầu ra (AL, A, K, D, và giải mờ, và kiểm tra quan hệ vào-ra. Ví dụ cho DL), trong đó A - âm , D - dương, L - lớn, K - không. input = [8,5] (nghĩa là e 8; e 5), sẽ nhận được Hệ quy tắc suy luận mờ được tóm tắt trong B.2. điện áp 6,7V. B.2 Bảng quy tắc suy luận mờ Bước 3: Xác định các thông số điều khiển. Các thông E-dot A K D số cần xác định là hệ số tỷ lệ KP, vi phân KD, khuyếch E đại K1 (xem H. 9). Các thông số này chi phối chất A DL D K lượng điều khiển: lượng quá chỉnh, thời gian xác lập K D K A và độ chính xác tĩnh. Tín hiệu vào thích hợp cho bước D K A AL này là hàm bậc thang đơn vị. Sử dụng luật hợp thành max-min, quy tắc suy luận mờ Bật chuyển mạch sang vị trí Step. Trước hết, điều được thể hiện bởi tập hợp các mệnh đề logic sau: chỉnh KP, KD theo quy tắc vẫn áp dụng cho các hệ PID truyền thống để hệ ổn định và đạt các đáp ứng đầu ra tốt nhất có thể. Sau đó, điều chỉnh K1 để nhận được dải điện áp phù hợp. Cuối cùng, bộ thông số được VCM-2014
  5. Hội nghị toàn quốc lần thứ 7 về Cơ Điện tử - VCM-2014 chọn là KD = 0,27, KP = 2,5, K1 = 200. Đáp ứng Step KC03_FLC/Goc co chan : Group 1 của hệ như trong H. 11: lượng quá chỉnh 2,6%, thời 0 Signal 1 gian xác lập khoảng 1,76s, sai số tĩnh bằng 0. Số liệu -10 này được lấy từ biến y do Simulink xuất sang -20 workspace (H. 9). -30 -40 -50 -60 -70 0 1 2 3 4 5 6 7 8 9 10 Time (sec) H. 12 Tín hiệu vào góc khớp cổ chân Bật chuyển mạch sang tín hiệu thực (Goc co chan), chạy chương trình, nhận được đáp ứng đầu ra (vẽ cùng tín hiệu vào) như H. 13. Ta thấy, tín hiệu ra bám sát tín hiệu vào, sai số lớn nhất khoảng 0,05. Bước 5: Kết quả mô phỏng cho thấy bộ FPD làm việc ổn định và có chất lượng tốt. Tuy nhiên, hiệu quả của giải pháp mờ sẽ thể hiện trực quan hơn khi so sánh trực tiếp đáp ứng của nó với PDF. H. 10 Quan sát hệ suy luận mờ Một mô hình mới được thiết lập bằng cách ghép thêm một bộ PDF (nền xanh), dùng chung tín hiệu vào với Dap ung Step FPD (xem H. 14). 1.4 Như đã nói trong mục đặt vấn đề, trong một nghiên cứu khác [7], chúng tôi đã so sánh các bộ PID truyền 1.2 X: 1.566 X: 1.759 Y: 1.026 Y: 1.02 thống khi làm việc với cùng một hệ chấp hành trong 1 H. 9 và nhận thấy bộ PDF, dạng N 0.8 KK (4) PD 1 N / s 0.6 có chất lượng tốt nhất. Trong đó N - hằng số của bộ Amplitude lọc, được xác định cùng với KP, KD. 0.4 Dap ung goc khop co chan 10 Output 0.2 0 Input -10 0 0 0.5 1 1.5 2 2.5 3 -20 Time, s -30 H. 11 Đáp ứng Step của bộ FPD Goc khop (do) khop Goc -40 Bước 4: Thử nghiệm với tín hiệu vào mẫu ref, được -50 lấy từ đồ thị góc khớp cổ chân trong H. 5, đưa vào -60 Simulink dưới dạng đồ thị như H. 12. -70 0 2 4 6 8 10 Time, s H. 13 Đáp ứng góc khớp cổ chân của FPD 1/K2 Signal 1 Step Do-radian Goc co chan Manual Switch 0.06 In1 Out1 0.00077s 3 +0.5392s 2 +0.6122s Comparison PD-Fuzzy Controller Transfer Fcn K2 0.06 PD(s) K2 0.00077s 3 +0.5392s 2 +0.6122s PD Controller Transfer Fcn1 PDF y To Workspace H. 14 Mô hình để so sánh FPD với PDF VCM-2014
  6. Hội nghị toàn quốc lần thứ 7 về Cơ Điện tử - VCM-2014 H. 15 Các thông số của bộ PDF Công cụ Tuner của Matlab cho phép hiệu chỉnh các thông số Bandwidth (bề rộng dải thông), Phase Dap ung goc co chan 10 margin (dự trữ ổn định pha), Response time (thời gian PD mo 0 PDF đáp ứng) và Peak response (giá trị max) trong chế độ Input tương tác. Khi hiệu chỉnh tự động, Matlab sẽ dung -10 hòa các tiêu chí trên và chọn các thông số chất lượng -20 là: quá chỉnh 9,56%, thời gian quá độ 1,98s. -30 Tổng hợp các thông số của hai bộ điều khiển trong -40 B.3 cho thấy bộ FPD có chất lượng tốt hơn bộ PDF. (do) khop Goc Điều này cũng được thể hiện trên H. 16. -50 -60 B.3 So sánh hai phương án thiết kế -70 Thông số PDF FPD 0 2 4 6 8 10 Hệ số Kp 30,157 2,5 Time, s Kd 16,122 0,27 H. 17 Đáp ứng của PD mờ và của PD truyền thống N 4,828 - Kết quả trên nhận được với tín hiệu vào của khớp cổ Lượng quá chỉnh (%) 9,56 2,6 chân. Mô hình hệ điều khiển đồng thời khớp hông và Thời gian ổn định (s) 1,98 1,76 khớp gối được lập như trong H. 18. Hệ gồm hai bộ Sai số xác lập 0 0 điều khiển mờ giống nhau, mỗi bộ có tín hiệu vào riêng, được trích từ H. 5. Đồ thị đáp ứng của chúng Dap ung Step 1.4 được vẽ trên cùng hệ tọa độ trên H. 19. X: 1.504 Ta thấy, đồ thị đáp ứng của khớp cổ chân (xem H. 17) 1.2 Y: 1.096 và của khớp hông (H. 19) có sai số ban đầu, còn khớp 1 gối không có. Lý do là góc ban đầu của khớp hông và X: 1.572 Y: 1.026 khớp cổ chân khác 0, trong khi cơ cấu chấp hành xuất 0.8 phát từ vị trí 0. Sai số này có thể được khử dễ dàng 0.6 bằng cách gán điều kiện đầu thích hợp cho chúng, Amplitude hoặc set điểm 0 thích hợp cho phần cứng. 0.4 PD mo Goc khop hong Do-rad Bo DK khop hong 0.2 PDF du/dt Input Signal 1 1/K2 In1 Out1 Van toc goc 0 0 0.5 1 1.5 2 2.5 3 Time, s K2 Goc khop Rad-do H. 16 Đáp ứng step của PD mờ và PD truyền thống Signal 1 1/K2 In1 Out1 Hong, Goi Goc khop goi Để mô phỏng với đầu vào là góc khớp thực, bật Do-rad1 Bo DK khop goi chuyển mạch sang bên phải (H. 14). Đáp ứng của 2 hệ được vẽ trên cùng đồ thị như H. 17. Ta thấy, đáp ứng H. 18 Mô hình PD mờ điều khiển khớp hông và khớp gối của FPD bám sát dữ liệu vào hơn của bộ PDF. VCM-2014
  7. Hội nghị toàn quốc lần thứ 7 về Cơ Điện tử - VCM-2014 Dap ung goc khop hong va khop goi [4] D. A. Winter: Biomechanics and Motor Control 50 of Human Movement, 5th Edition. John Wiley & 40 Sons, New York, 2009. [5] HIWIN: Linear Actuator LAS Series (2014). 30 [6] R. L. Haupt, S. E. Haupt: Practical Genetic 20 Algorithm, 2nd ed., Wiley-Interscience, 2004. Hong-ra Hong-vao [7] Đào Văn Hiệp, Đào Trung Kiên: Tối ưu hóa bộ 10 Goi-ra Goc khop (do) khop Goc điều khiển bám quỹ đạo khớp của robot hỗ trợ Goi-vao 0 người thiểu năng vận động, Chuyên san Điều khiển & Tự động hóa, số 10 (08-2014). -10 -20 GS. TS. Đào Văn Hiệp tốt 0 1 2 3 4 5 6 7 8 9 10 Time, s nghiệp Học viện Kỹ thuật quân H. 19 Đáp ứng của hệ FPD ở khớp hông và khớp gối sự, chuyên ngành Cơ khí - Chế tạo máy vào năm 1977; nhận 5. Kết luận bằng tiến sĩ Cơ khí năm 1989 tại So sánh đáp ứng của hệ điều khiển bám cho các khớp Học viện Quân sự (VAAZ) - của robot dùng FPD và PDF được thiết kế theo Cộng hòa Czech; được Nhà nước phương pháp truyền thống cho thấy FPD có chất bổ nhiệm Phó giáo sư năm 2005, lượng tốt hơn. Nhưng sẽ là sai nếu nói rằng "điều Giáo sư năm 2011 ngành Cơ khí- khiển mờ tốt hơn điều khiển truyền thống". Mong Động lực. Hiện nay, ông là giảng viên tại Khoa Hàng muốn của chúng tôi là bộ điều khiển mờ có được các không - Vũ trụ, Học viện Kỹ thuật quân sự. Các lĩnh chỉ tiêu chất lượng tương đương PID truyền thống vực hoạt động chính: Công nghệ chế tạo thiết bị hàng ngay cả với hệ phi tuyến và dữ liệu vào không thể không, CAD/CAM/CNC, Kỹ thuật Robot, Cơ điện tử được biểu diễn tường minh bằng toán học, hay nhập trong các hệ thống sản xuất tự động. nhằng, có biên giới mờ như ở người khuyết tật, và đã đạt được. Tính ổn định, bền vững của điều khiển mờ TS. Đào Trung Kiên tốt nghiệp trong điều kiện nói trên không cần phải chứng minh, ngành Công nghệ thông tin của vì nó nằm trong bản chất của điều khiển mờ. Với các Trường Đại học Cergy-Pontoise, hệ tuyến tính, có mô hình toán học tường minh thì Pháp vào năm 2004. Anh nhận giải pháp truyền thống vẫn là lựa chọn hợp lý, nhất là bằng thạc sĩ về Hệ thống phân tán khi được hỗ trợ bởi các phương pháp thiết kế tiên tiến. của Trường Đại học Paris 6 Nói rộng ra, kết quả khả quan trong nghiên cứu ứng (UPMC), Pháp năm 2006, và bằng dụng logic mờ và giải thuật gen [7] vào điều khiển tiến sĩ về Cơ khí và Tự động hoá, RBHT cho phép khẳng định tính khả thi của hướng Trường Đại học Dayeh, Đài Loan năm 2010. Hiện tiếp cận phỏng sinh. Nhưng còn một điều chúng tôi anh là giảng viên, nghiên cứu viên của Phòng nghiên tâm đắc nhưng chưa kịp thực hiện, là tạo khả năng cứu Môi trường Cảm thụ và Tương tác, thuộc Viện học cho bộ tạo quỹ đạo mẫu (Gait pattern generator - nghiên cứu quốc tế MICA, Đại học Bách khoa Hà GPG) tương tự não người. Về lý thuyết thì có thể thực Nội. Các hướng nghiên cứu chính bao gồm định vị ở hiện được bằng cách thay bộ điều khiển mờ bằng hệ môi trường trong nhà, tương tác người-hệ thống đa ANFIS (Adaptive Neural Fuzzy Inference System), phương thức, động lực học và điều khiển. hoặc đơn giản là gắn thêm modul ANN để xác định các hệ số KP, KD cho bộ điều khiển mờ. Vấn đề nằm ở TS. Tăng Quốc Nam, tốt nghiệp chỗ, tạo dữ liệu huấn luyện cho ANN hay ANFIS thế đại học ngành Cơ khí động lực nào? Chúng tôi rất mong và chân thành cảm ơn những năm 1995 tại Học viện Kỹ thuật chia sẻ của các bạn đọc. Quân sự, nhận bằng thạc sĩ về Cơ Công trình này được thực hiện trong khuôn khổ đề tài điện tử tại Viện Công nghệ châu cấp Nhà nước, mã số KC.03.12/11-15. Á (AIT) - Thái Lan năm 2002 và Tài liệu tham khảo bằng tiến sĩ về Cơ học kỹ thuật tại Học viện Kỹ thuật Quân sự [1] José L. Pons: Wearable Robots: Biomechatronic năm 2011. Từ năm 1995 đến nay, Exoskeletons; John Wiley & Sons, 2008. anh là giảng viên tại bộ môn [2] Kazerooni, H. and R. Steger: The Berkeley Robot đặc biệt và Cơ điện tử, khoa Hàng không Vũ Lower Extremity Exoskeleton, Journal of trụ, Học viện Kỹ thuật Quân sự. Các hướng nghiên Dynamic Systems Measurement and Control- cứu chính bao gồm Cơ điện tử trong khí tài quân sự, Transactions of the Asme, 2006. Động lực học và điều khiển robot di động, Định vị và [3] Andrew Valiente: Design of a Quasi-Passive xây dựng bản đồ ở môi trường trong nhà, Robot đặc Parallel Leg Exoskeleton to Augment Load biệt trong quân sự và thám hiểm, Mô hình hóa và mô Carrying for Walking; Master’s of Science at phỏng các hệ động lực. the MIT; August 2005. VCM-2014