Drone giữ tư thế bằng vòng điều khiển ra sao?

• Phép đo tư thế
• Bộ điều khiển tính điều chỉnh
• Drone phản hồi sau tác động

Bạn sẽ học được gì

• Theo dõi thông tin từ cảm biến tới hiệu chỉnh motor.
• Phân biệt vòng giữ góc với vòng giữ tốc độ góc.
• Hiểu vì sao giới hạn lực và nhiễu làm sai lệch không thể bị xóa tức thì.

Cần biết trước

Không cần chỉnh PID. Chỉ cần hiểu rằng sai lệch là khoảng cách giữa giá trị mong muốn và giá trị đang ước lượng.

Vòng phản hồi bắt đầu từ phép đo nào?

IMU là cụm cảm biến quán tính; gyro bên trong đo tốc độ quay của thân quanh các trục. Bộ ước lượng kết hợp dữ liệu cảm biến để đưa ra tư thế ước lượng, còn gyro cung cấp tốc độ góc cần cho vòng nhanh. “Đo” và “ước lượng” khác nhau: gyro không trực tiếp báo góc tuyệt đối, và mọi tín hiệu đều có nhiễu, độ trễ hoặc lệch cảm biến.

PX4 mô tả kiến trúc đa cánh kiểu tầng: các trạng thái ước lượng làm đầu vào cho bộ điều khiển. Đây là hệ thống số nên nó lấy mẫu, lọc và cập nhật liên tục. Lọc giảm nhiễu cao tần nhưng cũng có thể thêm trễ; nếu bộ điều khiển phản ứng theo ảnh chụp cũ của tư thế, hiệu chỉnh có thể đến muộn.

Vòng góc biến mục tiêu thành tốc độ ra sao?

Khi người điều khiển yêu cầu thân nghiêng một góc, vòng tư thế so góc mục tiêu với góc ước lượng. Sai lệch lớn yêu cầu tốc độ quay lớn hơn để tiến về mục tiêu; sai lệch giảm thì yêu cầu giảm. Trong kiến trúc PX4, bộ điều khiển tư thế tạo setpoint tốc độ góc cho vòng trong. Đây là vòng ngoài vì nó quan tâm hướng của thân chứ không trực tiếp điều khiển tín hiệu motor.

Ví dụ, nếu drone bị nhiễu làm nghiêng sang trái trong khi mục tiêu là thẳng, sai lệch tư thế tạo yêu cầu quay ngược hướng để trở lại. Khi drone gần thẳng, vòng ngoài hạ yêu cầu tốc độ. Nếu chỉ dùng vòng góc, phản ứng của motor có thể trễ trước khi thân đổi hướng; vòng tốc độ bên trong giúp theo dõi yêu cầu động nhanh hơn.

Vòng tốc độ biến sai lệch thành mô-men thế nào?

Vòng tốc độ góc so tốc độ quay mục tiêu với gyro đo được. Sai lệch đi vào bộ điều khiển PID: thành phần tỷ lệ phản ứng theo sai lệch hiện tại, tích phân tích lũy sai lệch kéo dài, và vi phân phản ứng với xu hướng thay đổi. Mỗi thành phần góp phần tạo lệnh mô-men; trong cấu hình PX4, đầu ra điều khiển tiếp tục qua control allocation để thành lệnh actuator cho motor hoặc servo.

Hãy theo một nhiễu nhỏ qua chuỗi: gió làm thân quay lệch; gyro nhận tốc độ; vòng tốc độ thấy giá trị đo khác setpoint; đầu ra mô-men làm allocator đổi lực rotor; thân quay trở lại; phép đo kế tiếp cho thấy sai lệch đã giảm. Đó là phản hồi: đầu ra vật lý quay lại thành đầu vào đo, khép vòng thay vì chỉ phát lệnh một chiều.

PID là cấu trúc điều khiển, không phải lời bảo đảm drone sẽ đứng yên. Độ lợi quá mạnh có thể làm hệ vượt quá mục tiêu hoặc dao động; quá yếu có thể hồi phục chậm. Tích phân có thể tích lũy khi motor đã bão hòa mà vẫn còn sai lệch, hiện tượng gọi là windup; vì vậy hệ thực giới hạn tích phân và đầu ra. Nhiễu, rung và độ trễ cũng khiến phép đo không hoàn hảo.

Các vòng phối hợp khi cần giữ tư thế

Trong sơ đồ PX4, vòng góc tạo tốc độ đặt, vòng tốc độ tạo đầu ra mô-men và lực đẩy, rồi allocator phân phối cho actuator. Lệnh cần thiết có thể vượt khả năng của một motor hoặc cả khung. Khi đó allocator bão hòa hoặc ưu tiên một số trục theo cấu hình; sai lệch còn lại không thể được vòng PID khắc phục chỉ bằng cách tăng lệnh vô hạn.

Tư thế cũng khác vị trí. Chế độ Stabilized giữ phản ứng góc theo cần điều khiển nhưng không tự giữ độ cao hay tọa độ. Nếu thả cần, thân có thể về gần ngang trong khi drone vẫn trôi. Để giữ vị trí, cần lớp ngoài dùng ước lượng vị trí/vận tốc để tạo mục tiêu gia tốc hoặc tư thế; lớp đó mới bổ sung thông tin cần để chống trôi.

Theo dõi cách drone đáp ứng nhiễu trong mô phỏng

Thiết kế minh họa được đề xuất; chưa phải kết quả đã chạy. Trong bộ mô phỏng, đặt mục tiêu tư thế thẳng và đưa nhiễu ngắn làm mô hình nghiêng. Ghi cùng thời điểm tư thế mục tiêu, tư thế ước lượng, tốc độ gyro, setpoint tốc độ, đầu ra mô-men và lệnh actuator. Một vòng hoạt động hợp lý phải cho thấy phép đo nhận nhiễu, sai lệch xuất hiện, lệnh sửa được phát, rồi sai lệch giảm. So sánh hai lượt với độ lợi khác nhau có thể minh họa đánh đổi giữa hồi phục chậm và dao động, nhưng không suy ra cài đặt an toàn cho drone thật.

Nếu biểu đồ góc trông trễ, hãy kiểm tra đồng bộ thời gian và trễ cảm biến trước khi đổ lỗi cho PID. Nếu đầu ra actuator chạm trần, điều khiển có thể không đủ quyền lực để theo mục tiêu. Nếu tín hiệu gyro rung bất thường, lọc, lắp đặt và rung cơ học đều đáng kiểm tra trong simulator hoặc dữ liệu ghi sẵn; bài này không hướng dẫn chỉnh thông số bay.

Hiểu lầm thường gặp

Gyro tự biết drone đang ở góc nào. Gyro đo tốc độ quay; tư thế là trạng thái được ước lượng từ nhiều nguồn. PID càng mạnh càng giữ tốt. Độ lợi cao làm phản ứng gắt hơn nhưng có thể tăng vượt lố và dao động; giới hạn actuator và nhiễu vẫn còn.

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

Vì sao cần cả vòng tư thế lẫn vòng tốc độ?

Vòng ngoài quyết định cần quay nhanh đến đâu để sửa góc; vòng trong bám tốc độ quay đó bằng phép đo gyro và đầu ra mô-men.

Nếu drone đạt góc mục tiêu thì vòng điều khiển dừng?

Không. Vòng vẫn đọc trạng thái và hiệu chỉnh khi có nhiễu, sai lệch hoặc mục tiêu thay đổi.

Tại sao độ trễ làm drone dao động?

Lệnh được tính từ trạng thái cũ có thể tới sau khi drone đã chuyển động thêm, khiến hiệu chỉnh quá mức hoặc sai pha.

Stabilized có giữ vị trí không?

Không nhất thiết. Giữ góc thân không cung cấp vòng vị trí cần thiết để bù gió và vận tốc trôi.

Tóm tắt

IMU và bộ ước lượng cung cấp phản hồi; vòng tư thế đổi sai lệch góc thành tốc độ mong muốn; vòng tốc độ so với gyro và tính mô-men; allocator đổi đầu ra thành lệnh actuator. Nhiễu, trễ, bão hòa và chất lượng ước lượng quyết định vòng kín thực sự bám mục tiêu tốt đến đâu.