Bộ điều khiển bay làm những việc gì trong mỗi vòng lặp?

• Số đo cảm biến
• Bộ điều khiển bay
• Động cơ nhận điều khiển

Vòng điều khiển đi từ cảm biến tới động cơ

Hãy hình dung drone mô phỏng đang được yêu cầu giữ yên tại một điểm. Bộ điều khiển bay không nhìn thấy “điểm” như con người; phần mềm nhận các bản tin có thời điểm, đơn vị và hệ tọa độ. Chuỗi dưới đây là mô hình giải thích khái niệm, không khẳng định mọi firmware chạy các bước đúng cùng thứ tự hay tần số.

Ví dụ: gió trong mô phỏng đẩy drone lệch khỏi điểm giữ. Cảm biến chuyển động ghi nhận gia tốc; bộ ước lượng cập nhật tốc độ và vị trí. Bộ điều khiển thấy vị trí ước lượng không còn trùng mục tiêu, nên yêu cầu lực và tư thế hiệu chỉnh. Phần phân bổ biến yêu cầu thành mức lệnh tương đối giữa các động cơ. Nếu trạng thái mới cho thấy drone đã gần mục tiêu hơn, vòng kế tiếp giảm hiệu chỉnh; nếu sai lệch tăng hoặc cảm biến mất tin cậy, hệ thống cần giới hạn hay từ chối điều khiển thay vì giả vờ đã giữ đúng điểm.

Vì sao cần ước lượng thay vì dùng một cảm biến?

Con quay hồi chuyển đo tốc độ quay; nó không tự cho biết vị trí trên bản đồ. Gia tốc kế phản ứng với gia tốc và trọng lực, nhưng đọc riêng lẻ không cho trạng thái hoàn chỉnh. Bộ ước lượng (estimator) kết hợp các nguồn đo cùng mô hình chuyển động để tạo một trạng thái thống nhất. Kết quả vẫn là ước tính: trễ, rung, lệch chuẩn hoặc mất định vị có thể làm nó sai.

Trong PX4, flight stack trên bộ điều khiển bay có driver, module truyền thông, bộ điều khiển và estimator. Tài liệu sơ đồ điều khiển PX4 mô tả kiến trúc nhiều tầng: khi chế độ cần giữ vị trí, vòng ngoài tạo yêu cầu chuyển động; vòng thái độ và tốc độ góc giúp thực hiện yêu cầu đó; phân bổ điều khiển ánh xạ lực/mô-men sang các đầu ra. Đây là chi tiết của PX4, không phải sơ đồ bắt buộc cho mọi bộ điều khiển.

Đọc log để lần theo vòng lặp

Trong một bài tập mô phỏng, chọn một đoạn ngắn quanh lúc mục tiêu vị trí thay đổi. Đặt trên cùng trục thời gian: mục tiêu vị trí, vị trí ước lượng, tốc độ ước lượng và đầu ra động cơ. Sai lệch (error) là khoảng cách có hướng giữa mục tiêu và trạng thái ước lượng; không thể kết luận chỉ từ sự kiện đổi chế độ.

Hỏi theo thứ tự: mục tiêu có tới đúng thời điểm không? Trạng thái có cập nhật sau mẫu cảm biến không? Sai lệch có giảm sau lệnh hiệu chỉnh không? Đầu ra có chạm giới hạn hoặc mất dữ liệu không? Log chỉ ghi những tín hiệu được bật và có thể thiếu mẫu; nó cho thấy quan hệ theo thời gian, không tự chứng minh nguyên nhân nếu thiếu tín hiệu đầu vào, trạng thái estimator và cấu hình tương ứng.

Những gì thay đổi giữa các hệ thống

PX4 phân biệt chế độ thủ công, nơi autopilot hỗ trợ ở các mức khác nhau khi người lái điều khiển, với chế độ tự động có thể do autopilot điều khiển hoàn toàn. Tên topic, cảm biến, thuật toán hợp nhất, cấu trúc tầng và nơi đặt bộ phân bổ phụ thuộc firmware, khung và cấu hình. Máy tính đồng hành có thể gửi nhiệm vụ cấp cao, nhưng bộ điều khiển bay vẫn phải xác nhận và chuyển nó qua giao diện điều khiển phù hợp. Vì vậy, sơ đồ ở đây giúp đọc luồng dữ liệu; cấu hình và log của đúng phiên bản mới cho biết tín hiệu thực tế.

Tóm tắt

Mỗi vòng lấy dữ liệu, ước lượng trạng thái, tính sai lệch, tạo hiệu chỉnh, phân phối tới động cơ rồi dùng phản hồi mới để cập nhật quyết định. Muốn hiểu log, hãy theo dõi cả mục tiêu, trạng thái và đầu ra trên cùng mốc thời gian.