.13 Nguyên lý hoạt động của phương pháp Sensor Fusion

Một phần của tài liệu Nghiên cứu giải pháp định vị chính xác cho thiết bị bay tự động không người lái dựa trên phương pháp sensor fusion (Trang 39 - 42)

Trong hệ thống UAV, Sensor Fusion làm tăng số lượng cảm biến thu thập, đa dạng hóa các loại cảm biến và sử dụng các mơ hình tốn học để tổng hợp và tinh chỉnh thông tin do cảm biến thu thập. Vì hợp nhất cảm biến cho phép xác định vị trí, định vị, phát hiện và theo dõi chính xác hơn, nên nó cải thiện nhận thức tình huống của hệ thống tự hành và làm cho các hệ thống nhất quán, chính xác và đáng tin cậy hơn. Nó cũng có thể cho phép chúng tơi kết hợp các cảm biến có tốc độ lấy mẫu khác nhau: thơng thường, cảm biến chính xác với tốc độ lấy mẫu thấp và cảm biến kém chính xác hơn với tốc độ lấy mẫu cao. Dưới đây là một số thuật toán phổ biến đã và đang được phát triển sử dụng cho phương pháp Sensor fusion.

2.3.1 Bộ lọc complementary

Complementary Filter là bộ lọc đơn giản nhất trong số các bộ lọc và thường được sử dụng để truy xuất hướng vì độ phức tạp tính tốn thấp của nó. Con quay hồi chuyển và gia tốc kế đều cung cấp một phép đo có thể giúp chúng ta ước tính hướng. Con quay hồi chuyển đọc phép đo nhiễu của vận tốc góc mà từ đó có thể tính tốn hướng của UAV mới từ trước theo công thức: qt=qt−1∗R2Q(Δtω)

Điều này thường được gọi là Dead Reckoning [64] và dễ xảy ra việc sai số bị tích lũy và kết quả thực tế sẽ bị trôi dạt. Việc giảm sai số cũng sẽ không giải quyết được vấn đề này cho dù là thiết bị đắt đến đâu đi chăng nữa, vì vậy cần một biện pháp khác để có một kết quả chính xác. Ta đã có gia tốc kế cung cấp phép đo định hướng có độ nhiễu cao (rung động, gió, v.v.), nhưng nó khơng bị ảnh hưởng bởi tác động của hiện tượng trơi vì nó khơng dựa vào sự tích tụ dựa trên việc gia tốc kế sẽ đo hướng trường trọng lực. Bản thân ý tưởng của bộ lọc là kết hợp các phép đo "ngắn hạn" chính xác của con quay hồi chuyển có thể bị trơi với các phép đo "dài hạn" của gia tốc kế. Tuy nhiên, một máy bay không người lái đang chịu tác động của gia tốc và rung động liên tục và đáng kể và sẽ có sai số. Vì vậy trong đề tài này thuật tốn Complementary filter sẽ khơng được áp dụng.

2.3.2 Bộ lọc Kalman

Việc phát triển Kalman filter được dựa trên lý thuyết Bayesian. Đây là một phương pháp suy luận thống kê, trong đó định lý Bayes được sử dụng để cập nhật xác suất cho một giả thuyết khi có thêm bằng chứng hoặc thông tin. Trong lý thuyết Bayesian, giá trị trước là phân phối ước tính của trạng thái trước đó tại thời điểm t-1, khả năng tương ứng với khả năng nhận được dữ liệu mới từ cảm biến cho trước và cuối cùng, giá trị sau là phân phối ước tính được cập nhật. Bộ lọc Kalman yêu cầu cả quá trình xây dựng mơ hình và q trình đo đạc dữ liệu đều là phân bố Gaussian tuyến tính [65]. Các phân bố

gaussian tuyến tính có dạng: 𝑥𝑡=f(𝑥𝑡-1)+ 𝑤𝑡. Trong đó f là một hàm tuyến tính và 𝑥𝑡 có dạng phân bố Gaussian.

Bộ lọc Kalman là một ứng dụng trực tiếp của suy luận bayes. Nó kết hợp dự đốn của phân phối với trạng thái ước tính trước và mơ hình chuyển đổi trạng thái và phân phối ước tính dựa trên dữ liệu đến từ các cảm biến. Bởi vì, cả q trình mơ hình và quá trình cảm biến đều được giả định là Gaussian tuyến tính, chúng ta có thể kết hợp chúng thành một phân phối Gaussian. Thật vậy, tích của phân bố hai Gauss tạo thành một phân bố Gauss mới. Bộ lọc Kalman theo dõi các tham số của gaussian đó: trạng thái trung bình và hiệp phương sai của trạng thái thể hiện sự khơng chắc chắn về dự đốn cuối cùng của chúng ta. Giá trị trung bình của phân phối đó cũng là ước tính trạng thái hiện tại tốt nhất của bộ lọc. Bằng cách theo dõi độ khơng đảm bảo, chúng tơi có thể kết hợp các tiêu chuẩn một cách tối ưu bằng cách biết tầm quan trọng của sự khác biệt giữa dữ liệu cảm biến dự kiến và dữ liệu cảm biến thực tế. Yếu tố đó là Kalmain Gain.

Để hiểu việc áp dụng Kalman Filter trong phương pháp Sensor Fusion, ta lấy ví dụ cho việc theo dõi một đối tượng như robot hoặc UAV. Bộ lọc Kalman cơ bản là một quy trình đệ quy bao gồm 3 bước. Đầu tiên, bước đự đoán - Dựa vào kiến thức trước đây về vị trí của đối tượng và phương trình động học, dự đốn vị trí của đối tượng sau thời điểm t + 1 cùng với độ không chắc chắn theo phân bố Gaussian. Tiếp theo là bước đo đạc - nhận kết quả đọc từ cảm biến liên quan đến vị trí của xe và so sánh với kết quả từ bước dự đoán. Bước cuối cùng là cập nhật - cập nhật vị trí(trạng thái) của đối tượng dựa trên dự đoán và các chỉ số cảm biến dựa trọng trọng số Kalman Gain. Kalman Gain là một tham số quyết định bao nhiêu trọng lượng nên được cung cấp cho giá trị dự đốn và giá trị đo. Nó kiểm tra mức độ khơng chắc chắn ở cả giá trị dự đoán và giá trị đo được và sau đó nó quyết định xem giá trị thực cần tìm có gần với giá trị dự đốn hay giá trị đo được hay khơng. Những hình dưới sẽ thể hiện rõ hơn nguyên lý các bước trong Kalman Filter.

Mơ hình đối tượng đang được xem xét

Nhận biết ban đầu của hệ thống tại thời điểm t=0. Phân bố Gaussian màu đỏ đại diện cho niềm tin(sự chắc chắn) ban đầu về vị trí của đối tượng. Mũi tên chỉ sang phải biểu thị vận tốc ban đầu đã biết của đối tượng.

Bước dự đốn, dự đốn của vị trí đối tượng tại t=1 với mức độ không chắc chắn được thể hiện.

Bước đo đạc, phân bố Gaussian màu xanh thể hiện dữ liệu đo vị trí tại thời điểm t=1 với mức độ khơng chắc chắn trong phép đo nhiễu đó

Bước cập nhật, phân bố Gaussian màu xanh là sự kết hợp của kết quả đo và dự đốn vị trí tại thời điểm t=1 cho thấy sự ước lượng tốt nhất về vị trí của đối tượng

Một phần của tài liệu Nghiên cứu giải pháp định vị chính xác cho thiết bị bay tự động không người lái dựa trên phương pháp sensor fusion (Trang 39 - 42)

Tải bản đầy đủ (PDF)

(86 trang)