Dalam sistem kontrol modern, stabilitas adalah batu penjuru operasi yang aman dan dapat diprediksi. Tidak ada tempat yang lebih terlihat dari ini di drone quadrotor, di mana ketidakstabilan dapat menyebabkan kegagalan bencana dalam hitungan detik. Studi kasus ini menunjukkan penerapan praktis dari Routh-Hurwitz kriteria[] untuk menganalisis dan menstabilkan sistem kontrol dari drone quadrotor. Dengan membangun array Routh dari polinomial karakteristik sistem tertutup-loop, insinyur dapat menentukan stabilitas tanpa pemecahan untuk akar secara langsung, memungkinkan tuning parameter cepat dan kinerja penerbangan yang kuat.

Dinamika dan Arsitektur Pengendalian dan Dinamika Kuarsor

Sebuah quadrotor adalah sistem nonlinear yang tidak tertandingi, sangat berpasangan. Geraknya dikendalikan dengan bervariasi kecepatan empat rotor, yang menghasilkan daya dorong dan torsi. Untuk analisis stabilitas, sistem biasanya dialerisasi secara linier di sekitar kondisi hover, menghasilkan satu set persamaan diferensial urutan kedua yang bervariasi untuk roll, pitch, yaw, dan altitude. Sistem kontrol umumnya mempekerjakan Proportional-Integral-Divivatif (PID) kontrolir untuk setiap sumbu, dengan loop umpan balik tertutup sekitar sikap dan tingkat pengukuran yang bersudut dari unit pengukuran aerial (I) . Sistem kontrol umumnya mempekerjakan fungsi transfer tertutup dari setiap sumbu yang dapat ditentukan oleh polinomial-oprigenal, yang menentukan kestabilan akar yang terkemuka.

Model Linearisasi untuk Paksi Lambung

Perhatikan dinamika roll. persamaan linearisasi dari gerakan adalah:

[[GALAT:0]]

BAHASA di mana adalah sudut roll, adalah momen inertia, adalah turunan peredam aerodinamis, dan adalah turunan kendali yang mewakili torsi yang dihasilkan oleh gaya dorong diferensial. Sebuah kontrol PID menyediakan sinyal kontrol:

Mengganti dan membentuk fungsi transfer tertutup-loop menghasilkan polinomial karakteristik dari order tiga (atau lebih tinggi jika dinamika sensor dimasukkan). Untuk sistem order ketiga:

Pembatas Routh-Hurwitz kemudian memungkinkan kita untuk menganalisis tanda dari bagian-bagian nyata akar tanpa penemuan akar eksplisit.

(Inggris) The Routh-Hurwitz Criterion: A Systematic Stability Test

Dikembangkan secara independen oleh Edward John Routh dan Adolf Hurwitz, kriteria Routh-Hurwitz menyediakan kondisi yang diperlukan dan cukup untuk stabilitas sistem variabel-waktu linear. Ia menggunakan koefisien polinomial karakteristik untuk membangun sebuah array (susunan Routh). Jumlah perubahan tanda dalam kolom pertama dari susunan ini sama dengan jumlah akar dengan bagian nyata positif. Untuk sistem yang stabil, semua entri dalam kolom pertama harus memiliki tanda yang sama (biasanya positif).

¡Membentuk Routh Array

Dinosaurus diberi polinomial , susunan Routh dibangun baris demi baris:

  • ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇
  • ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇
  • Baris-baris tahsidi dihitung menggunakan rumus: (di mana a1 adalah unsur pertama dari baris kedua).

Jika unsur apapun dalam kolom pertama menjadi nol, penanganan khusus diperlukan (ganti dengan epsilon kecil atau menggunakan metode polinomial tambahan).Jika seluruh baris menjadi nol, polinomial memiliki akar simetris, dan array dilanjutkan menggunakan polinomial tambahan.

Syarat Stabilitas untuk Sistem Ketiga-Order

Untuk polinomial kubik , kondisi Routh-Hurwitz disederhanakan ke:

  • Semua pekali pekali harus positif (kondisi perlu).
  • Ketidaksamaan ketidaksamaan ketidaksamaan [ harus dipegang (kondisi cukup untuk urutan ketiga).

Aturan yang mudah ini sering digunakan sebagai cek cepat sebelum menyusun susunan penuh.

Aplikasi untuk Sistem Kontrol Roll Quadrotor

Untuk studi kasus quadrotor kami, polinomial karakteristik untuk sumbu roll, termasuk keuntungan kontrolir PID dan dinamika rotor (dimodelkan sebagai lag order pertama dengan konstanta waktu τ), diturunkan sebagai:

Di mana nilai numerik dari sistem fisik adalah: ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ s (konstanta waktu tortor), I xx = 0,01 kg·m2, L 2 = 0.5 N·m per kontrol unit . Keuntungan PID awal dipilih berdasarkan tuning heuristik: K p = 10, K i = 2, K d = 5. Hasil penggantian:

→

Bangunan Routh Array

Kami membangun susunan untuk ini keempat urutan polinomial:

  • Baris 1 (s4): 0.05, 15.1, 10
  • 2 (s3): 1,5, 52, 0
  • Baris ifgonia 3 (s2): menghitung b1 = (1.1.*15.1 - 0.05*52)/1.5 = (22.65 - 2.6)/1.5 = 13.367; b2 = (1.5*10 - 0.05*0)/1.5 = 10; b3 = 0
  • Baris darza 4 (s1): c1 = (13.367*52 - 1.5*10)/13.367 = (694.064 - 15)/13.367 = 50.84; c2 = 0
  • Baris dar 5 (s0): d1 = (50.84*10 - 13.367*0)/50.84 = 10

Nilai-nilai kolom pertama adalah: 0.05, 1,5, 13.367, 50.84, 10 ⁇ semua positif, tidak ada perubahan tanda. Dengan demikian, sistem dengan perolehan ini stabil.Namun, jika kita meningkatkan keuntungan integral ke K i = 20, koefisien polinomial berubah dan susunan Routh mengungkapkan perubahan tanda, menunjukkan ketidakstabilan. Ini menunjukkan kekuatan kriteria untuk parameter eksplorasi ruang.

Parameter Parameter Parameter Penolaan Menggunakan Kekangan Routh-Hurwitz

Dari simulasi percobaan dan teror, kriteria Routh-Hurwitz menyediakan ketidaksetaraan aljabar yang harus puas untuk stabilitas.

  • Semua pekali pekali positif: otomatis puas jika perolehan positif dan ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ ⁇
  • Kolom pertama dari Routh array pasti tidak memiliki tanda-tanda perubahan.

Dengan menyatakan entri kolom pertama secara simbolis dalam hal K p, K i, dan K d, kami memperoleh tiga persamaan batasan.

  • OCLC (perkiraan dari kondisi Routh)

Kekangan ini membimbing pemilihan perolehan akhir: K p = 8, K i = 1, K d = 4, yang terletak baik di dalam wilayah stabil dan juga memberikan margin fase yang baik ketika dievaluasi melalui respon frekuensi.

Hasil Simulasi dan Validasi

Sebuah simulasi nonlinear dari quadrotor dalam Gazebo lingkungan digunakan untuk memvalidasi margin stabilitas. Dengan perolehan yang dioptimasi oleh Routh-Hurwitz, respon roll terhadap input langkah 10 derajat menunjukkan waktu penyelesaian 0.8 detik, overshoot kurang dari 5%, dan tidak ada kesalahan negara-berstabil. Kontras, keuntungan di luar wilayah stabil (misalnya, K i = 20) menghasilkan oscillasi divergen yang tumbuh tidak terikat dalam waktu 2 detik.

Pengujian kekokohan Lanjut Lanjut older plugsts termasuk gusts angin hingga 5 m/s dan sensor noise tipikal low-cost MEMS IMUs . Kontrol mempertahankan stabilitas dalam semua kasus, dengan deviasi sudut roll maksimum tersisa di bawah 1,5 derajat . Kriteria Routh-Hurwitz dengan demikian disediakan tidak hanya stabilitas tetapi juga dasar untuk kinerja yang kuat.

Pertimbangan Implementasi Praktis

Sementara kriteria Routh-Hurwitz adalah alat analitik yang kuat, ia memiliki keterbatasan. Ini hanya berlaku untuk sistem linear time-invarian, sehingga model linearized harus valid di sekitar titik operasi. Untuk manuver agresif, efek nonlinear (mis., actuator kejenuhan, torsi gyroscopic) dapat menyebabkan degradasi stabilitas. Insinyur harus melengkapi analisis Routh-Hurwitz dengan time-domain simulasi] dan ] metode frqueency-domain (seperti plot root atau locus).

Secara tambahan, implementasi digital memperkenalkan penundaan sampling dan kesalahan kuantisasi. Ini dapat dimodelkan sebagai lag fase tambahan, yang mengurangi margin fase efektif. Pembedahan masih dapat diterapkan dengan menyertakan penundaan kontrol digital sebagai tiang tambahan dalam polinomial karakteristik. Untuk quadrotor kami, menjalankan loop kontrol pada 500 Hz tetap penundaan di bawah 2 ms, yang tidak mengubah secara signifikan hasil array Routh.

Kekecualian Kesimpulan

Diagnosis Routh-Hurwitz tetap merupakan langkah pertama yang tak dapat dibantah dalam desain sistem kontrol untuk dron kuadrotor. Studi kasus ini menunjukkan bagaimana untuk memperoleh karakteristik polinomial dari sumbu gulung kuadrotor, membangun susunan Routh, dan mengekstrak kendala aljabar yang mendefinisikan wilayah gain stabil. Metode memungkinkan penolakan cepat parameter yang tidak stabil ditetapkan tanpa simulasi ekstensif atau prototip. Dengan mengintegrasikan analisis Routh-Hurwitz dengan pedoman tuning praktis, insinyur dapat mencapai aman, dapat diandalkan, dan penerbangan dronsformance tinggi.

Untuk pembacaan lebih lanjut pada kriteria Routh-Hurwitz, lihat comprehensive Wikipedia artikel. Rujukan yang sangat baik tentang dinamika quadrotor adalah makalah oleh B. Corke dalam Robotik dan Autonomous Systems. Untuk teori kontrol yang lebih dalam, Universitas Kawali Michigan untuk MATLAB]. Lingkungan simulasi yang digunakan dapat ditemukan di T:6]] Situs resmi [TFLTFL]