(Lưu ý: độ dài sải chân bằng 2 độ dài bước chân như đã trình bày trong Mục 3.6)
TT Tốc độ
bước (m/s) Số sải chân
(sải) Độ dài sải
chân (m) Thời gian mỗi
sải chân (s) Sai lệch khoảng cách (m) 1 1,15 24 1,27 1,09 0,48 2 1,15 24 1,26 1,09 0,24 3 1,32 24 1,27 0,95 0,48 4 1,28 23 1,33 1,02 0,59 5 1,31 23 1,32 1 0,36 6 1,33 23 1,32 0,98 0,36 7 1,51 20 1,52 0,99 0,4 8 1,51 20 1,52 0,99 0,4 9 1,52 20 1,53 0,99 0,6 10 1,54 20 1,52 0,97 0,4 11 1,54 20 1,52 0,97 0,4 12 1,55 20 1,52 0,97 0,4 13 1,68 20 1,48 0,89 0,4 14 1,69 20 1,48 0,89 0,4 15 1,69 20 1,47 0,89 0,6 TB 1,45 21.4 1.42 0.97 0,43 (1,4%)
Trang 87
3.8 Đánh giá hiệu quả hệ thống đề xuất
Hệ thống đề xuất khắc phục được những hạn chế của các cơng trình nghiên cứu liên quan được trình bày trong phần tổng quan tình hình nghiên cứu. Trong đó:
- Phần cứng đơn giản: Chỉ sử dụng 01 cảm biến khoảng cách để hỗ trợ nâng cao độ chính xác cho hệ thống INS nên hệ thống đề xuất đơn giản hơn các hệ thống trong các cơng trình [44], [45], [46] và [48].
- Thuật toán đơn giản: Chỉ sử dụng thuật tốn của hệ thống INS mà khơng sử dụng xử lý ảnh hay thuật toán làm trơn quỹ đạo như các cơng trình [44], [45], [46] và [48].
- Sai số nhỏ: Thơng qua các thí nghiệm đã chứng minh hệ thống đạt sai số khoảng 1,4% trong trường hợp thí nghiệm đi bộ 30 𝑚 dọc hành lang và 0,74% trong trường hợp thí nghiệm đi bộ 3 𝑚 với hệ thống OptiTrack. Sai số này chỉ lớn hơn sai số của cơng trình [44] nhưng bù lại hệ thống đề xuất tốt hơn cơng trình [44] trong 3 tiêu chí cịn lại.
- Linh hoạt trong sử dụng: Hệ thống đề xuất không cần cài đặt thiết lập môi trường ban đầu, không bị giới hạn phạm vi làm việc như cơng trình [44].
Ngồi ra, hệ thống đề xuất cho phép ước lượng chính xác hơn về quỹ đạo chuyển động 3D, đặc biệt là quỹ đạo theo phương đứng. Điều này cung cấp nhiều thông tin hơn cho ứng dụng phân tích dáng đi do có khả năng truy xuất quỹ đạo chuyển động 3D chính xác.
Hệ thống đề xuất sử dụng cảm biến IMU loại MTi-100 có giá khoảng 2000 $. Tuy nhiên, cảm biến MTi-1 có giá 300 $ cũng đáp ứng được trong hệ thống này. Ngoài ra, cảm biến khoảng cách VL6180 có giá khoảng 10 $. Thuật tốn hệ thống INS có thể được thực hiện trên các vi điều khiển Raspberry có giá khoảng 50 $. Do vậy giá thành chế tạo hệ thống có thể dưới 500 $. Đây là chi phí rất nhỏ so với các hệ thống hiện đại lên đến 200.000 $ như đã giới thiệu ở phần lý do chọn đề tài.
Trang 88
3.9 Kết luận chương
Trong chương này,đã đề xuất một hệ thống INS đặt bàn chân để nâng cao độ chính xác của việc ước lượng thông số bước đi cho người dùng bằng cách sử dụng cảm biến khoảng cách hướng xuống mặt đất trong q trình bước đi. Trong đó, luận án đã giải quyết được các vấn đề sau:
- Ước lượng chính xác được mối quan hệ gồm vị trí và hướng của cảm biến khoảng cách trong hệ toạ độ của IMU bằng các đưa các thông số này vào bộ lọc Kalman để ước lượng.
- Xây dựng được mơ hình bộ lọc Kalman kiểu MEKF cho hệ thống dựa trên mơ hình bộ lọc Kalman cho hệ thống INS cơ bản bằng cách đưa thêm thơng số vị trí và hướng vào đồng thời loại bỏ thành phần nhiễu chậm thay đổi của cảm biến.
- Xây dựng được các phương trình cập nhật ZUPT và các phương trình cập nhật sử dụng dữ liệu từ cảm biến khoảng cách.
- Trích xuất được thông số bước đi từ quỹ đạo chuyển động của cảm biến IMU đặt trên bàn chân dựa vào thời điểm bàn chân chạm đất.
- Đánh giá được hiệu quả hệ thống đề xuất. Trong đó, hệ thống đạt được các tiêu chí đặt ra ở phần nghiên cứu tổng quan là đơn giản về phần cứng và thuật toán, sai số nhỏ và linh hoạt trong sử dụng.
Một số điểm mới của chương như sau:
- Đề xuất hệ thống phần cứng hệ thống INS gồm cảm biến IMU kết hợp với cảm biến khoảng đặt trên bàn chân.
- Đề xuất xây dựng mơ hình bộ lọc cho bộ lọc Kalman cho hệ thống INS đề xuất.
- Đề xuất xây dựng các phương trình cập nhật bộ lọc Kalman cho hệ thống INS sử dụng các thông tin từ cảm biến khoảng cách.
Trang 89
Chương 4. NGHIÊN CỨU XÂY DỰNG HỆ THỐNG ĐỊNH VỊ QUÁN TÍNH ĐẶT TRÊN KHUNG TẬP ĐI
4.1 Giới thiệu chương
Trong chương này, đề xuất hệ thống INS đặt trên khung tập đi loại không bánh hoặc loại có hai bánh trước nhằm ước lượng thơng số bước đi cho người cần hỗ trợ đi lại. Trong đó, một cảm biến IMU được gắn trên khung tập đi và 2 encoder được dùng để giám sát chuyển động của 2 bánh trước. Việc ước lượng chuyển động của khung tập đi sử dụng cảm biến IMU được thực hiện bằng thuật toán hệ thống INS trong Chương 2 và cập nhật ZUPT trong Chương 3. Trong chương này tập trung vào việc sử dụng thông tin từ các encoder để cập nhật nhằm nâng cao độ chính xác. Một số vấn đề cụ thể cần giải quyết như sau:
- Xây dựng thuật toán xác định chính xác mối quan hệ gồm vị trí và hướng giữa cảm biến IMU và khung tập đi.
- Xây dựng thuật toán phát hiện và phân loại chuyển động của khung tập đi trong quá trình sử dụng.
- Xây dựng các phương trình cập nhật cho bộ lọc Kalman sử dụng các tín hiệu từ encoder.
- Trích xuất các thông số bước đi từ quỹ đạo chuyển động của khung tập đi.
- Đánh giá hiệu quả của hệ thống đề xuất.
Nội dung chương này đã được tác giả luận án và cộng sự công bố trong các cơng trình [106], [99], [107]. Trong bài báo [106] được cơng bố trên tạp chí TIM (SCI, Q1) năm 2017, đã đề xuất ý tưởng, giải pháp của việc sử dụng hệ thống khung tập đi có gắn cảm biến IMU và 2 encoder để ước lượng thông số bước đi của người dùng; trong bài báo [99] được cơng bố trong tạp chí Heliyon (Scopus, Q1) năm 2019, đã xây dựng các phương trình cập nhật cho bộ lọc Kalman sử dụng thông tin của các encoder; và trong bài báo [107] được công bố trong tạp chí Heliyon (Scopus, Q1)
Trang 90
năm 2020, đã đề xuất phương pháp hiệu chỉnh nhanh mối quan hệ giữa cảm biến IMU và khung tập đi.
4.2 Đề xuất hệ thống INS đặt trên khung tập đi
4.2.1 Giới thiệu về hệ thống
Hình 4.1 Tổng quan hệ thống khung tập đi đề xuất (nguồn [99])
Hệ thống đề xuất được thể hiện trong Hình 4.1 bao gồm 01 cảm biến IMU và 02 encoder được gắn vào một khung tập đi. Trong đó, cảm biến IMU có thể được gắn tại 1 vị trí bất kỳ trên khung tập đi trong khi mỗi encoder được gắn vào mỗi bánh để đo độ dịch chuyển của mỗi bánh. Một vi điều khiển Arduino Uno R3 được sử dụng để đọc và đồng bộ dữ liệu từ các cảm biến và lưu vào thẻ nhớ Micro SD. Dữ liệu này sẽ được đưa vào thuật toán của hệ thống INS xử lý trên máy tính bằng chương trình Matlab để trích xuất thơng sốbước đi.
Do vị trí đặt cảm biến IMU không đại diện được cho vị trí bàn chân trong q trình bước đi, nên hệ toạ độ BCS tách biệt với hệ toạ độ vật lý của IMU. Lúc này, hệ toạđộ BCS trong hệ thống INS trình bày ở Chương 2được đặt tên mới là ICS trong khi hệ toạ độ BCS được đặt trên khung tập đi.
Như vậy trong hệ thống này, sử dụng hệ trục tọa độ WCS, BCS và ICS như trong Hình 4.2. Gốc tọa độ của hệ BCS là trung điểm của đoạn thẳng nối 2 điểm tiếp
Trang 91
xúc của 2 bánh khung tập đi với mặt đất. Trục 𝑥𝑏 của hệ BCS trùng với hướng thẳng tới trước của khung tập đi. Trục 𝑧𝑏 của BCS hướng thẳng lên trên khi khung tập đi được đẩy đi trên mặt đất. Do các trục 𝑥𝑏,𝑦𝑏 và 𝑧𝑏 tạo thành tam diện thuận nên trục 𝑦𝑏 của BCS nằm trên đường nối 2 điểm tiếp xúc giữa 2 bánh với mặt đất và có phương hướng từ bánh phải sang bánh trái của khung tập đi. Để đơn giản trong tính tốn, hệ WCS được chọn trùng với hệ BCS tại vị trí ban đầu của quá trình chuyển động.
Hình 4.2 Các hệ trục tọa độ sử dụng
Việc xác định mối quan hệ giữa các hệ tọa độ ICS và BCS bao gồm ma trận quay và vectơ tịnh tiến không dễ dàng đo được bằng thước mà cần phải được hiệu chỉnh thơng qua thuật tốn để đem lại giá trị chính xác sẽ được trình bày ở Mục 4.2.3.
4.2.2 Kết nối phần cứng và đồng bộ dữ liệu
Một vi điều khiển Arduino Uno R3 được sử dụng để dọc và đồng bộ dữ liệu của 01 IMU MTi-1 của hãng Xsens và 02 encoder 1024 xung/vòng của hãng LS sau đó lưu vào thẻ nhớ Micro SD. Để tiện cho việc sử dụng, một cơng tắc được bố trí tại vị trí tay cầm để bắt đầu hoặc kết thúc quá trình đọc dữ liệu.
Việc kết nối các thành phần của hệ thống được thể hiện trong Bảng 4.1. Trong đó, việc truyền nhận dữ liệu giữa cảm biến IMU và Arduino được thực hiện qua cổng truyền nhận dữ liệu không đồng bộ (Universal Asynchronous Receiver-Transmitter – UART) với 2 dây Rx, Tx. Các encoder được sử dụng cả dây A và B để xác định
Trang 92
chiều quay của bánh xe. Các chân ngắt ngoài của Arduino được sử dụng trong mục đích này để việc đọc encoder được thực hiện một cách nhanh chóng và kịp thời. Điều này là cần thiết khi tốc độ di chuyển lớn và độ phân giải của encoder cao.