IMU, áp kế và GPS giúp drone biết vị trí ra sao?

• IMU đo chuyển động
• Định vị vệ tinh
• Áp kế đo áp suất

Mỗi phép đo trả lời câu hỏi khác nhau

IMU (bộ đo quán tính) thường gồm con quay và gia tốc kế. Con quay cung cấp thay đổi góc quay; gia tốc kế cung cấp thay đổi vận tốc theo các trục của thân. PX4 mô tả dữ liệu IMU ở dạng delta góc và delta vận tốc. Bộ ước lượng tích lũy các thay đổi này để dự đoán hướng và vận tốc trong khoảng ngắn. Vì sai lệch nhỏ tích lũy theo thời gian, dự đoán quán tính không tự giữ vị trí tuyệt đối chính xác lâu dài.

Áp kế đo áp suất khí quyển, rồi phần mềm dùng thay đổi áp suất để ước lượng thay đổi độ cao. Nó không đo trực tiếp khoảng cách tới mặt đất. Áp suất môi trường biến đổi có thể làm mốc độ cao trôi; luồng khí quanh phương tiện cũng có thể ảnh hưởng phép đo. Vì vậy “độ cao áp kế” là một nguồn quan sát cần đối chiếu, không phải giá trị tuyệt đối hoàn hảo.

PX4 hỗ trợ bộ thu GNSS; trong EKF, vị trí toàn cục được biểu diễn bằng vĩ độ, kinh độ và độ cao. GPS/GNSS cung cấp phép đo vị trí, giúp hiệu chỉnh trôi theo thời gian, nhưng phép đo có thể nhiễu, bị che khuất hoặc đến chậm hơn dữ liệu IMU. GPS cũng không thay thế phép đo hướng và chuyển động tức thời của IMU.

Bộ ước lượng ghép các phép đo thế nào?

PX4 dùng bộ lọc EKF để xử lý phép đo và tạo ước lượng trạng thái. Bộ lọc này trước tiên dự đoán trạng thái từ dữ liệu IMU, rồi so sánh dự đoán với quan sát GPS, áp kế và các nguồn độ cao khác đã được bật. Sai khác giữa dự đoán và phép đo gọi là phần dư (innovation). Nếu chênh lệch lớn hơn mức nhất quán đã cấu hình, bộ lọc có thể từ chối phép đo đó thay vì để một giá trị bất thường kéo cả ước lượng đi lệch.

Hãy hình dung một kịch bản: drone đang đứng yên trong mô phỏng. IMU liên tục báo chuyển động góc và gia tốc nhỏ; bộ lọc cập nhật hướng và vận tốc dự đoán. Áp kế cho xu hướng độ cao, còn GPS định kỳ đưa vị trí địa lý. Nếu GPS bất ngờ nhảy sang vị trí xa trong khi IMU không ghi nhận chuyển động tương ứng, phép đo không khớp với dự đoán; bộ ước lượng có thể nhận diện dữ liệu GPS không nhất quán và không dùng nó ngay. Khi GPS ổn định lại, các quan sát mới có thể giúp hiệu chỉnh ước lượng vị trí.

Đây là hợp nhất cảm biến: mỗi phép đo đóng góp thông tin trong giới hạn của nó. “Drone biết vị trí” vì phần mềm ước lượng trạng thái, không phải vì GPS đưa ra một sự thật không sai số. Tài liệu PX4 mô tả EKF xuất các trạng thái như hướng, vận tốc và vị trí, đồng thời theo dõi tính nhất quán giữa các phép đo.

Vì sao cần nhiều nguồn, và khi nào có giới hạn?

IMU cập nhật nhanh nhưng sai số tích lũy; GPS cung cấp định vị toàn cục nhưng có thể gián đoạn hoặc nhiễu; áp kế cho tín hiệu độ cao nhưng chịu ảnh hưởng áp suất. Ghép chúng giúp một nguồn bù một phần điểm yếu của nguồn kia. Tuy nhiên, hợp nhất chỉ hữu ích khi cảm biến được cấu hình đúng, thời điểm đo phù hợp và dữ liệu đủ tin cậy. Nguồn lỗi hoặc thời điểm lệch có thể làm ước lượng kém thay vì tốt hơn.

PX4 cần một tổ hợp phép đo tối thiểu cho từng cấu hình ước lượng; việc có GPS không có nghĩa tất cả chế độ hay môi trường đều được hỗ trợ. Tài liệu cảm biến của PX4 nói GPS hoặc hệ định vị khác cần cho các chế độ tự động nhất định, còn EKF có thể dùng nguồn độ cao như GPS, áp kế, đo xa hoặc vision theo cấu hình. Đây là cấu hình phần mềm cụ thể, không phải quy tắc phổ quát cho mọi bộ điều khiển.

Một lỗi đọc dữ liệu thường gặp

Tình huống giả định để minh họa, chưa phải kết quả thử nghiệm.

Trong log mô phỏng, đường GPS nhảy nhưng đường vận tốc IMU vẫn gần như không đổi. Không nên kết luận drone đã dịch chuyển thật. Hãy xem phần dư/innovation, cờ kiểm tra GPS và trạng thái ước lượng để biết phép đo nào bị nghi ngờ. Nếu cả dữ liệu áp kế và IMU cùng lệch, cần xem thêm rung, hiệu chuẩn và mốc độ cao. Mục tiêu là xác định ranh giới quan sát: cảm biến đo gì, bộ lọc đã chấp nhận gì và ước lượng nào đang được xuất ra.

Câu hỏi thường gặp

GPS có trực tiếp đo độ cao drone không?

Nó có thể cung cấp phép đo độ cao, nhưng PX4 có thể chọn nguồn độ cao khác như áp kế hoặc cảm biến đo xa. Kết quả dùng phụ thuộc cấu hình ước lượng.

Vì sao áp kế không cho độ cao tuyệt đối ổn định?

Áp kế đo áp suất; phần mềm suy ra thay đổi độ cao từ phép đo đó. Thay đổi môi trường và đặc tính cảm biến có thể làm mốc trôi.

Tại sao không chỉ tin cảm biến có vẻ chính xác nhất?

Mỗi nguồn quan sát giới hạn khác nhau. Bộ ước lượng so sánh chúng và có thể loại phép đo không nhất quán thay vì tin mù quáng một nguồn.

Tóm tắt

• IMU dự đoán chuyển động ngắn hạn; áp kế cung cấp xu hướng độ cao; GPS hỗ trợ vị trí.
• Bộ ước lượng ghép dự đoán với phép đo và theo dõi độ nhất quán.
• Vị trí là ước lượng có điều kiện, không phải phép đọc không sai số từ một cảm biến.