(57)【要約】      （修正有）【課題】わずか１つの機能するエフェクタを有する飛翔体の飛翔体制御スキームを提供する。【解決手段】飛行中の故障を受けるマルチコプタを動作させるための方法であって、該方法は、エフェクタ１０２ａ〜ｄによって発生されるトルク及び／又は推進力に影響を与える前記故障を識別するステップを含み、前記故障の前記識別に応じて、ａ）あらかじめ規定された基準系１６０に関する前記本体１１２のプライマリ軸１３０の配向の推定を計算するステップであって、前記プライマリ軸１３０が、飛行時にマルチコプタがその周りに回転する軸であり、ｂ）前記マルチコプタの角速度の推定を計算するステップと、ｃ）前記あらかじめ規定された基準系１６０に関する前記本体１１２のプライマリ軸１３０の配向の推定と、前記マルチコプタの角速度の推定とに基づいて前記少なくとも４つのエフェクタ１０２ａ〜ｄのうちの１つ又はこれにより多くを制御するステップとを含む。【選択図】図１
2018083625.tif 000002
【特許請求の範囲】
【請求項１】
飛行中の故障を受けるマルチコプタを動作させるための方法であって、マルチコプタは、
・本体と、
・それぞれ、該本体に取り付けられ、前記故障を受けない場合に前記マルチコプタを飛行させることが可能なトルク及び推進力を発生するように動作可能である少なくとも４つのエフェクタと
を備え、
前記方法は、
・前記エフェクタによって発生されるトルク及び／又は推進力に影響を与える前記故障を識別するステップ
を含み、
前記故障の前記識別に応じて、
ａ）あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定を計算するステップであって、前記プライマリ軸が、飛行時にマルチコプタがその周りに回転する軸であり、
ｂ）前記マルチコプタの角速度の推定を計算するステップと、
ｃ）前記あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定と、前記マルチコプタの角速度の推定とに基づいて前記少なくとも４つのエフェクタのうちの１つ又はこれにより多くを、
ｉ）前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルクと、前記プライマリ軸に対して垂直なトルクをまとめて発生するように、このとき、
Ａ．前記プライマリ軸に沿ったトルクが前記プライマリ軸周りにマルチコプタを回転させ、
Ｂ．前記プライマリ軸に対して垂直なトルクが、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関して目標配向へ収束するようにマルチコプタを動かし、
ｉｉ）前記１つ又はこれより多くのエフェクタが前記プライマリ軸に沿った推進力を個々に発生するように
制御するステップと
を含む方法。
【請求項２】
前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップが、故障のない前記１つ又はこれより多くのエフェクタのそれぞれによって前記プライマリ軸に沿って発生される推進力が前記目標配向へ前記プライマリ軸の配向が収束されるときに故障を有さない前記１つ又はこれより多くのエフェクタによってまとめて発生された推進力の少なくとも２０％であるように、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタが前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の前記推定と、前記マルチコプタの角速度の前記推定とに基づく制御を含んでいる、請求項１記載の方法。
【請求項３】
前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップが、故障のない前記１つ又はこれより多くのエフェクタのそれぞれによって前記プライマリ軸に沿って発生される推進力が前記目標配向へ前記プライマリ軸の配向が収束されるときに故障を有さない前記１つ又はこれより多くのエフェクタによってまとめて発生された推進力の少なくとも３０％であるように、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタが前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の前記推定と、前記マルチコプタの角速度の前記推定とに基づく制御を含んでいる、請求項１記載の方法。
【請求項４】
１つのエフェクタによって発生されるトルク及び／又は推進力に影響を与える故障を識別する前記ステップが、前記エフェクタのうち少なくとも１つによって発生されたトルク及び／又は推進力を２０％より多く減少させる故障を識別するステップを含む、請求項１〜３のいずれか１項に記載の方法。
【請求項５】
１つのエフェクタによって発生されるトルク及び／又は推進力に影響を与える故障を識別する前記ステップが、前記エフェクタのうち少なくとも１つによって発生されたトルク及び／又は推進力を５０％より多く減少させる故障を識別するステップを含む、請求項１〜４のいずれか１項に記載の方法。
【請求項６】
１つのエフェクタによって発生されるトルク及び／又は推進力に影響を与える故障を識別する前記ステップが、前記エフェクタのうち少なくとも１つによって発生されたトルク及び／又は推進力を８０％より多く減少させる故障を識別するステップを含む、請求項１〜５のいずれか１項に記載の方法。
【請求項７】
１つのエフェクタによって発生されるトルク及び／又は推進力に影響を与える故障を識別する前記ステップが、前記エフェクタのうち少なくとも１つによって発生されたトルク及び／又は推進力の完全なロスを生じさせる故障を識別するステップを含む、請求項１〜６のいずれか１項に記載の方法。
【請求項８】
前記プライマリ軸に沿ったトルクが、毎分０．５回転より大きな速度で前記マルチコプタを前記プライマリ軸周りに回転させる、請求項１〜７のいずれか１項に記載の方法。
【請求項９】
前記プライマリ軸に沿ったトルクが、毎分１回転より大きな速度で前記マルチコプタを前記プライマリ軸周りに回転させる、請求項１〜８のいずれか１項に記載の方法。
【請求項１０】
ａ）前記マルチコプタのための目標加速度を定義するステップと、
ｂ）前記マルチコプタのための、前記プライマリ軸の前記目標配向を計算するために前記目標加速度を用いるステップと、
を更に含み、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタの制御が、前記１つ又はこれより多くのエフェクタによってまとめて発生される推力が前記目標加速度で前記マルチコプタを加速するよう前記１つ又はこれより多くのエフェクタを制御するステップを更に含む、請求項１〜９のいずれか１項に記載の方法。
【請求項１１】
前記マルチコプタの前記目標加速度を用いる前記プライマリ軸の前記目標配向を計算するステップが、
【数１】
2018083625.tif 000055
という方程式を用いて前記目標配向を計算するステップを含み、ここで、ベクトルａが前記目標加速度を表し、ベクトルｇが重力加速度を表し、前記ベクトル
【数２】
2018083625.tif 000056
が前記目標配向を表し、｜｜−｜｜がベクトルのユークリッドノルムを表す、請求項１０記載の方法。
【請求項１２】
前記目標推進力の大きさを規定するステップを更に含み、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップが、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の推定と、前記マルチコプタの角速度の推定とに基づいて、前記プライマリ軸に沿った前記１つ又はこれにより多くのエフェクタによって個々に発生された前記推進力のそれぞれの成分の和の大きさが前記目標推進力の大きさと等しくなるように前記１つ又はこれより多くのエフェクタを制御するステップを含む、請求項１〜１１のいずれか１項に記載の方法。
【請求項１３】
目標推進力の大きさを定義するステップを更に備え、
前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップが、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の推定と、前記マルチコプタの角速度の推定とに基づいて、前記プライマリ軸に沿った前記１つ又はこれにより多くのエフェクタによって個々に発生された前記推進力のそれぞれのあらかじめ規定された期間にわたって平均化された和の大きさが前記目標推進力の大きさと等しくなるように前記１つ又はこれより多くのエフェクタを制御するステップを含む、請求項１〜１２のいずれか１項に記載の方法。
【請求項１４】
故障を有さない前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップが、前記プライマリ軸の配向が前記目標配向へ収束されたときにそれぞれが目標推進力の大きさに少なくとも２０％寄与するように前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタをそれぞれ制御するステップを含む、請求項１３記載の方法。
【請求項１５】
前記マルチコプタの前記目標加速度を用いる前記目標推進力を計算する前記ステップが、
・前記目標加速度を定義するステップと、
・前記目標推進力が
ｆｄｅｓ＝ｍ｜｜ａ−ｇ｜｜
として計算されステップと
を含み、ここで、ｆｄｅｓは目標推進力の大きさを表し、｜｜−｜｜はベクトルのユークリッドノルムを表し、ａは前記目標加速度を表し、ｇは重力による加速度を表し、ｍは前記マルチコプタの質量を表す、請求項１２〜１４のいずれか１項に記載の方法。
【請求項１６】
ａ）前記マルチコプタの目標並進運動速度を定義するステップと、
ｂ）前記マルチコプタの目標位置を定義するステップと、
ｃ）前記マルチコプタの現在の並進運動速度を推定するステップと、
ｄ）前記マルチコプタの現在の位置を推定するステップと、
ｅ）前記目標加速度を計算するために、前記マルチコプタの前記目標並進運動速度、前記目標位置、前記現在の並進運動速度及び前記現在の位置のうち少なくとも１つを用いるステップと
を更に含む、請求項１３又は１４記載の方法。
【請求項１７】
前記マルチコプタがクアッドコプタである、請求項１記載の方法。
【請求項１８】
前記１つ又はこれより多くのエフェクタのそれぞれが、個々に、前記プライマリ軸に沿ったゼロでない要素を有するトルクを発生することを特徴とする請求項１記載の方法。
【請求項１９】
前記制御が前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタのそれぞれの複数の変数のうち単一変数の制御を含み、前記複数の変数が、
・回転速度と、
・電圧と、
・電流と、
・燃料流量と、
・モータトルクと、
・質量流量と、
・動力と
のうち少なくとも１つを含む、請求項１記載の方法。
【請求項２０】
前記制御が、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタのうち多くとも３つを制御することを含む、請求項１〜１９のいずれか１項に記載の方法。
【請求項２１】
前記制御が、前記少なくとも４つのエフェクタのうち多くとも２つを制御することを含む、請求項１〜２０のいずれか１項に記載の方法。
【請求項２２】
ａ）本体と、
ｂ）該本体に取り付けられ、それぞれ、故障を受けていないときにマルチコプタを飛行させるトルク及び推進力を発生するために動作可能な少なくとも４つのエフェクタと、
ｃ）請求項１に基づく方法を実行することができるよう構成された飛行モジュールと
を備えたマルチコプタ。
【請求項２３】
前記飛行モジュールが、
ａ）複数のセンサ及び／又はユーザからのデータを受信するための入力ユニットと、
ｂ）前記マルチコプタの運動及び／又は前記エフェクタのうち少なくとも１つの動作を表すデータを測定するためのセンシングユニットと、
ｃ）前記エフェクタのうち１つ又はこれより多くによって発生されるトルク及び／又は推進力に影響を与える故障を識別するための前記センシングユニット及び／又は前記入力ユニットに動作可能に接続された推定ユニットと、
ｄ）該推定ユニットに動作可能に接続されるように構成され、
ｉ．あらかじめ規定された基準系に関して前記本体のプライマリ軸の配向の推定を計算するように構成され、このとき、前記プライマリ軸が、制御ユニットの制御の下での飛行時にその周りに前記マルチコプタが回転する軸であり、
ｉｉ．
Ａ．前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルク及び前記プライマリ軸に対して垂直なトルクをまとめて発生させるように、このとき、
・前記プライマリ軸に沿ったトルクにより前記マルチコプタが前記プライマリ軸周りに回転し、
・前記プライマリ軸に対して垂直なトルクにより、前記プライマリ軸の配向があらかじめ規定された基準系に関する目標配向へ収束するよう前記マルチコプタが移動し、
Ｂ．前記１つ又はこれより多くのエフェクタのそれぞれが個々に前記プライマリ軸に沿った推進力を発生するように
前記１つ又はこれより多くのエフェクタに制御信号を送信するように
構成された制御ユニットと
を備えた、請求項２２記載のマルチコプタ。
【請求項２４】
ａ）前記推定ユニットが、前記マルチコプタの運動を表すデータを提供するよう構成されているとともに、該データを供給するように前記制御ユニットへ動作可能に接続されており、
ｂ）前記制御ユニットが、前記推定ユニットの前記データに基づいて前記１つ又はこれより多くのエフェクタの制御を実行するように設定されている、
請求項２２記載のマルチコプタ。
【請求項２５】
前記プライマリ軸の配向が前記目標配向へ収束されるときに、それぞれが、故障を有さない前記１つ又はこれより多くのエフェクタによってまとめて発生される推力の少なくとも２０％寄与するように、前記制御ユニットが、故障を有さない前記１つ又はこれより多くのエフェクタを制御するよう構成されている、請求項２２記載のマルチコプタ。
【請求項２６】
前記プライマリ軸の配向が収束されるときに、それぞれが、故障を有さない前記１つ又はこれより多くのエフェクタによってまとめて発生される推力の少なくとも３０％寄与するように、前記制御ユニットが、故障を有さない前記１つ又はこれより多くのエフェクタを制御するよう構成されている、請求項２２記載のマルチコプタ。
【請求項２７】
前記推定ユニットが、前記エフェクタのうち少なくとも１つによって発生されるトルク及び／又は推進力を２０％、５０％又は８０％より大きく減少させる故障を識別するよう動作可能である、請求項２２記載のマルチコプタ。
【請求項２８】
前記推定ユニットが、前記エフェクタのうち少なくとも１つによって発生されるトルク及び／又は推進力を完全にロスさせる故障を識別するよう動作可能である、請求項２２記載のマルチコプタ。
【請求項２９】
前記プライマリ軸の周りに前記マルチコプタを毎分０．５回転より大きな速度で回転させるために前記プライマリ軸に沿ったトルクを前記１つ又はこれより多くのエフェクタがまとめて発生させるよう、前記エフェクタのうち少なくとも１つのエフェクタを制御可能に前記制御ユニットが構成されている、請求項２２〜２８のいずれか１項に記載のマルチコプタ。
【請求項３０】
前記マルチコプタがクアッドコプタである、請求項２２〜２９のいずれか１項に記載のマルチコプタ。
【請求項３１】
前記制御ユニットが、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタのそれぞれの複数の変数のうち単一変数を制御するよう構成されており、前記複数の変数が、
ａ）回転速度と、
ｂ）電圧と、
ｃ）電流と、
ｄ）燃料流量と、
ｅ）モータトルクと、
ｆ）質量流量と、
ｇ）動力と
のうち少なくとも１つを含んでいる、請求項２２〜３０のいずれか１項に記載のマルチコプタ。
【請求項３２】
前記制御ユニットが、更に
ａ）前記マルチコプタの目標加速度を定義し、
ｂ）前記マルチコプタのための前記プライマリ軸の前記目標配向を計算するために、前記目標加速度を利用し、
ｃ）前記１つ又はこれより多くのエフェクタによってまとめて発生される推力が前記目標加速度で前記マルチコプタを加速するよう更に前記少なくとも４つのエフェクタが制御されるように、前記制御信号を送信する
ために構成されている、請求項２２〜３１のいずれか１項に記載のマルチコプタ。
【請求項３３】
前記制御ユニットが、更に、方程式
【数３】
2018083625.tif 000057
を用いて前記目標配向を計算することで前記マルチコプタの前記目標加速度を用いる前記プライマリ軸の前記目標配向を計算するよう構成されており、ベクトルａが前記目標加速度を表し、ベクトルｇが重力加速度を表し、ベクトル
【数４】
2018083625.tif 000058
が前記目標配向を表し、｜｜−｜｜がベクトルのユークリッドノルムを表す、請求項３２記載のマルチコプタ。
【請求項３４】
前記制御ユニットが、更に、
・前記目標推進力の大きさを規定し、
・前記プライマリ軸に沿った前記１つ又はこれより多くのエフェクタによって個々に発生された推進力のそれぞれの和の大きさが前記目標推進力の大きさと等しくなるよう前記制御信号を送信する
ように構成された、請求項２２〜３３のいずれか１項に記載のマルチコプタ。
【請求項３５】
前記制御ユニットが、更に、
・前記目標推進力の大きさを規定し、
・あらかじめ規定された期間にわたって平均化された、前記プライマリ軸に沿った前記１つ又はこれより多くのエフェクタによって個々に発生された推進力のそれぞれの和の大きさが前記目標推進力の大きさと等しくなるよう前記制御信号を送信する
ように構成された、請求項２２〜３４のいずれか１項に記載のマルチコプタ。
【請求項３６】
前記制御ユニットが、更に、
・前記目標加速度を規定し、
・                          ｆｄｅｓ＝ｍ｜｜ａ−ｇ｜｜
としての前記目標推進力を計算する
ことで、前記マルチコプタの前記目標加速度を用いて前記目標推進力の大きさを計算するよう構成され、ｆｄｅｓは目標推進力の大きさを表し、｜｜−｜｜はベクトルのユークリッドノルムを表し、ａは前記目標加速度を表し、ｇは重力による加速度を表し、ｍは前記マルチコプタの質量を表す、請求項３４又は３５記載のマルチコプタ。
【請求項３７】
前記マルチコプタが、更に、前記センシングユニットに動作可能に接続されたセンサを備え、
・前記マルチコプタの運動を検出し、
・検出された前記マルチコプタの運動を表すデータを前記センシングユニットへ供給するように構成された、請求項２２〜３６のいずれか１項に記載のマルチコプタ。
【請求項３８】
前記マルチコプタが、更に、前記センシングユニットに動作可能に接続されたセンサを備え、
・前記少なくとも４つのエフェクタのうち少なくとも１つのエフェクタの動作を検出し、・前記少なくとも４つのエフェクタのうち少なくとも１つのエフェクタの検出された動作を表すデータを前記センシングユニットへ供給する
ように構成された、請求項２２〜３７のいずれか１項に記載のマルチコプタ。
【請求項３９】
前記制御ユニットが、前記本体及び前記少なくとも４つのエフェクタから機械的に独立しているとともに、ワイヤレス接続によって前記マルチコプタに動作可能に接続されている、請求項２２〜３８のいずれか１項に記載のマルチコプタ。
【請求項４０】
機械的に独立した前記制御ユニットが、ユーザの手で保持することができるよう、及び前記ワイヤレス接続によって前記マルチコプタの前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタの制御に使用可能なユーザインタフェースを介してユーザからの入力を受信するよう構成されたハウジング内に収容されている、請求項３９記載のマルチコプタ。
【請求項４１】
マルチコプタのための制御ユニットであって、前記マルチコプタは、
ａ）本体と、
ｂ）それぞれ、該本体に取り付けられ、前記マルチコプタを飛行させることが可能なトルク及び推進力を発生する少なくとも４つのエフェクタと、
ｃ）請求項１記載の方法を実行することが可能に構成された飛行モジュールと
を備える、制御ユニット。
【請求項４２】
前記飛行モジュールが、
ａ）複数のセンサ及び／又はユーザからのデータを受信するための入力ユニットと、
ｂ）前記マルチコプタの運動及び／又は前記エフェクタのうち少なくとも１つの動作をセンシングするためのセンシングユニットと、
ｃ）前記エフェクタのうち１つによって発生されるトルク及び／又は推進力に影響を与える故障を識別するための前記センシングユニット及び／又は前記入力ユニットに動作可能に接続された推定ユニットと
を備え、前記制御ユニットが、
ａ）前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルク及び前記プライマリ軸に対して垂直なトルクをまとめて発生させるように、このとき、
ｉ．前記プライマリ軸に沿ったトルクにより前記マルチコプタが前記プライマリ軸周りに回転し、
ｉｉ．前記プライマリ軸に対して垂直なトルクにより、前記プライマリ軸の配向があらかじめ規定された基準系に関する目標配向へ収束するよう前記マルチコプタが移動し、
ｂ）前記１つ又はこれより多くのエフェクタのそれぞれが個々に推進力を発生するように、
前記エフェクタのうち１つ又はこれより多くのエフェクタを制御するように構成されている、請求項４１記載の制御ユニット。
【請求項４３】
前記推定ユニットに動作可能に接続され、
ａ）前記推定ユニットが、前記マルチコプタの運動を表すデータを供給するように構成されているとともに、前記データを供給するよう前記制御ユニットに動作可能に接続されており、
ｂ）前記制御ユニットが、前記推定ユニットの結果に基づいて前記１つ又はこれより多くのエフェクタの制御を実行するように構成されている、
請求項４１記載の制御ユニット。
【請求項４４】
更に前記本体のプライマリ軸を計算するように構成され、
ａ）前記プライマリ軸が、前記制御ユニットの制御の下で飛行する際に前記マルチコプタがその周りに回転する軸であり、
ｂ）前記１つ又はこれより多くのエフェクタのそれぞれが前記プライマリ軸に沿った推進力を発生させ、
ｃ）前記プライマリ軸の前記計算が、前記マルチコプタの運動を表すデータ及び前記マルチコプタの物理的な特性を表すデータに依存して行われる、
請求項４１〜４３のいずれか１項に記載の制御ユニット。
【請求項４５】
マルチコプタの制御のための請求項４１〜４４のいずれかに記載の制御ユニットの使用であって、前記マルチコプタが、
ａ）本体と、
ｂ）それぞれ、該本体に取り付けられ、前記故障を受けない場合に前記マルチコプタを飛行させることが可能なトルク及び推進力を発生する少なくとも４つのエフェクタと、
ｃ）複数のセンサ及び／又はユーザからのデータを受信するための入力ユニットと、
ｄ）前記マルチコプタの運動及び／又は前記エフェクタのうち少なくとも１つの動作をセンシングするためのセンシングユニットと、
ｅ）前記エフェクタのうち１つ又によって発生されるトルク及び／又は推進力に影響を与える故障を識別するための前記センシングユニット及び／又は前記入力ユニットに動作可能に接続された推定ユニットとを備え、前記マルチコプタが、前記エフェクタのうち少なくとも１つによって発生されるトルク及び／又は推進力を２０％以上低減させる故障を受ける、使用。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、エフェクタに影響を与える故障を受けるマルチコプタの制御に関するものである。特に、本発明は、回転させることによるマルチコプタの並進運動制御を可能とする制御された飛行のための新たなスキームと、固定して取り付けられた複数の固定ピッチプロペラを備えた従来の浮揚可能な航空用の飛翔体（「マルチコプタ」）においてエフェクタの故障の場合に本発明をフェイルセーフ制御機構として用いることが可能な新たな制御方法とに関するものである。
【背景技術】
【０００２】
本発明によれば、マルチコプタの制御のための以前の方法の制限が十分に低減されたか、又は除去された。特に、本発明は、わずか１つの機能するエフェクタを有する飛翔体の飛翔体制御スキームを提供するものである。加えて、本発明は、１つ又はこれより多くのエフェクタに影響を与える故障の場合の飛翔体の制御のための改善されたシステム及び方法を提供するものである。
【０００３】
本発明のある実施例の技術的な利点によれば、現存のマルチコプタのデザインを改善又は単純化することが可能である。例えば、マルチコプタは、より小さな質量を必要とするとともに、エフェクタの冗長性（例えばヘキサコプタ及びオクトコプタ）、エフェクタの収容（例えばシュラウド、ダクテッドファン）又は安全性の担保としてのパラシュートに依存する現在のシステムよりも少ないデザインの制約及び特有の制限を必要とする。
【０００４】
本発明のある実施例の技術的な利点によれば、現存するマルチコプタの安全性及び信頼性を向上させることが可能である。例えば、本発明によれば、衝突、機械的若しくは電気的な故障、電子的な不具合、操作者のエラー又は風若しくは乱気流のような不利な環境状況によって生じる飛翔体における特有なリスクを最小化又は除去することが可能である。本発明は、制御を完全に失う破滅的な故障よりもむしろグレースフルデグラデーションを可能とすることによる故障、不具合、操作者のエラー及びこれに類するものの影響を軽減することが可能である。
【０００５】
本発明のある実施例の他の技術的な利点により、マルチコプタの信頼性及び安全性を向上させること、より幅広いいろいろな動作状況及び環境における使用を可能にすること、又は人間を乗せているか、若しくは人間を乗せていない飛翔体についての熟練したパイロットによって一般に実行されるあるタスクの部分的な又は完全な自動化を可能とすることによって新たな用途のためのマルチコプタの使用を可能とすることができる。パイロットの必要性は、費用対効果、可能な操作状況及び多くの用途におけるマルチコプタの飛行耐久性を厳しく制限するものである。例えば、熟練したパイロットでさえ、風及び乱気流を含む状況を操作する多くの現実の世界における安全及び効果的な制御を保証することはできない。
【０００６】
さらに、本発明のある実施例の他の技術的な利点により、本発明を様々な状況における様々な用途の特有の必要性に適合させることが可能である。例示的な用途は社会インフラの検査及び監視を含むものであり、これらは、危険な若しくは繰り返しのタスク、工業上の若しくは公共のサービス用途（例えば産業用地における監督及び監視、写真測量、調査）、職業上の航空写真若しくは映画撮影、航空便による貨物の搬送若しくは配達、小さな飛翔体のようなおもちゃ、音楽及び光に合わせた振り付けを含むステージパフォーマンス、劇場俳優との相互作用を必要とするシアターパフォーマンス、ＤＩＹドローンのような公衆のための趣味に熱中する人のプラットフォーム、飛行プラットフォームをアクティブに調査し、若しくはカリキュラムの一部として用いるグループのための調査プラットフォーム、又はサバイバビリティ、動力自立性、検出感度又は極端な状況（天候、照明条件、汚濁物）における動作のような要件を有する軍事用途を含むものである。特に、ある技術的な利点により、本発明はセンサの広い範囲を備えることが可能である。例えば、赤外線センサにより、果樹園における乾燥した地面の区画の検出又は作物の監視のための実施例が可能となる。
【発明の概要】
【発明が解決しようとする課題】
【０００７】
本発明の課題は、わずか１つの機能するエフェクタを有する飛翔体の飛翔体制御スキームを提供することである。加えて、本発明は、１つ又はこれより多くのエフェクタに影響を与える故障の場合の飛翔体の制御のための改善されたシステム及び方法を提供することにある。
【課題を解決するための手段】
【０００８】
飛行中の故障を受けるマルチコプタを動作させるための方法を提供する本発明の第１の態様によれば、マルチコプタは、本体と、それぞれ、該本体に取り付けられ、前記故障を受けない場合に前記マルチコプタを飛行させることが可能なトルク及び推進力を発生する少なくとも４つのエフェクタとを備える。この方法は、前記エフェクタによって発生されるトルク及び／又は推進力に影響を与える前記故障を識別するステップを含み、前記故障の前記識別に応じて、（１）あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定を計算するステップであって、前記プライマリ軸が、飛行時にマルチコプタがその周りに回転する軸であり、（２）前記マルチコプタの角速度の推定を計算するステップと、（３）前記あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定と、前記マルチコプタの角速度の推定とに基づいて前記少なくとも４つのエフェクタのうちの１つ又はこれにより多くを制御するステップとを含む。前記少なくとも４つのエフェクタのうちの１つ又はこれにより多くを制御するステップは、（ａ）前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルクと、前記プライマリ軸に対して垂直なトルクをまとめて発生するように、このとき、（ｉ）前記プライマリ軸に沿ったトルクが前記プライマリ軸周りにマルチコプタを回転させ、（ｉｉ）前記プライマリ軸に対して垂直なトルクが、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関して目標配向へ収束するようにマルチコプタを動かし、（ｂ）前記１つ又はこれより多くのエフェクタが前記プライマリ軸に沿った推進力を個々に発生するように行われる。
【０００９】
トルクは、マルチコプタの重心周りのトルクである。
【００１０】
角速度は、好ましくはマルチコプタが慣性系に関して回転する速度である。
【００１１】
好ましくは、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の前記推定と、前記マルチコプタの角速度の前記推定とに基づく少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップが、少なくとも４つのエフェクタのうち故障による影響を受けていない他のものを制御することを含んでいる。
【００１２】
トルク及び推進力は、好ましくはゼロでないトルク及びゼロでない推進力である。
【００１３】
好ましくは、各エフェクタによって発生されるトルク及び推進力は、必然的に、及び本質的にリンクされている。
【００１４】
好ましくは、トルクの成分は、マルチコプタの重心からの距離において作用するエフェクタの推力によるものであり得る。トルクの追加的な成分は、エフェクタ自体によって発生されるトルク対であることができ、例えば、回転するプロペラにおける流体力学的な効果によるものであり得る。
【００１５】
本発明では、プライマリ軸は、マルチコプタ本体の慣性の主軸と同一である必要はない。
【００１６】
好ましくは、プライマリ回転は、故障によって影響を受けていない残りのエフェクタによって少なくとも主に発生され得る。
【００１７】
好ましくは、あらかじめ規定された基準系に関する目標配向は自由に選択されるとともに、目標配向は、達成及び維持されることが可能である。
【００１８】
あらかじめ規定された基準系に関する目標配向は、より具体的には目標配向としての、プライマリ軸と重力の方向又は慣性系における垂直方向の間の角度の考えであり得る。
【００１９】
好ましくは、目標配向は、実行時間において自由に選択されることができ、好ましくは、目標配向の範囲又は特定されたリストから選択される。
【００２０】
原則的には制限はないものの、一般的な目標配向は、０〜７５°であり、より具体的には重力とは反対方向から０〜４５°である。
【００２１】
目標配向の方位方向は、０〜３６０°の範囲のいずれでもよい。
【００２２】
エフェクタの故障は、具体的には、推進力を発生するエフェクタの能力における相当な低減を意味し得る。
【００２３】
このような故障は、一般には、エフェクタがもともとの推進力を発生させる能力の０〜５０％の間で発生させる能力を維持することを意味し得る。
【００２４】
より具体的には、推力を発生させるもともとの能力の０〜１０％であり得る。
【００２５】
故障は、マルチコプタからのエフェクタの機械的なデカップリングを含む様々な要因によって引き起こされ得る。
【００２６】
故障の発生後いくつかのエフェクタがもはやいかなる推力も発生できない場合には、プライマリ軸に沿った推力を発生させるエフェクタは、故障によって影響されない全てのエフェクタであり得る（例えば、故障がモータの脱落である場合には、モータが脱落しなかったもののための全てのエフェクタがプライマリ軸に沿った推力を発生させる）。
【００２７】
前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップは、故障のない前記１つ又はこれより多くのエフェクタのそれぞれによって前記プライマリ軸に沿って発生される推進力が前記目標配向へ前記プライマリ軸の配向が集束されるときに故障を有さない前記１つ又はこれより多くのエフェクタによってまとめて発生された推進力の少なくとも２０％又は３０％であるように、（ａ）前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタが前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の前記推定と、（ｂ）前記マルチコプタの角速度の前記推定とに基づく制御を更に含み得る。
【００２８】
１つのエフェクタによって発生されるトルク及び／又は推進力に影響を与える故障を識別する前記ステップが、前記エフェクタのうち少なくとも１つによって発生されたトルク及び／又は推進力を２０％、５０％若しくは８０％より多く減少させるか、又は完全なロスを生じさせる故障を識別するステップを更に含み得る。
【００２９】
故障は、人間による監視、モデルに基づくマルチコプタのオンボード又はオフボードの観測器のような自動的な方法による測定データの監視、スライドモードを用いる観測器、投票を基礎とするアルゴリズム、パリティ空間アプローチ又はパラメータ識別のような間接的な検出、例えば、マルチコプタのモータの回転速度の監視による、又はマルチコプタのモータがどのくらいの電流を取り出すかの監視による、故障の直接的な検出などを含む非常に様々な方法を用いて検出されることができる。
【００３０】
本発明においては、更に、前記プライマリ軸に沿ったトルクが、毎秒０．５回転より大きな速度で前記マルチコプタを前記プライマリ軸周りに回転させるものであり得る。
【００３１】
本発明においては、更に、前記プライマリ軸に沿ったトルクが、毎秒１回転より大きな速度で前記マルチコプタを前記プライマリ軸周りに回転させる物であり得る。
【００３２】
好ましくは、前記プライマリ軸に沿った前記トルクは、プライマリ軸の回転が目標配向へ収束された場合にマルチコプタを連続的に回転させることができる。
【００３３】
好ましくは、前記毎秒０．５又は１回転は、あらかじめ規定された時間間隔における平均の回転速度である。
【００３４】
好ましくは、目標の力は、残りの、故障を有さないエフェクタの力の和である。
【００３５】
本方法は、更に、前記マルチコプタのための目標加速度を定義するステップを含むことが可能である。好ましくは、前記目標加速度は、前記マルチコプタのための、前記プライマリ軸の前記目標配向を計算するために用いられる。好ましくは、本方法は、更に、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタの制御が、前記１つ又はこれより多くのエフェクタによってまとめて発生される推力が前記目標加速度で前記マルチコプタを加速するよう前記１つ又はこれより多くのエフェクタを制御するステップを含む。
【００３６】
本方法は、更に、前記マルチコプタの前記目標加速度を用いる前記プライマリ軸の前記目標配向を計算するステップが、
【００３７】
【数１】
2018083625.tif 000003
という方程式を用いて前記目標配向を計算するステップを含み、ここで、ベクトルａが前記目標加速度を表し、ベクトルｇが重力加速度を表し、前記
【００３８】
【数２】
2018083625.tif 000004
が前記目標配向を表し、｜｜−｜｜がベクトルのユークリッドノルムを表す。換言すれば、前記プライマリ軸の目標配向は、前記目標加速度を等しくするベクトルと重力加速度のベクトルの差をこの差のノルムで除したものとして計算され得る。
【００３９】
本方法は、前記目標推進力の大きさを規定するステップを更に含み得る。好ましくは、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップが、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の推定と、前記マルチコプタの角速度の推定とに基づいて、前記プライマリ軸に沿った前記１つ又はこれにより多くのエフェクタによって個々に発生された前記推進力のそれぞれの成分の和の大きさが前記目標推進力の大きさと等しくなるように前記１つ又はこれより多くのエフェクタを制御するステップを含む。
【００４０】
本発明においては、目標推進力の大きさを定義するステップを更に備え得る。好ましくは、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップが、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の推定と、前記マルチコプタの角速度の推定とに基づいて、前記プライマリ軸に沿った前記１つ又はこれにより多くのエフェクタによって個々に発生された前記推進力のそれぞれの成分のあらかじめ規定された期間にわたって平均化された和の大きさが前記目標推進力の大きさと等しくなるように前記１つ又はこれより多くのエフェクタを制御するステップを含む。
【００４１】
本発明においては、本方法は、故障を有さない前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御するステップが、前記プライマリ軸の配向が前記目標配向へ収束されたときにそれぞれが目標推進力の大きさにそれぞれ少なくとも２０％寄与するように前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタをそれぞれ制御するステップを更に含み得る。
【００４２】
本発明においては、前記マルチコプタの前記目標加速度を用いる前記目標推進力を計算する前記ステップが、前記目標加速度を定義するステップと、前記目標推進力が
ｆｄｅｓ＝ｍ｜｜ａ−ｇ｜｜
として計算されステップとを更に含むことができ、ここで、ｆｄｅｓは目標推進力の大きさを表し、｜｜−｜｜はベクトルのユークリッドノルムを表し、ａは前記目標加速度を表し、ｇは重力による加速度を表し、ｍは前記マルチコプタの質量を表す。換言すれば、目標推進力の大きさは、マルチコプタの質量に前記目標加速度を等しくするベクトルと重力加速度のベクトルの差のユークリッドノルムを乗じることで計算され得る。
【００４３】
前記加速度の制御により、例えば、マルチコプタの浮揚を維持するのに十分な推力をエフェクタがもはや発生しない重大な故障をもたらすマルチコプタの地面への衝突の方向が制御され得る。
【００４４】
本発明においては、前記マルチコプタの目標並進運動速度を定義するステップと、前記マルチコプタの目標位置を定義するステップと、前記マルチコプタの現在の並進運動速度を推定するステップと、前記マルチコプタの現在の位置を推定するステップと、前記目標加速度を計算するために、前記マルチコプタの前記目標並進運動速度、前記目標位置、前記現在の並進運動速度及び前記現在の位置のうち少なくとも１つを用いるステップとを更に含み得る。
【００４５】
好ましくは、本方法は、前記目標加速度を計算するために現在の並進運動速度を用いる。
【００４６】
好ましくは、本方法は、前記目標加速度を計算するために現在の位置を用いる。
【００４７】
好ましくは、前記方法は、前記目標速度、前記目標位置、前記マルチコプタの前記現在の位置の全てを前記目標加速度を計算するために用いる。
【００４８】
これらの推定をどのように用い得るかについての好ましい方法は、以下のとおりである。ｖｄｅｓ及びｐｄｅｓがそれぞれマルチコプタの目標速度及び位置を表すものとし、ｖ及びｐがそれぞれマルチコプタの現在の速度及び現在の位置の推定を表すものとし、目標加速度をａｄｅｓとして定義する。マルチコプタがこの目標加速度に従えば、マルチコプタの位置及び速度は目標へ収束し、目標加速度が選択されれば、以下のとおりである：
【００４９】
【数３】
2018083625.tif 000005
ここで、パラメータζは減衰比を表し、ωｎが固有振動数を表し、ζ及びωｎの両者は設計パラメータである。典型的な選択は、ζ＝０．７及びωｎ＝２ｒａｄ／ｓにいくらか類似したものである。上述の式は本発明の利点を与える、当業者にとって明白は多くの他のものとともに現在の位置及び目標位置並びに速度に関する目標加速度をパラメータ化するための単に１つの方法であることに留意されたい。
【００５０】
前記速度の制御により、例えば、マルチコプタの浮揚を維持するのに十分な推力をエフェクタがもはや発生しない重大な故障をもたらすマルチコプタの地面への衝突場合のマルチコプタのエネルギーを最小化され得る。
【００５１】
例えば、目標位置を一定とし、マルチコプタをこの位置へ（例えば加速度を制御することで）動かすことで、マルチコプタは、浮揚状態であることができ、ここで「浮揚」は空間における一点に実質的に維持されることを意味するために用いられる。
【００５２】
好ましくは、マルチコプタはクアッドコプタである。本発明における用途では、クアッドコプタは４つのエフェクタを有するマルチコプタであり、これらエフェクタのそれぞれが、
・マルチコプタの本体に固定して取り付けられ、
・ブレード回転として変動しないロータピッチを有する固定ピッチプロペラブレードを備え、
・トルク及び推進力を発生するために動作可能であり、
・マルチコプタを飛行させることが可能な推進力に貢献するために構成及び配置され
ている。
【００５３】
本発明においては、更に、前記１つ又はこれより多くのエフェクタのそれぞれが、個々に、前記プライマリ軸に沿ったゼロでない要素を有するトルクを発生することができる。
【００５４】
本発明においては、更に、前記制御が前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタのそれぞれの複数の変数のうち単一変数の制御を含み、前記複数の変数が、
・回転速度と、
・電圧と、
・電流と、
・燃料流量と、
・モータトルクと、
・質量流量と、
・動力と
のうち少なくとも１つを含み得る。
【００５５】
好ましくは、前記単一変数は例えば大きさであるスカラー量であり、ベクトルではない。さらに、前記単一変数は、エフェクタ制御信号のような信号として考慮されることも可能である。
【００５６】
好ましくは、単一変数は、同時に推進力及びトルクを設定するものである。
【００５７】
好ましくは、目標配向へ収束させるプライマリ軸の配向を発生させるために、及びマルチコプタがプライマリ軸周りの進行中の回転を有する間に、マルチコプタ本体は、旋回軸周りに（好ましくはプライマリ軸に関してゼロでない角度で）旋回され得る。剛体の角速度の展開を支配するオイラーの運動方程式による回転の２つの成分の影響は、好ましくは、旋回軸周りの回転と同様にプライマリ回転から線形に独立して角加速度（及びしたがって速度）を創造するために利用され得る。
【００５８】
それゆえ、たとえエフェクタがプライマリ軸に垂直な方向への十分なトルクを発生し得ないとしても、本発明によれば、姿勢ダイナミクスにおいて固有のこのカップリング効果を完全な姿勢制御を達成するために利用することが可能である。これは、とりわけ１つ又は２つのみの故障のないエフェクタを有するマルチコプタの場合については適切かつ有用である。
【００５９】
本発明においては、姿勢制御は、前記マルチコプタのプライマリ軸の配向を制御するための制御ユニットを用いることを意味する。
【００６０】
プロペラのために、プロペラブレードの運動に対抗する空気によりプロペラの回転に対抗するトルクを発生させるトルク対が存在する。これは、プライマリ軸の方向におけるトルク成分に寄与することが可能である。
【００６１】
本発明においては、更に、前記制御が、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタのうち多くとも３つを制御することを含むことができる。
【００６２】
本発明においては、更に、前記制御が、前記少なくとも４つのエフェクタのうち多くとも２つを制御することを含むことができる。
【００６３】
本発明においては、更に、前記制御が、前記少なくとも４つのエフェクタのうち多くとも１つを制御することを含むことができる。
【００６４】
本発明の更なる態様によれば、（Ａ）本体と、（Ｂ）該本体に取り付けられ、それぞれ、故障を受けていないときにマルチコプタを飛行させるトルク及び推進力を発生するために動作可能な少なくとも４つのエフェクタと、飛行中に故障を受ける前記マルチコプタを動作させるための方法を実行することができるよう構成された飛行モジュールとを備えたマルチコプタが提供される。この方法は、前記エフェクタによって発生されるトルク及び／又は推進力に影響を与える前記故障を識別するステップを含み、前記故障の前記識別に応じて、（１）あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定を計算するステップであって、前記プライマリ軸が、飛行時にマルチコプタがその周りに回転する軸であり、（２）前記マルチコプタの角速度の推定を計算するステップと、（３）前記あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定と、前記マルチコプタの角速度の推定とに基づいて前記少なくとも４つのエフェクタのうちの１つ又はこれにより多くを制御するステップとを含むことができる。前記少なくとも４つのエフェクタの１つ又は２つを制御するステップは、（ａ）前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルクと、前記プライマリ軸に対して垂直なトルクをまとめて発生するように、このとき、（ｉ）前記プライマリ軸に沿ったトルクが前記プライマリ軸周りにマルチコプタを回転させ、（ｉｉ）前記プライマリ軸に対して垂直なトルクが、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関して目標配向へ収束するようにマルチコプタを動かし、（ｂ）前記１つ又はこれより多くのエフェクタが前記プライマリ軸に沿った推進力を個々に発生するように制御することができる。
【００６５】
好ましくは、マルチコプタの飛行モジュールは、（１）複数のセンサ及び／又はユーザからのデータを受信するための入力ユニットと、（２）前記マルチコプタの運動及び／又は前記エフェクタのうち少なくとも１つの動作を表すデータを測定するためのセンシングユニットと、（３）前記エフェクタのうち１つ又はこれより多くによって発生されるトルク及び／又は推進力に影響を与える故障を識別するための前記センシングユニット及び／又は前記入力ユニットに動作可能に接続された推定ユニットと、（４）制御ユニットとを備えている。好ましくは、この制御ユニットは、該推定ユニットに動作可能に接続されるように構成され、
・あらかじめ規定された基準系に関して前記本体のプライマリ軸の配向の推定を計算するように構成され、このとき、前記プライマリ軸が、制御ユニットの制御の下での飛行時にその周りに前記マルチコプタが回転する軸であり、
・（ａ）前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルク及び前記プライマリ軸に対して垂直なトルクをまとめて発生させるように、このとき、（ｉ）前記プライマリ軸に沿ったトルクにより前記マルチコプタが前記プライマリ軸周りに回転し、（ｉｉ）前記プライマリ軸に対して垂直なトルクにより、前記プライマリ軸の配向があらかじめ規定された基準系に関する目標配向へ収束するよう前記マルチコプタが移動し、（ｂ）前記１つ又はこれより多くのエフェクタのそれぞれが個々に前記プライマリ軸に沿った推進力を発生するように構成されている。
【００６６】
前記推定ユニットが、前記マルチコプタの運動を表すデータを提供するよう構成されているとともに、該データを供給するよう前記制御ユニットへ動作可能に接続されており、前記制御ユニットが、前記推定ユニットの前記データに基づいて前記１つ又はこれより多くのエフェクタの制御を実行するように設定され得る。
【００６７】
プライマリ軸の前記計算は、前記マルチコプタの運動を表すデータ及び前記マルチコプタの物理的な特性を表すデータから独立して行われることができる。
【００６８】
好ましくは、マルチコプタの運動を表す前記データは、前記マルチコプタの少なくとも１つの配向、前記マルチコプタの角速度、前記マルチコプタの前記エフェクタの動作状態、前記マルチコプタの加速度、前記マルチコプタの並進運動速度又は前記マルチコプタの位置のうち少なくとも１つを含んでいる。好ましくは、前記マルチコプタの物理的な特性を表す前記データは、慣性モーメント、質量、次元、流体力学的特性又はエフェクタ特性のうち少なくとも１つを含んでいる。物理的な特性を表す前記データは、好ましくはメモリユニットに格納される。前記計算は、好ましくはマイクロコントローラにおいて実行される。
【００６９】
好ましくは、前記プライマリ軸の配向が前記目標配向へ収束されるときに、それぞれが、故障を有さない前記１つ又はこれより多くのエフェクタによってまとめて発生される推力の少なくとも２０％寄与するように、前記制御ユニットが、故障を有さない前記１つ又はこれより多くのエフェクタを制御するよう構成され得る。好ましくは、これら１つ又はこれより多くのエフェクタは、前記故障により影響を受けないエフェクタである。
【００７０】
前記プライマリ軸の配向が前記目標配向へ収束されるときに、それぞれが、故障を有さない前記１つ又はこれより多くのエフェクタによってまとめて発生される推力の少なくとも３０％寄与するように、前記制御ユニットが、故障を有さない前記１つ又はこれより多くのエフェクタを制御するよう構成されることが可能である。好ましくは、これら１つ又はこれより多くのエフェクタは、前記故障により影響を受けないエフェクタである。
【００７１】
好ましくは、前記推定ユニットが、前記エフェクタのうち少なくとも１つによって発生されるトルク及び／又は推進力を２０％より大きく減少させる故障を識別するよう動作可能である。
【００７２】
好ましくは、前記推定ユニットが、前記エフェクタのうち少なくとも１つによって発生されるトルク及び／又は推進力を５０％より大きく減少させる故障を識別するよう動作可能である。
【００７３】
好ましくは、前記推定ユニットが、前記エフェクタのうち少なくとも１つによって発生されるトルク及び／又は推進力を８０％より大きく減少させる故障を識別するよう動作可能である。
【００７４】
好ましくは、前記推定ユニットが、前記エフェクタのうち少なくとも１つによって発生されるトルク及び／又は推進力を完全にロスさせる故障を識別するよう動作可能である。
【００７５】
好ましくは、推定ユニットは、マイクロプロセッサを用いるものである。
【００７６】
好ましくは、推定ユニットは、（ａ）エフェクタの複数の変数のうち１つ又はこれより多くの変数のうち少なくとも１つを表すデータに基づき、ここでは、エフェクタの複数の変数は回転速度、電圧、電流、燃料流量、モータトルク、質量流量、動力のうち少なくとも１つを含んでおり、又は（ｂ）前記マルチコプタの配向、前記マルチコプタの角速度、前記マルチコプタの動作状態、前記マルチコプタの加速度、前記マルチコプタの並進運動速度又は前記マルチコプタの位置を含む前記マルチコプタの運動を表すデータに基づき、故障を識別する。
【００７７】
前記プライマリ軸の周りに前記マルチコプタを毎秒０．５回転より大きな速度で回転させるために前記プライマリ軸に沿ったトルクを前記１つ又はこれより多くのエフェクタがまとめて発生するよう、前記エフェクタのうち少なくとも１つのエフェクタを制御可能に前記制御ユニットが更に構成され得る。
【００７８】
好ましくは、前記プライマリ軸の周りに前記マルチコプタを毎秒１回転より大きな速度で回転させるために前記プライマリ軸に沿ったトルクを前記１つ又はこれより多くのエフェクタがまとめて発生するよう、前記エフェクタのうち少なくとも１つのエフェクタを制御可能に前記制御ユニットが構成されている。
【００７９】
好ましくは、プライマリ軸の配向が目標配向へ収束されるときに、前記プライマリ軸に沿った前記トルクにより前記マルチコプタが連続的に回転され得る。
【００８０】
好ましくは、前記毎秒０．５又は１回転はあらかじめ規定された時間間隔における平均回転速度である。
【００８１】
前記制御ユニットが、更に、前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタのそれぞれの複数の変数のうち単一変数を制御するよう構成されており、前記複数の変数が、
・回転速度と、
・電圧と、
・電流と、
・燃料流量と、
・モータトルクと、
・質量流量と、
・動力と
のうち少なくとも１つを含み得る。
【００８２】
好ましくは、エフェクタによって発生されるトルク及び／又は推進力に影響を与える故障を受けた後のマルチコプタは、もはや前記故障によって影響されない３つを超えないエフェクタを含んでいる。
【００８３】
好ましくは、エフェクタによって発生されるトルク及び／又は推進力に影響を与える故障を受けた後のマルチコプタは、もはや前記故障によって影響されない２つを超えないエフェクタを含んでいる。
【００８４】
好ましくは、エフェクタによって発生されるトルク及び／又は推進力に影響を与える故障を受けた後のマルチコプタは、もはや前記故障によって影響されない１つを超えないエフェクタを含んでいる。
【００８５】
前記制御ユニットが、更に（ａ）前記マルチコプタの目標加速度を定義し、（ｂ）前記マルチコプタのための前記プライマリ軸の前記目標配向を計算するために、前記目標加速度を使用し、（ｃ）前記１つ又はこれより多くのエフェクタによってまとめて発生される推力が前記目標加速度で前記マルチコプタを加速するよう更に前記少なくとも４つのエフェクタが制御されるように、前記制御信号を送信するために構成されている。
【００８６】
好ましくは、前記目標加速度は、実行時に自由に選択されることができ、好ましくは目標加速度の範囲又は特定されたリストから選択される。
【００８７】
好ましくは、前記制御ユニットが、更に、方程式
【００８８】
【数４】
2018083625.tif 000006
を用いて前記目標配向を計算することで前記マルチコプタの前記目標加速度を用いる前記プライマリ軸の前記目標配向を計算するよう構成されており、ベクトルａが前記目標加速度を表し、ベクトルｇが重力加速度を表し、ベクトル
【００８９】
【数５】
2018083625.tif 000007
が前記目標配向を表し、｜｜−｜｜がベクトルのユークリッドノルムを表す。換言すれば、前記プライマリ軸の目標配向は、前記目標加速度を等しくするベクトルと重力加速度のベクトルの差をこの差のユークリッドノルムで除したものとして計算され得る。
【００９０】
前記制御ユニットが、更に、（ａ）前記目標推進力の大きさを規定し、（ｂ）前記プライマリ軸に沿った前記１つ又はこれより多くのエフェクタによって個々に発生された推進力のそれぞれの和の大きさが前記目標推進力の大きさと等しくなるよう前記制御信号を送信するように構成されている。好ましくは、これら推進力は、前記故障によって影響を受けていないエフェクタによって発生される。
【００９１】
前記制御ユニットが、更に、（ａ）前記目標推進力の大きさを規定し、（ｂ）あらかじめ規定された期間にわたって平均化された、前記プライマリ軸に沿った前記１つ又はこれより多くのエフェクタによって個々に発生された推進力のそれぞれの和の大きさが前記目標推進力の大きさと等しくなるよう前記制御信号を送信するように構成されている。好ましくは、これら推進力は、前記故障によって影響を受けていないエフェクタによって発生される。
【００９２】
好ましくは、目標推進力の大きさを、実行時間において自由に、好ましくは目標推進力の大きさの範囲又は所定のリストから選択することができる。
【００９３】
前記制御ユニットが、更に、（ａ）前記目標加速度を規定し、（ｂ）
ｆｄｅｓ＝ｍ｜｜ａ−ｇ｜｜
としての前記目標推進力を計算することで、前記マルチコプタの前記目標加速度を用いて前記目標推進力の大きさを計算するよう構成され、ｆｄｅｓは目標推進力の大きさを表し、｜｜−｜｜はベクトルのユークリッドノルムを表し、ａは前記目標加速度を表し、ｇは重力による加速度を表し、ｍは前記マルチコプタの質量を表す。換言すれば、目標推進力の大きさは、マルチコプタの質量に前記目標加速度を等しくするベクトルと重力加速度のベクトルの差のユークリッドノルムを乗じることで計算され得る。
【００９４】
前記マルチコプタが、更に、前記センシングユニットに操作可能に接続されたセンサを備え、（ａ）前記マルチコプタの運動を検出し、（ｂ）検出された前記マルチコプタの運動を表すデータを前記センシングユニットへ供給するように構成されている。好ましくは、センサは、慣性センサ、距離センサ又はレートセンサのグループに属するものである。好ましくは、センサは、加速度計、ジャイロスコープ、磁力計、カメラ、オプティカルフローセンサ、レーザ又はソナー測距計、レーダ、気圧計、温度計、湿度計、バンパー、化学センサ、電磁センサ、エアフローセンサ又は相対対気速度センサ、超音波センサ、マイクロホン、無線センサ又は他の高度、距離若しくは距離センサ又は赤外線センサに属する。
【００９５】
前記マルチコプタが、更に、前記センシングユニットに操作可能に接続されたセンサを備え、前記エフェクタのうち少なくとも１つのエフェクタの動作を検出し、前記エフェクタのうち少なくとも１つのエフェクタの検出された動作を表すデータを前記センシングユニットへ供給するように構成され得る。
【００９６】
好ましくは、センサは、エフェクタの複数のうち少なくとも１つの単一変数を用いるものであり、エフェクタの複数の変数は、回転速度、電圧、電流、燃料流量、モータトルク、質量流量、動力のうち少なくとも１つを含む。
【００９７】
前記制御ユニットが、前記本体及び前記少なくとも４つのエフェクタから機械的に独立しているとともに、ワイヤレス接続によって前記マルチコプタに動作可能に接続され得る。このようなワイヤレス接続は、Ｗｉｆｉ接続、Ｂｌｕｅｔｏｏｔｈ、Ｚｉｇｂｅｅ又は無線接続の他のタイプで構成され得る。これに代えて、接続は、例えば赤外線伝送である光接続で構成されることも可能である。
【００９８】
好ましくは、機械的に独立した前記制御ユニットが、ユーザの手で保持することができるよう、及び前記ワイヤレス接続によって前記マルチコプタの前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタの制御に使用可能なユーザインタフェースを介してユーザからの入力を受信するよう構成されたハウジング内に収容されている。このような手持ち式の装置は、スマートホン又はタブレットコンピュータ装置の形態であり得るか、又は伝統的な趣味に熱中する人のリモートコントローラに類似の形態であってもよい。
【００９９】
本発明の更なる態様によれば、マルチコプタが、（１）本体と、（２）故障を受けていない場合にそれぞれ、該本体に取り付けられ、前記故障を受けない場合に前記マルチコプタを飛行させることが可能なトルク及び推進力を発生する少なくとも４つのエフェクタとを備え、前記制御ユニットが、飛行中に故障を受ける前記マルチコプタを動作させるための方法を実行可能に構成された飛行モジュールを備えた、マルチコプタのための制御ユニットが提供される。この方法は、前記エフェクタによって発生されるトルク及び／又は推進力に影響を与える前記故障を識別するステップを含むことができ、前記故障の前記識別に応じて、（１）あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定を計算するステップであって、前記プライマリ軸が、飛行時にマルチコプタがその周りに回転する軸であり、（２）前記マルチコプタの角速度の推定を計算するステップと、（３）前記あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定と、前記マルチコプタの角速度の推定とに基づいて前記少なくとも４つのエフェクタのうちの１つ又はこれにより多くを制御するステップを含む。前記少なくとも４つのエフェクタのうちの１つ又はこれより多くを制御するステップは、（ａ）前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルクと、前記プライマリ軸に対して垂直なトルクをまとめて発生するように、このとき、（ｉ）前記プライマリ軸に沿ったトルクが前記プライマリ軸周りにマルチコプタを回転させ、（ｉｉ）前記プライマリ軸に対して垂直なトルクが、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関して目標配向へ収束するようにマルチコプタを動かし、（ｂ）前記１つ又はこれより多くのエフェクタが前記プライマリ軸に沿った推進力を個々に発生するように構成されている。
【０１００】
好ましくは、制御ユニットの飛行モジュールは、（１）複数のセンサ及び／又はユーザからのデータを受信するための入力ユニットと、（２）前記マルチコプタの運動及び／又は前記エフェクタのうち少なくとも１つの動作を表すデータを測定するためのセンシングユニットと、（３）前記エフェクタのうち１つ又はこれより多くによって発生されるトルク及び／又は推進力に影響を与える故障を識別するための前記センシングユニット及び／又は前記入力ユニットに動作可能に接続された推定ユニットと、（４）制御ユニットとを備えている。好ましくは、この制御ユニットは、該推定ユニットに動作可能に接続されるように構成され、
・あらかじめ規定された基準系に関して前記本体のプライマリ軸の配向の推定を計算するように構成され、このとき、前記プライマリ軸が、制御ユニットの制御の下での飛行時にその周りに前記マルチコプタが回転する軸であり、
・（ａ）前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルク及び前記プライマリ軸に対して垂直なトルクをまとめて発生させるように、このとき、（ｉ）前記プライマリ軸に沿ったトルクにより前記マルチコプタが前記プライマリ軸周りに回転し、（ｉｉ）前記プライマリ軸に対して垂直なトルクにより、前記プライマリ軸の配向があらかじめ規定された基準系に関する目標配向へ収束するよう前記マルチコプタが移動し、（ｂ）前記１つ又はこれより多くのエフェクタのそれぞれが個々に前記プライマリ軸に沿った推進力を発生するように構成されている。
【０１０１】
制御ユニットは前記推定ユニットに動作可能に接続されることができ、前記推定ユニットは、前記マルチコプタの運動を表すデータを提供するとともに、このデータを前記制御ユニットへ提供し、前記制御ユニットは、前記推定ユニットの結果に基づいて前記１つ又はこれより多くのエフェクタの制御を実行する。
【０１０２】
制御ユニットは、更に、前記本体のプライマリ軸を計算するよう構成されており、（ａ）前記プライマリ軸が、前記制御ユニットの制御の下で飛行するときにマルチコプタが回転する軸であり、（ｂ）前記１つ又はこれより多くのエフェクタのそれぞれが前記プライマリ軸に沿った推進力を発生させ、前記プライマリ軸の計算が、前記マルチコプタの運動を表すデータと、前記マルチコプタの物理的な特性を表すデータとに依存して行われる。
【０１０３】
好ましくは、前記マルチコプタの運動を表すデータは、前記マルチコプタの配向、前記マルチコプタの角速度、前記マルチコプタの前記エフェクタの動作状況、前記マルチコプタの加速度、前記マルチコプタの並進運動速度又は前記マルチコプタの位置のうち少なくとも１つを含む。
【０１０４】
好ましくは、前記マルチコプタの物理的な特性を表すデータは、慣性モーメント、質量、次元、流体力学的な特性、エフェクタの特性のうち少なくとも１つを含んでいる。物理的な特性を表す前記データは、好ましくはメモリユニットに格納されている。前記計算は、好ましくはマイクロコントローラにおいて実行される。
【０１０５】
本発明の更に他の態様によれば、マルチコプタのための前記制御ユニットの使用が提供され、このマルチコプタが、（１）本体と、（２）故障を受けていない場合にそれぞれ、該本体に取り付けられ、前記故障を受けない場合に前記マルチコプタを飛行させることが可能なトルク及び推進力を発生する少なくとも４つのエフェクタとを備え、前記制御ユニットが、飛行中に故障を受ける前記マルチコプタを動作させるための方法を実行可能に構成された飛行モジュールを備えた、マルチコプタのための制御ユニットが提供される。この方法は、前記エフェクタによって発生されるトルク及び／又は推進力に影響を与える前記故障を識別するステップを含むことができ、前記故障の前記識別に応じて、（１）あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定を計算するステップであって、前記プライマリ軸が、飛行時にマルチコプタがその周りに回転する軸であり、（２）前記マルチコプタの角速度の推定を計算するステップと、（３）前記あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定と、前記マルチコプタの角速度の推定とに基づいて前記少なくとも４つのエフェクタのうちの１つ又はこれにより多くを制御するステップを含む。前記少なくとも４つのエフェクタのうちの１つ又はこれより多くを制御するステップは、（ａ）前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルクと、前記プライマリ軸に対して垂直なトルクをまとめて発生するように、このとき、（ｉ）前記プライマリ軸に沿ったトルクが前記プライマリ軸周りにマルチコプタを回転させ、（ｉｉ）前記プライマリ軸に対して垂直なトルクが、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関して目標配向へ収束するようにマルチコプタを動かし、（ｂ）前記１つ又はこれより多くのエフェクタが前記プライマリ軸に沿った推進力を個々に発生するように構成されている。
【０１０６】
好ましくは、制御ユニットの飛行モジュールは、（１）複数のセンサ及び／又はユーザからのデータを受信するための入力ユニットと、（２）前記マルチコプタの運動及び／又は前記エフェクタのうち少なくとも１つの動作を表すデータを測定するためのセンシングユニットと、（３）前記エフェクタのうち１つ又はこれより多くによって発生されるトルク及び／又は推進力に影響を与える故障を識別するための前記センシングユニット及び／又は前記入力ユニットに動作可能に接続された推定ユニットと、（４）制御ユニットとを備えている。好ましくは、この制御ユニットは、該推定ユニットに動作可能に接続されるように構成され、
・あらかじめ規定された基準系に関して前記本体のプライマリ軸の配向の推定を計算するように構成され、このとき、前記プライマリ軸が、制御ユニットの制御の下での飛行時にその周りに前記マルチコプタが回転する軸であり、
・（ａ）前記１つ又はこれより多くのエフェクタが、前記プライマリ軸に沿ったトルク及び前記プライマリ軸に対して垂直なトルクをまとめて発生させるように、このとき、（ｉ）前記プライマリ軸に沿ったトルクにより前記マルチコプタが前記プライマリ軸周りに回転し、（ｉｉ）前記プライマリ軸に対して垂直なトルクにより、前記プライマリ軸の配向があらかじめ規定された基準系に関する目標配向へ収束するよう前記マルチコプタが移動し、（ｂ）前記１つ又はこれより多くのエフェクタのそれぞれが個々に前記プライマリ軸に沿った推進力を発生するように構成されている。好ましくは、エフェクタのうちの１つによって発生されるトルク及び／又は推進力に影響を与える故障により、前記トルク及び／又は推進力が２０％以上、５０％以上、８０％以上又は１００％低減される。
【０１０７】
本発明の他の技術的な利点は、以下の図面、説明及び請求項から当業者にとって容易に明白である。さらに、上記において特有の利点が列挙された一方、様々な実施例は、列挙された利点の全て、いくつかを含むか、又は含まないことが可能である。
【０１０８】
本発明のより完全な理解のために、以下の説明及び添付の図面が参照される。
【図面の簡単な説明】
【０１０９】
【図１】開示された方法を用いる制御された飛行が可能である、１つのエフェクタを浮揚とする故障を受けるクアッドコプタを示す本発明の第１の好ましい実施例を概略的に示す図である。
【図２】従来技術において知られた故障のないクアッドコプタを概略的に示す図である。
【図３】飛行モジュールとその部分のブロック図である。
【図４】２つのロータ故障を受けるクアッドコプタを概略的に示すとともに、制御方法の導出を説明するために用いられるトルク及び力を示す図である。
【図５】本発明の適用性を図示するための、クアッドコプタにとっての一般的なエフェクタ故障についての表である。
【図６】本発明と共に使用可能な模範的な制御構成を説明するためのブロック図である。
【図７】様々なエフェクタ故障を受ける３つの代替的なマルチコプタの概略を示す図であり、それぞれ結果として生じる構成が開示された制御方法を用いてコントロールされ得る。
【図８】エフェクタの故障時に適切な制御方法を決定するためのフローチャートである。
【図９】制御方法の導出を説明するために用いられる、１つの故障したエフェクタを有するクアッドコプタを概略的に示す図である。
【図１０】制御方法の導出を説明するために用いられる、３つの故障したエフェクタを有するクアッドコプタを概略的に示す図である。
【発明を実施するための形態】
【０１１０】
開示された発明は、１つ以上のエフェクタに影響を及ぼす故障を起こすマルチコプタの運動の制御に関するものである。マルチコプタは、一般的に、推進力と、マルチコプタに作用するトルクとの両方を発生させる複数のエフェクタを備えている。これらエフェクタは、一般に、マルチコプタの本体部に関して固定された特徴的な駆動軸（一般的には推進力の方向と同一）を有すること、及び推進力を制御する単一変数を有することによって特徴付けられている。例えば、マルチコプタのような浮揚可能な航空用の飛翔体において用いられる固定ピッチプロペラは、推進力及びこの飛翔体に作用するトルクを発生させるとともに、一般的にモータの固定駆動軸に直接固定されているとともに、単一変数を用いて指令される。マルチコプタのために、この単一変数は、一般にモータの所望の相対速度と、したがってエフェクタの推進力を指令するものである。一般に、マルチコプタはブラシレスモータを用い、このブラシレスモータは、一般に、所望のロータ速度を達成するのに必要な振幅、波形及び周波数にこの単一変数を変換するモータコントローラを用いるものである。このようなモータコントローラは、一般に双方向性の３つの出力（例えば周波数制御された三相の出力）を含んでおり、これら出力は、論理回路によって制御されるが、高い性能又は他の所望の特性を得るために、追加のセンサ及び電子機器を伴うより多くの複合的な実装を有することが可能である。浮揚可能な飛翔体は、空間における目標点にほぼ達すことができ、この目標点に維持され得る空気より重い飛翔体である。
【０１１１】
本発明の定義付け特性は、マルチコプタの本体部に関して固定された座標系において定義され、重心を通るプライマリ軸１３０周りのマルチコプタの連続的な回転に帰着する開示された制御体系である。マルチコプタにおいては、駆動軸に沿って力を加えることに加えて、マルチコプタの重心に作用するトルクを発生しプライマリ軸１３０に対して垂直な成分を有するように、複数のエフェクタが配置されている。
【０１１２】
プライマリ軸１３０周りのマルチコプタのこの回転を達成し、維持するために、エフェクタは、更にプライマリ軸１３０の方向における成分を有するトルクを発生させるように構成されることが可能である。固定ピッチプロペラのために、トルク成分は、プロペラの駆動軸をプライマリ軸１３０へ配置すること、並びにプロペラの回転に対抗する流体力学的な反応ドラグトルクを用いること（及びしたがってプライマリ軸１３０の方向に作用すること）によって達成され得る。
【０１１３】
本発明においては、エフェクタに影響を及ぼす故障とは、エフェクタにより発生されるトルク及び／又は推進力の一部若しくは完全な損失を意味する。一般に、この損失は、名目上の推力の２０〜１００％の範囲にある。全体として、マルチコプタは、比較的単純であり、それゆえ比較的安全な飛翔体である（航空機における最良のシステムは、このシステムを有さないものである。なぜなら決して故障を起こさないためである）。しかしながら、マルチコプタの非常に大きな流行により、多数のマルチコプタの墜落が文献に記録されている。マルチコプタの全ての墜落の大部分は、障害物へのマルチコプタの衝突に帰着するパイロットのエラーのほかにエフェクタの故障によるものであり、マルチコプタは、一般的に制御された方法における推力の発生においてエフェクタが故障を起こさない限り空中に維持される。したがって、本発明は、障害物との衝突を伴ういくつかのものを含むマルチコプタの全ての墜落の大部分の結果を克服又は制限することが可能である。文献における最も一般的なマルチコプタの故障は、
１．パイロットのエラー、風又は乱気流による障害物への衝突による故障。例えば、検査動作中に突然の突風によりマルチコプタが橋へ押され、破壊されたプロペラによるエフェクタの故障につながり、つづいて、制御の破滅的なロス及び墜落へつながる。
２．マルチコプタの配線の故障。非常によくある故障は、
・振動によるモータコネクタの脱落
・はんだ線の剥離
・弛み線のプロペラによる切断
・部分的なモータの装着故障によるワイヤの剥離（締結ネジの振動による脱落又はアセンブリの材料疲労）
・不十分なワイヤサイズ及びその結果として生じるワイヤ又ははんだ付け点の過熱／溶融を含む。
３．マルチコプタのプロペラ付属物、モータ付属物又はフレームの故障。最もよくある故障は、
・ネジ及びボルトの弛み（振動による弛み、アセンブリエラー、磨滅、材料疲労）
・誤った配列において取り付けられたプロペラ（半時計回り（「引き」プロペラとも呼ばれることがある）及び時計回りのプロペラ（「押し」プロペラとも呼ばれることがある））
・取付ネジの過剰な締付
・取付ネジの締付不足
を含む。
４．全てのモータの適切なバランス、全てのプロペラの適切なバランスについての故障、及びモータのコレット及びシャフトによる故障。このカテゴリーは、振動及びこれつづく部品、特により大きなマルチコプタにおける部品の脱落の主な原因である。
５．マルチコプタのモータの故障。最もよくある故障は、モータの過負荷（例えば大きすぎるプロペラ）及びこれにつづく過熱又は塵埃若しくは砂における動作に起因するものである。
６．マルチコプタの電気部品又は電子部品の故障。このカテゴリーにおける最もよくある故障は、雨、霧又は高湿度のような湿った状況での飛行である。
７．マルチコプタの飛行ソフトウェアの故障。例えば、飛行制御コンピュータの不適切なプログラミング又は不適切なモータが航空機の重量に対して増大する。
８．不適切なリモート制御構成、特に不適切に構成されたトランスミッタチャネルに起因する故障又は基地局と受信機の間の十分強い信号を確認することについての故障。
９．干渉に起因する故障であり、最もよくある干渉は、電子式速度制御（「モータコントローラ」とも呼ばれる）とマルチコプタの受信機の間の干渉である。
１０．間違った有効荷重による故障。
１１．センサキャリブレーションの不足又は欠陥による故障。
１２．材料疲労（例えば疲労亀裂又は疲労破壊）による故障。
【０１１４】
上記の故障の全てがエフェクタの故障をもたらすとはいえ、多くは本発明を用いることで制御され得る飛行設定に帰着する。特に、上述の故障の１つにつづいて、本発明は、推力のロスにもかかわらず、マルチコプタがプライマリ軸１３０周りの実質的な連続した回転へ移行するように残りのエフェクタを制御すること、及びこのプライマリ軸１３０を制御された降下及び着陸を可能とする好ましい方向へ向けることを達成するか、又は維持するためのここに開示された方法を用いることでマルチコプタの墜落を阻止することを可能とするものである。
【０１１５】
故障が生じたことを検出するために様々な方法を用いることができる。これら例は、マルチコプタを監視し、故障が認識されたときにマルチコプタへ信号を送信することが可能なパイロットを有することであり、この故障は、マルチコプタを制御するためにこのマルチコプタが本発明を用いる原因となる。この代わりに、検出は、例えばモデルに基づく、測定データを監視するマルチコプタにおける観測器を有すること、及びエラーが確率的に観測されたこと（例えばそれぞれ異なる故障モードを表すカルマンフィルタのバンクを使用すること）によって自動的であることが可能である。スライディングモード観測器、票決を基礎とするアルゴリズム、パリティ空間アプローチ及びパラメータ同定を用いることも可能である。例えばマルチコプタのモータの回転速度を監視すること、又はマルチコプタのモータがどのくらいの電流を引き出すかを監視することで、故障を直接検出することも可能である。
【０１１６】
いくつかの故障検出方法は、故障が発生した後ある時間のみ故障を検出することができ、これは、故障が認識されたときにマルチコプタが意図した状態とは異なる状態にあり得ることを意味する。障害物への衝突のようなある事象は、所望の状態とは異なる状態へもたらす傾向がある。それにもかかわらず、開示された発明は、任意の初期状態からマルチコプタを回復させることが可能である。特定のマルチコプタの構成（例えば質量、故障による影響を受けない残りのエフェクタなど）に依存して、マルチコプタは、故障後に浮揚へ転じることが可能であるか、又は空間を自由に移動可能となる。これに代えて、位置の制御の代わりに、開示された発明は、（例えば）マルチコプタが好ましい方法で地面へ到達するように、故障の後にマルチコプタを単に再配向するように用いられることが可能である。
【０１１７】
本発明は、パイロットのエラーの重大性を低減する可能性も提供することが可能である。例えば、クアッドコプタのパイロットが偶然にクアッドコプタを構造物に衝突させてしまい、これによってプロペラのうち１つが損傷すると、自動化されたシステムによって、故障が起きたことと、マルチコプタのエフェクタのいくつかが故障の影響を受けることが検出される。そして、このシステムは、自動的に、マルチコプタを浮揚させるため、又はマルチコプタを地上に軟着陸させるための使用可能なセンサを用いる内部のオートパイロットに関与することができる。
【０１１８】
図１には、３つの残りの動作中のエフェクタ１０２と、故障により使用不能となった１つのエフェクタ１００を有するクアッドコプタについての好ましい実施例の例示的な配置が示されており、各エフェクタは、モータ１０６によって駆動される固定ピッチプロペラ１０４の形態となっている。マルチコプタ１４０は、複数のエフェクタ１０２と、機械的な構造部１１４を有する本体部１１２とによって構成されている。機械的な構造部１１４及びマルチコプタ本体部１１２も、複数のセンサ、ケーブル配線、電子機器及びマルチコプタのその他の構成要素（いずれも不図示）を収容している。マルチコプタの重心１２０は、二色の円でマークされている。プロペラ１０４は、プライマリ軸１３０周りのマルチコプタ本体部１１２全体の連続的な回転１１８をもたらすプロペラ１０４の流体力学的な反応ドラグトルクによって、回転駆動軸１１０周りに回転する。動作中のプロペラのうち２つは一方向１０８ｂへ回転する一方、３番目のものは逆方向１０８ａへ回転する。従来技術において知られるように標準的なマルチコプタ制御方法を用いて制御不能であっても、開示された発明は、プライマリ軸１３０周りに回転を生じさせ、このプライマリ軸の方向をあらかじめ設定された基準系１６０内で制御することによってマルチコプタをまだ制御するために応用されることができる。この図には、プライマリ軸の目標方向１５０と、あらかじめ設定された基準系１６０も示されている。エフェクタ１０２は、便宜上個々に１つめ１０２ａ、２つ目１０２ｂ、３つ目１０２ｃ、４つ目１０２ｄと番号が付されている。
【０１１９】
プライマリ軸の方向は、一般に、プライマリ軸の方向１５０の推定の算出が可能なアルゴリズムを用いるように設定されている。類似のように、マルチコプタの角速度の推定が計算され得る。この推定の計算のためのアルゴリズムの例は、カルマンフィルタ及びルーエンバーガー観測器を含んでいる。空間中のマルチコプタの位置は、一般にあらかじめ設定された基準系１６０内で規定され、いくつかの固定点に言及される、位置及び並進運動速度によって記述される。あらかじめ設定された基準系１６０の例は、いくつかのランドマークに固定された原点を有する「北東上方の」系である。マルチコプタの位置の推定及び並進運動速度の推定は、方向及び角速度のアルゴリズムと類似のアルゴリズムによって計算され得る。
【０１２０】
飛翔体の運動は、通常、慣性基準系を参照することによって記述される。地球のそれ自体の軸線周りの回転及び太陽周りの回転並びに銀河を通る態様の回転を無視することで、地球に固定された系を慣性基準系についての近似として用いることが可能である。したがって、地球に固定された系は、第１の軸点を西から東へ、第２の軸点を南から北へ、最後の軸点を地球の中心から外側へ設定することで構成され得る。このような系は、低速で短距離を移動する物体についての良好な類似であることが証明されている。より良好な正確性のために、系は、太陽の重心から黄道面（地球の重心が太陽の周りを回るように移動する面）に対して垂直な方向へ指向する１つの方向と、おひつじ座（又は春分点）の第１の点へ指向する第２の方向と、右手の法則からつづく第３の方向とによって構成され得る。
【０１２１】
マルチコプタの操作者は、マルチコプタのための目標加速度、目標並進運動速度又は目標位置へ変換され得るよりハイレベルの目標をしばしば有する。さらに、いくつかの目標は、目標の推進力の大きさへ変換されることができ、ここで、これはマルチコプタのエフェクタによって発生される所望の力の総和である。
【０１２２】
図２には強固に取り付けられた２組の固定ピッチプロペラを有する従来技術において知られた故障のないクアッドコプタが示されており、１つの組１０８ａは時計回りに回転し、他方の組１０８ｂは反時計回りに回転する。一般的に、プロペラは、２つ、３つ又は４つのブレードを有するとともに、「回転翼」又は「ロータ」と呼ばれることもあり、これらを動かすために用いられるモータの全ての回転部分も含むように定義される。マルチコプタは、複数のプロペラを有する浮揚可能なマルチコプタである。典型的な配置は、４つ、６つ又は８つのプロペラを用いるものであり、これらプロペラは、それぞれクアッドコプタ、ヘキサコプタ及びオクトコプタと呼ばれ、従来技術においてよく知られているとともに幅広く使用されている。しかしながら、多くの設定（例えば、傾斜しているか、又は逆にされた軸と同様に配列され、個々に反転型に配置され、さらされるか、配管又は保護シュラウド内に入れられている）において１６個又はこれより多くのプロペラを有する多くのバリエーションが用いられている。マルチコプタは一般に固定ピッチブレードを用いており、そのロータピッチは、機械的な簡易性のために、ブレードが回転するように変化しない。この機械的な簡易性と、位置（浮揚）を維持するための高い機敏性及び能力と組み合わされた、得られる構造上の簡易さは、マルチコプタを多くの空中での応用についての選択のプラットフォームとするものである。
【０１２３】
マルチコプタの運動は、一般的には、推力及びトルクを変更するための各プロペラの相対速度を変化させるためのマルチコプタのエフェクタへ送信させる制御信号によって制御される。各プロペラの相対速度は、一般的には単一変数を用いるように設定されており、この単一変数は、モータコントローラによって制御信号へ変換される。４つのプロペラの推力（「総推力」又は「集合推力」とも呼ばれることがある）の方向における並進運動は、目標とする力の和を達成するためのプロペラのそれぞれの個々の垂直を変更することにより制御される。集合推力から独立して、総推力の方向周りの回転（通常「ヨー」と呼ばれる）は、他のプロペラのそれぞれの減速中にプロペラが時計回り又は反時計回りにスピンアップすることにより制御され、これにより、時計回りに回転するプロペラと反時計回りに回転するプロペラの間のドラグ効果によって生じるトルクを発生させる。上記の事項とは無関係に、他の軸周りの回転は、ヨー及び所望の総推力を制御するための上述の独立した関係を維持しつつ反対側のプロペラの間の推力差を用いて制御される。全体として、したがって、マルチコプタの４つの独立した運動特性（「自由度」）、すなわち１つの並進と３つの回転は、プロペラによって発生する推力を適切に変調することで独立して制御される。いくつかの比較的に重要でないバリエーションについては、この操作の原理は、一般に共通に用いられるマルチコプタ飛翔体へ応用される。そして、十分な並進運動制御は、力の和を所望の並進運動の方向に配向することで達成される。
【０１２４】
図３には開示された制御スキームの一部として用いることが可能なマルチコプタ用の飛行モジュールの例が示されている。マルチコプタにとって、このような飛行モジュールは、一般にオンボードで実行されるか、又はオンボード及びオフボード（例えば、オンボードモータに直接結合された制御ユニット３０６を有し、また入力ユニット３０４を介してオフボードセンサからの入力をカメラトラッキングシステムのようなオフボードセンシングユニット３１０を介して受ける）の両方で実行される。飛行モジュールは、一般に飛翔体入力（例えばユーザコマンド、センサ信号）を処理するとともに、出力（例えばエフェクタ３１４のための制御信号）を演算するために用いられる。例えば、これらは、他のエフェクタ又はアクチュエータに対するのと同様に飛行エフェクタ（例えばプロペラ１０４）のための制御出力を発生させることによるアクティブな自己安定化を可能とするものである。マルチコプタにおいては、複数の飛行モジュールが、マルチコプタへの直接的な視線方向を有する操作者によるリモート制御を含む様々な動作モードにおいて用いられるか、パイロットへのセンサデータの中継及びマルチコプタへ戻る制御信号の中継によりリモート制御されるか（「テレプレゼンス」とも呼ばれることがある）、又は部分的に若しくは完全に自発的な操作モードにおいて用いられる。
【０１２５】
飛行モジュールは、一般に、ユーザ、基地局、コマンドセンターからの目標若しくはコマンドの形態のハイレベルの入力を受信するか、又は入力ユニット３０４を介してハイレベルの制御アルゴリズムを受信し、制御ユニット３０６、推定ユニット３０８及びセンシングユニット３１０へ引き渡す。制御ユニット３０６は、一般に、マルチコプタのエフェクタに対する制御信号を発生させるものである。推定ユニット３０８は、一般に、入力ユニット３０４、センシングユニット３１０及びメモリユニット３１２からのデータを推定するために用いられる。このようなデータは、相対位置及び絶対位置、特にＧＰＳセンサ、視覚による走行距離計測法／ＳＬＡＭ、回帰反射型測位システム、レーザ測距器、Ｗｉｆｉ測位システム、気圧高度計及び昇降計又は超音波センサ（いずれも不図示）と同様のユーザコマンド又はハイレベルのコマンドの典型であり得る。センサデータは、センサユニット３１０を用いて収集及び前処理されるか、又はメモリユニット３１２に格納される。処理された情報の典型的な例は、加速度計、ジャイロスコープ、磁力計、カメラ、オプティカルフローセンサ、レーザ又はソナー測距計、レーダ、気圧計、温度計、湿度計、バンパー、化学センサ、電磁センサ、エアフローセンサ又はマイクロホン（いずれも不図示）のようなセンサから受信されるものである。メモリユニット３１２は、一般にデータの格納のために用いられる。例えば、これらを、マルチコプタの特性と同様に過去のセンサ信号、動作状態又はユーザコマンドにおけるデータの格納に用いることが可能である。
【０１２６】
上記全てのユニットは、単一回路基板、シングルボードコンピュータ又は単一マイクロコントローラにおいて実装されることが可能である。
【０１２７】
用途に応じて、飛行モジュールは、図３に示された単純なブロック図よりもはるかに複雑であることができるとともに、特に、単一ブロック３０２又は多重ブロックに配置された複数の入力ユニット３０４、制御ユニット３０６、推定ユニット３０８、センシングユニット３１０及びメモリユニット３１２を備えることが可能である。
【０１２８】
図４（Ａ）には、故障１００により機能しない対向する２つのエフェクタと、残りの、同様に回転１０８ｂする動作中の２つのエフェクタとを有するクアッドコプタが示されている。浮揚動作中及び本発明の使用中には、力及びトルクがプライマリ軸１３０周りのマルチコプタ本体の連続的な回転を発生させる。座標系は、マルチコプタの本体に関して固定され、方向ｘ、ｙ及びｚで構成され、ここで、ｚは、このケースでは、プライマリ軸１３０と一致するように選択されており、ｘは、ｚに対して垂直に、かつ、重心１２０から第１のエフェクタへ向いている。ｙは、右手の法則に従う。マルチコプタについての３つの瞬間回転率ｐ、ｑ、ｒは、それぞれマルチコプタの本体に固定された軸線ｘ、ｙ、ｚ周りに定義されている。
【０１２９】
図示のように、マルチコプタ本体は、瞬間角速度ωＢを有しており、この瞬間角速度は、名目上プライマリ軸１３０と一致しているものの、補正動作中又は指令による動作中には方向及び大きさにおいてそれることが可能である。
【０１３０】
いくつかの慣性座標系に関するこの本体に固定された系の回転は、微分方程式によって支配されて、回転行列Ｒを用いて、
【０１３１】
【数６】
2018083625.tif 000008
と記述される。ここで、ωＢ＝（ｐ，ｑ，ｒ）は、マルチコプタ本体に固定された座標系において表現された、図４（Ｄ）に示された構成要素を有して示されたマルチコプタの角速度であり、
【０１３２】
【数７】
2018083625.tif 000009
は、外積の行列形式であり、
【０１３３】
【数８】
2018083625.tif 000010
である。
【０１３４】
慣性座標系におけるプライマリ軸１３０の配向又は方向ｚは、
【０１３５】
【数９】
2018083625.tif 000011
として、配向の微分方程式が（１）と共に
【０１３６】
【数１０】
2018083625.tif 000012
のように得られる。このことから、角速度成分ｐ及びｑが制御され得る場合にはプライマリ軸１３０がコマンドを受けた配向を達成するために構成され得るとともに、成分ｐ及びｑがゼロであれば配向が維持される。
【０１３７】
各エフェクタｉは、単一のコマンド可能な自由度（ここでは単一変数とも呼ばれる）を有するとともに、推進力ベクトルｆＴｉ（図４（Ｃ））及びマルチコプタの重心１２０（図４（Ｂ））周りのトルクベクトルτｉを発生し、この重心では、トルクベクトルが、推進力ベクトルのモーメントで構成され、プロペラの回転に対抗するように作用する流体力学的な反応ドラグトルクを含んでいる。加えて、マルチコプタの重さｍｇがマルチコプタへ作用し、ここではマルチコプタの角速度に対抗するよう作用する流体力学的なドラグトルクτｄが存在する。
【０１３８】
回転するエフェクタを有する本体の角速度の発生を支配する微分方程式は、
【０１３９】
【数１１】
2018083625.tif 000013
で与えられ、ここで、ωＲｉはエフェクタｉの回転速度ベクトルであり、ＩＢは本体に固定された座標系において表現されるマルチコプタの本体の慣性行列であり、ＩＲｉはエフェクタｉの慣性行列であり、τｊはマルチコプタの重心１２０を通して作用する各ロータｉのトルクベクトルと、（マルチコプタにおける流体力学的なドラグトルクのような）マルチコプタに作用するその他のトルクとを含んでいる。本体の慣性が、マルチコプタ構造部、制御ユニット、センサのような本体にしっかりと取り付けられた構成要素を含むようにされていることに留意されたい。
【０１４０】
式（５）の左辺は、各加速度
【０１４１】
【数１２】
2018083625.tif 000014
、
【０１４２】
【数１３】
2018083625.tif 000015
を含んでおり、これら成分の制御により、式（４）によるプライマリ軸の配向の制御が可能である。式（５）の右辺の最初の項は、マルチコプタに作用する全てのトルクの総和である。式（５）の残りの項は、非慣性系における微分係数を取ることで系における角運動量の相互結合を表している。
【０１４３】
図４（Ｂ）には、マルチコプタの重心１２０における２つの残りのロータのそれぞれによって発生されるトルクベクトルτｉと、プライマリ軸１３０に垂直なその成分とが示されている。
【０１４４】
図４（Ｃ）には、マルチコプタの重心１２０における２つの残りのロータのそれぞれによって発生される推進力ベクトルｆＴｉと、プライマリ軸１３０の方向に作用するその成分とが示されている。この図には、マルチコプタの重さｍｇも示されている。マルチコプタのプライマリ軸１３０を配向することによって、及びプロペラの推進力ベクトルの総和によって力の和が得られる。この力の和は、上述のとおり、プライマリ軸を配向する機構によって目標方向へ向けられ得る。
【０１４５】
並進運動の加速度は、ニュートンの運動の第２法則によって力の和に関連している。したがって、マルチコプタの並進運動の加速度は、力の和によって影響を受ける。その一方、同様にこの加速度により並進運動の速度に影響を与えることができ、この並進運動の速度により、同様にマルチコプタの位置について変化に影響を与えることができる。説明の明確さのために、系についての以下の仮定が導出のためになされている。この仮定は、役立つマルチコプタの構成のための制御スキームの誘導について合理的であるとともに、役立ち、応用可能な制御スキームへ導くものであることに留意されたい。
・マルチコプタの質量分布は、慣性行列ＩＲが成分
【０１４６】
【数１４】
2018083625.tif 000016
を有して対角となるよう慣性の主軸がｘ、ｙ及びｚと一致するようになっている。
・エフェクタは、それぞれマルチコプタの重心１２０からｌの距離離れた本体のｘ軸に沿って設けられたプロペラである。
・エフェクタは、同一のプロペラであり、クアッドコプタの質量に比べれば無視できる質量を有しているとともに、マルチコプタ本体の対角慣性行列の大きさに比べれば無視できる対角慣性行列ＩＲの大きさを有しており、プライマリ軸１３０に対して平行に軸周りに回転する。
【０１４７】
【数１５】
2018083625.tif 000017
・マルチコプタ本体の角速度の大きさは、いずれかのプロペラの角速度の大きさに比べれば無視できるものである。
・プロペラによって発生される力ベクトルｆＴｉは、平行であり、本体に固定された座標系において
【０１４８】
【数１６】
2018083625.tif 000018
として記述されるよう、図４（Ｃ）に図示されているようにマルチコプタのプライマリ軸１３０に対して平行となっている（ベクトルｆＴｉとスカラーｆＴｉの間の区別に留意されたい）。マルチコプタに作用すると仮定される他の力はその重さｍｇである。
・プロペラによって発生される、マルチコプタの重心１２０を通りプライマリ軸１３０に対して垂直なトルクベクトルの成分は、図４（Ｂ）に示されているようにｙと同一直線上かつ平行である。プライマリ軸１３０に対して垂直に作用する成分がプロペラの推進力ベクトルｆＴｉのモーメントによってのみ重心１２０からの距離ｌにおいて作用すること、及びｘの方向におけるトルク成分がないことが仮定されている。プライマリ軸１３０に対して平行なトルクの成分は、τ１｜｜であり、プロペラの回転に対抗するための流体力学的な反応ドラグトルクによって生じる。それゆえ、プロペラのトルクベクトルは、本体に固定された系において
【０１４９】
【数１７】
2018083625.tif 000019
と記述される。
・マルチコプタの回転に対抗するよう作用する流体力学的なドラグトルクτｄの成分は、τｄ＝（０，０、−τｄ）となるようｚに対して平行にのみ作用すると仮定される（ベクトルτｄとスカラーτｄの区別に留意されたい）。
【０１５０】
あらかじめ規定されたいくつかの慣性基準系１６０に関する本体に固定された系の回転を再びＲで表し、本体の角速度をωＢで表せば、Ｒの微分方程式は式（１）のようになる。マルチコプタの配向は、ここでも、式（４）によって与えられる微分方程式に関連する式（３）によって記述されている。
【０１５１】
式（５）を参照すれば、マルチコプタの本体に関する、本体に固定された系において表現されるロータの角速度ｉは、ωＲｉ＝（０，０，ωＲｉ）である（ベクトルのωＲｉとスカラーのωＲｉの区別に留意されたい）。
【０１５２】
式（５）の左辺は角速度を含んでおり、
【０１５３】
【数１８】
2018083625.tif 000020
と単純化される。マルチコプタの配向は、角速度の成分ｐ及びｑによって制御され得る。
【０１５４】
全てのトルクの総和、すなわち右辺の最初の項は、プロペラのトルクベクトルと、マルチコプタの回転に対抗する流体力学的なドラグトルクとを含むとともに、
【０１５５】
【数１９】
2018083625.tif 000021
が導かれる。
【０１５６】
式（５）の最終項は、非慣性系における微分係数を取ることで系における角運動量の相互結合を表している。この項を展開し、成分を加えると、以前の仮定の下で
【０１５７】
【数２０】
2018083625.tif 000022
が導かれる。
【０１５８】
上述のことから、式（５）をその成分において書き出すと、
【０１５９】
【数２１】
2018083625.tif 000023
【０１６０】
【数２２】
2018083625.tif 000024
【０１６１】
【数２３】
2018083625.tif 000025
の３つの微分方程式となる。このことから、プロペラへ送信される制御信号により、ｘ周りの角加速度
【０１６２】
【数２４】
2018083625.tif 000026
に直接影響を与えることが可能である。これはプライマリ軸１３０に対して垂直な成分であるため、直接発生されたこの角加速度は、プライマリ軸１３０に線形に依存する。さらに、上述の角加速度
【０１６３】
【数２５】
2018083625.tif 000027
によって、角速度ｑを得ることが可能である。
【０１６４】
それゆえ、ｙに沿うセカンダリ軸を通って本体が回転することで、プライマリ軸１３０周りのマルチコプタの角速度成分（ｒ）及びセカンダリ軸周りのマルチコプタの角速度成分（ｑ）は、ここではｘである回転軸周りの角加速度（したがって回転）を発生させるために相互作用する。重要なことは、セカンダリ軸がプライマリ軸１３０に関してゼロでない角度で位置していること（例えばセカンダリ軸がプライマリ軸１３０から線形に独立している）、及び回転軸がプライマリ軸とセカンダリ軸の両方に対してゼロでない角度で位置していることである（例えば回転軸は両者から線形に独立している）。具体的には、このマルチコプタにとって、これは、ロータがｘ軸周りのトルクを発生させることができないもののｘに沿った角速度の成分ｐが影響され得るとともに、慣性系に関するプライマリ軸１３０の配向が制御され得ることを意味している。類似のように、他のマルチコプタにとって、これは、上述の影響がこれらの制御のために反対に作用するか又はそうでなければ相殺されるよりもむしろアクティブに他の制御が活用されることを意味する。
【０１６５】
さらに、この配向は、角速度成分ｐ及びｑをゼロとすること、及びそれぞれ式（１３）と式（１４）によって
【０１６６】
【数２６】
2018083625.tif 000028
及び
【０１６７】
【数２７】
2018083625.tif 000029
となるようｆＴ１＝ｆＴ３となるようにプロペラへ指令することによって維持される。そして、マルチコプタの角速度は、プライマリ軸１３０に沿って指向されるとともに、この配向は一定である。
【０１６８】
プライマリ軸１３０に沿ったマルチコプタの角速度の成分ｒは、トルクτ１｜｜及びドラグトルクτｄによって支配される。ドラグトルクが一般にｒと共に増大するため、マルチコプタが角速度のこの成分を増大させ、したがってマルチコプタがプライマリ軸１３０周りに回転する自然な傾向を有するように、低速においてτ１｜｜＋τ３｜｜−τｄにおけるアンバランスが存在する。固定ピッチプロペラにとって、一般には、推進力の大きさｆＴｉと流体力学的な反応ドラグトルクτｉ｜｜の間の強い線形の関係が存在する。
【０１６９】
いまや、マルチコプタの並進運動加速度は、プライマリ軸の配向の達成及び維持のための２つの力ｆＴ１とｆＴ３の間の差異を用いることと、本体に作用する合力を達成するための２つのプロペラの推進力の和を用いることで影響を受け得る。特に、目標推進力の大きさは、ｆＴ１及びｆＴ２によって達成される。
【０１７０】
上述の導出が特有の仮定の下でなされる一方、これら仮定は、実用的なマルチコプタ構成のための制御スキームの導出のために合理的であるとともに、実用的で応用可能な制御スキームに導くものである。したがって、上述の結果は、環境の広い範囲のために維持するものであるとともに、そのようなものとして解釈されるべきである。
【０１７１】
上述の導出は、慣性行列における非対角の項を有する飛翔体のために繰り返されることができる。この場合、代数はより複雑であるが、得られる方程式は類似する。同様に、プロペラの慣性は、本体の慣性と比較可能であるか、又はプロペラの速度は本体の速度と比較可能である。
【０１７２】
さらに、本発明の利益が与えられれば、用いられる特有の制御規則が、変化可能であるとともに、極配置を用いた線形二次レギュレータ（ＬＱＲ）のような線形の方法、様々なロバスト制御方法又は非線形制御方法を用いて導かれ得ることは当業者にとって非常に明白である。
【０１７３】
図５には、平行な回転軸を有する全てのプロペラと、互いに同様の回転を有する対向するプロペラと、逆の回転を有する隣接するプロペラを有する標準的なクアッドコプタについて、故障１００により不能となったエフェクタの例が示されている。故障により不能となったエフェクタは、当該エフェクタの上において大きな「Ｘ」によって示されている。標準的なマルチコプタ制御方法は、故障したプロペラを有するマルチコプタを制御することができない。なぜなら、これらの方法は全ての軸においてもはや独立して角加速度を発生させることができないためである。
図５（ａ）には、故障により完全に不能となった１つのプロペラを有するクアッドコプタが示されている。マルチコプタの制御は、開示された方法を適用することで復帰するが、マルチコプタは、標準的なマルチコプタ制御を用いては制御可能ではない。
図５（ｂ）には、故障により不能となった対向する２つのプロペラを有するクアッドコプタが示されている。マルチコプタ制御は、開示された方法によって復帰されることができるが、標準的なマルチコプタ制御を用いては制御可能ではない。
図５（ｃ）には、故障により不能となった２つの隣り合うプロペラを有するクアッドコプタが示されている。マルチコプタ制御は、開示された方法によって復帰されることができるが、標準的なマルチコプタ制御を用いては制御可能ではない。
図５（ｄ）には、故障により不能となった３つのプロペラを有するクアッドコプタが示されている。マルチコプタ制御は、開示された方法によって復帰されることができるが、標準的なマルチコプタ制御を用いては制御可能ではない。
図５（ｅ）には、故障により不能となった４つのプロペラを有するクアッドコプタが示されている。このクアッドコプタは制御不能である。
【０１７４】
（例示的な制御構造）
図６には飛行するマルチコプタにおける開示された方法の例示的な実施が示されており、ここで、この方法は、外側の制御ループ６０２と内側の制御６０４に分けられている。開示された方法の他の実施は、当業者にとって明白である。ハイレベルの目標６１０は、ユーザによって与えられるとともに、並進運動制御装置６１２へ送信される。ＧＰＳセンサのようなハイレベルセンサ６１４及びオンボード視覚システムは、測定結果を並進運動状態推定器６１６へ送信し、この並進運動状態推定器は、マルチコプタの並進運動状態を推定するとともに、この推定を並進運動制御装置へ送信する。並進運動制御装置は、ハイレベルの目標を達成するために、本体の目標並進運動加速度を発生させる。
【０１７５】
姿勢制御装置６４２は、この目標並進運動加速度を受信し、プロペラ６６０のそれぞれに制御信号を送信する。この姿勢制御装置６４２は、マルチコプタのプライマリ軸の目標配向１５０と、目標加速度をもたらす指令された合計の力とを計算し、そして、各プロペラのための制御信号を発生させるために開示された方法を用いる。センサの測定結果は、マルチコプタの回転を推定しこの推定を姿勢制御装置へ送信する状態推定器６４６へ受け渡される。センサの測定結果は慣性センサ６４４から得られ、この慣性センサは、加速度計及びレートジャイロスコープを含み得る。オンボードセンサの更なる例は、カメラのような視覚センサ、距離センサ、高度センサ及び対気速度センサを含み得る。
【０１７６】
図７には故障により不能となった様々なエフェクタを有するマルチコプタの代替的なレイアウトが示されており、これらの全ては、開示された本発明を用いることでまだ制御可能である。特に、図７（Ａ）には２つ１組で配置された８つのエフェクタを有するマルチコプタが示されていて、２つの対向する組が完全に故障しており、開示された本発明を用いることで、もたらされた構成がまだ制御可能である。図７（Ｂ）には交互に回転する、重心周りに対称に配置された８つのエフェクタを有するマルチコプタが示されており、隣り合う５つのエフェクタが完全に故障しているとともに、開示された本発明を用いることでもたらされた構成がまだ制御可能である。図７（Ｃ）には、それぞれの側に４つのエフェクタを有するＨ状の構成に配置された８つのエフェクタを有するマルチコプタが示されていて、一方側の４つ全てのエフェクタが完全に故障しており、開示された本発明を用いることでもたらされた構成がまだ制御可能である。
【０１７７】
図８には、マルチコプタにおける故障の場合における制御方法を決定するための例示的なフローチャートが示されている。故障８０２の後、システムは、まだトルクを発生させることができるかどうかをチェックする８０４。もし不可能であれば、マルチコプタは制御不能である８１２。しかしながら、もしマルチコプタがトルクを発生可能であり、本体に作用する全てのトルクが合計でゼロとなり、さらにトルクが独立した３つの方向において発生させることができれば８０６、従来技術において知られた標準的なマルチコプタの制御方法を用いて制御可能である。標準的なマルチコプタの制御方法が使用可能でない場合には、開示された本発明によってマルチコプタがまだ制御可能である８１６。
【０１７８】
図９には、１つのロータが故障し、本発明をマルチコプタの制御に用いるマルチコプタが示されている。一般性を失うことなく、エフェクタ１〜３がまだ操作されており、エフェクタ４が故障１００によって不能となっていることが仮定されている。エフェクタ１，３は、同方向１０８ｂへ回転する一方、エフェクタ２は逆方向１０８ａへ回転する。推進力ｆＴ１，ｆＴ２及びｆＴ３は、図９（Ｃ）に示されているように本体に沿ってｚ軸へ同方向へ向いており、各トルクベクトルが図９（Ｂ）に示されている。プロペラによって発生されたトルクのアンバランスは、本体へ作用するドラグトルクτｄがプロペラのトルクをバランスさせるために作用するように、角速度ωＢによるマルチコプタの回転を生じさせる。本発明は、プライマリ軸１３０に沿うようにマルチコプタの角速度を制御するために用いられる。一方、プライマリ軸の目標配向１５０は、慣性系に関して達成されている。
【０１７９】
一般的に、プライマリ軸１３０は、もはやｚに沿わず、プライマリ軸１３０の方向の決定のための１つの方法は、図４を参照し、図４のために導入された表記を参照すれば以下のとおりである。マルチコプタの慣性行列をＩＢとして、本体の系において、
【０１８０】
【数２８】
2018083625.tif 000030
のように記述され、単純化のために、慣性行列が対角状であること、及びｘ周りの慣性がｙ周りの慣性と等しくなるようにマルチコプタが対称であることが仮定されている。ここでは、ロータ周りの角運動量が無視されている。ここでも、ωＢ＝（ｐ，ｑ，ｒ）は、図９（Ｄ）に示されているように、本体の系において表現されたマルチコプタ本体の角速度を表している。
【０１８１】
各ロータｉは、本体の系においてはｆＴｉ＝（０，０，ｆＴｉ）として記述される推進力ベクトルｆＴｉを発生させる。さらに、各ロータｉは、重心１２０を通るトルクベクトルを発生し、このトルクベクトルは、本体の系において、
【０１８２】
【数２９】
2018083625.tif 000031
単純化のために、成分τＺｉは、τＺｉ＝κｆＴｉのように推進力に比例すると仮定される。流体力学的なトルクτＤも本体に作用し、ここでは単純化のためにｚの方向にのみ作用し、τＤ＝（０，０，−ＣＤｒ）となるようｒに比例すると仮定されている。本体の変化量の発生を支配する微分方程式は、
【０１８３】
【数３０】
2018083625.tif 000032
として記述することができ、以下の３つの微分方程式を導くために展開及び書き直されることができる：
【０１８４】
【数３１】
2018083625.tif 000033
【０１８５】
【数３２】
2018083625.tif 000034
【０１８６】
【数３３】
2018083625.tif 000035
【０１８７】
ｎ＝（ｎｘ，ｎｙ，ｎｚ）を慣性系に固定された単位ベクトルであるとする。このベクトルは、微分方程式
【０１８８】
【数３４】
2018083625.tif 000036
に基づいて展開される。いまや、目標は、一定の回転速度ωと、ｎが本体の系において表現されたプライマリ軸１３０を表現するように一定のｎとをもたらす一連の指令された力ｆＴｉを見出せるものである。これは、
【０１８９】
【数３５】
2018083625.tif 000037
及び
【０１９０】
【数３６】
2018083625.tif 000038
を暗に示している。式（２２）から、これはｎ＝εωを暗に意味しており、ｎが単位ベクトルであるように、
【０１９１】
【数３７】
2018083625.tif 000039
となっている。
【０１９２】
これは、（ｐ，ｑ，ｒ，ｎｘ，ｎｙ，ｎｚ，ｆＴ１，ｆＴ２，ｆＴ３，ε）について解くために１０個のスカラーの未知数を有する一連の７つの代数方程式を導くものである。これは、３つの追加的な限定を加えることで解決され、例えば、第１のエフェクタと第３のエフェクタが等しい力を定常状態で発生させるとし、すなわち
【０１９３】
【数３８】
2018083625.tif 000040
とし、第２のプロペラが、
【０１９４】
【数３９】
2018083625.tif 000041
となるように第３のプロペラの推力の半分とし、推進力の和が、プライマリ軸１３０が重力に対抗するように向く場合にマルチコプタの重さ（ｍｇ）をバランスさせるこれら推進力が目標推進力の大きさとなるようにする。
【０１９５】
【数４０】
2018083625.tif 000042
これは、１０個の未知数における１０個の一連の代数方程式を残すものであり、これらから、定常状態の回転速度ωＢと、本体の系ｎにおけるプライマリ軸１３０の方向と、定常状態の推進力ｆＴｉを計算することができる。推進力ｆＴｉは、比較的大きく、例えばゼロとは大きく異なることが望ましい。制御された飛行の本方法によれば、当業者は、プロペラ及びモータが好ましい特性を有する定常状態の推力値を選択することが可能である。
【０１９６】
いまや、安定化コントローラは、マルチコプタをいくつかの瞬間角速度及び配向から上述の定常状態の解決へ導くように構成されている。さらに、慣性系におけるプライマリ軸の配向は、空間におけるマルチコプタを並進移動させるために用いられ得る。
【０１９７】
第２のエフェクタが定常状態の重大な推力ｆＴ２＞０を発生させるためにマルチコプタの重心が静止しないもののその代わり軌道を連続的に回転することに留意されたい。重力の方向における成分が重さを相殺するようにプライマリ軸１３０がエフェクタの推力の方向と一致していないが、重力に対して垂直な成分はマルチコプタの軌道の中心に対するマルチコプタの加速を常に生じさせる。それゆえ、上述の解法を用いる場合には、マルチコプタの重心は、空間の一点において静止することができないものの、その代わり空間における目標点周りの連続的な運動を有する。
【０１９８】
３つの残ったプロペラを有するクアッドコプタの場合については、代替的なストラテジが異なる方向に回転する１つの残りのプロペラを不能にさせ、制御に応用するために図４のために導入されるストラテジを可能とする。しかしながら、これは、マルチコプタの高度を維持するために各プロペラがマルチコプタの重さの半分を発生させる必要があり、一方、３つのプロペラによって、残りの各プロペラが受け持つ重さの割合が、より魅力的なオプションとする第３のものへ近づけられる。本発明によれば、これら２つのオプションのいずれかを当業者が選択することが可能である。
【０１９９】
図１０には、３つのロータの故障を受け、１つの残りのプロペラを用いるマルチコプタを制御するための本発明を利用するクアッドコプタが示されている。一般性を失うことなく、エフェクタ１はまだ動作していること、エフェクタ２，３，４が故障１００によって不能となったと仮定されている。推進力ｆＴ１は、図１０（Ｃ）に示すように本体に沿ってｚ軸へ向けられているとともに、図１０（Ｂ）に示すように対応するトルクベクトルへ向けられている。プロペラによって発生されたトルクのアンバランスは、本体に作用するドラグトルクτｄがプロペラトルクに作用するように、角速度ωＢによってマルチコプタを回転させる。本発明は、プライマリ軸１３０に沿うようにマルチコプタの角速度を制御するために用いられる一方、プライマリ軸の目標配向１５０は慣性系に関して達成される。
【０２００】
一般に、プライマリ軸１３０はｚ軸に沿わない。プライマリ軸１３０の方向を決定する１つの方法は、図４について以前に導入した表記及び図４を参照しつつ以下のとおりである。ＩＢを本体の系において記述されたマルチコプタの慣性行列とし、
【数４１】
2018083625.tif 000043
となる。ここで、単純化のために、慣性行列は対角状であること、及びｘ周りの慣性がｙ周りの慣性と等しいようにマルチコプタが対称であることが仮定されている。ロータの各運動量は、ここでは無視されている。ここでも、ωＢ＝（ｐ，ｑ，ｒ）は、図１０（Ｄ）に示されているように、本体の系において記述されたマルチコプタの本体の角速度を表している。
【０２０１】
ロータは、ｆＴ１＝（０，０，ｆＴ１）として本体の系において記述された推進力ベクトルｆＴ１を発生させる。さらに、ロータは、重心１２０を通るトルクベクトルを発生し、このトルクベクトルは、本体の系において、
【０２０２】
【数４２】
2018083625.tif 000044
として記述される。単純化のために、成分τＺ１がτＺ１＝κｆＴ１のように推進力に比例することが仮定されている。流体力学的なトルクτＤも、本体に作用し、単純化のために、ここではｚの方向にのみ作用し、τＤ＝（０，０，−ＣＤｒ）となるようｒに比例することが仮定されている。いまや、本体の変化量の発生を支配する微分方程式は、
【０２０３】
【数４３】
2018083625.tif 000045
と記述されることができ、以下の３つの微分方程式を導くために展開及び書き直されることが可能である：
【０２０４】
【数４４】
2018083625.tif 000046
【０２０５】
【数４５】
2018083625.tif 000047
【０２０６】
【数４６】
2018083625.tif 000048
【０２０７】
ｎ＝（ｎｘ，ｎｙ，ｎｚ）があらかじめ規定された慣性と理解されるべき基準系１６０に固定された固定ベクトルとする。このベクトルは、微分方程式
【０２０８】
【数４７】
2018083625.tif 000049
に基づき展開される。いまや、目標は、一定の回転速度ωとｎが本体の系において記述されたプライマリ軸１３０を記述するよう一定のｎに至る指令された力ｆＴ１を見出すことにある。これは、
【０２０９】
【数４８】
2018083625.tif 000050
であること、及び
【０２１０】
【数４９】
2018083625.tif 000051
であることが暗に示すものである。式（３２）からはｎ＝εωであることが暗に示され、ここで、ｎが単位ベクトルであるように
【０２１１】
【数５０】
2018083625.tif 000052
となっている。
【０２１２】
これは、（ｐ，ｑ，ｒ，ｎｘ，ｎｙ，ｎｚ，ｆＴ，ε）について解くためのスカラーの未知数を有する一連の代数方程式を導くものである。これは、１つの追加的な限定を加えることで解決され、具体的には、推進力がマルチコプタの重さｍｇ：
【０２１３】
【数５１】
2018083625.tif 000053
をバランスされることが可能であることによって解決される。これは、８つの未知数における８つの一連の代数方程式を残すものであり、これら代数方程式から定常状態の回転速度ωＢ、本体の系におけるプライマリ軸１３０の方向ｎ及び定常状態の推進力ｆＴ１を計算することが可能である。
【０２１４】
いまや、安定化コントローラは、マルチコプタをいくつかの瞬間角速度及び配向から上述の定常状態の解決へ導くように構成されている。さらに、慣性系におけるプライマリ軸の配向は、空間におけるマルチコプタを並進移動させるために用いられ得る。このようなコントローラを創造するための１つの方法は、釣り合いについての運動方程式の増加させることと、線形二次制御の合成を行うことである。
【０２１５】
ｆＴｉの低周波数成分は、あらかじめ規定された期間にわたって平均化される場合に目標推力の達成に使用され得る。一方、高周波数成分は、プライマリ軸の配向の制御に用いられ得る。
【０２１６】
エフェクタの推力が重力ベクトルと一致しないため、マルチコプタの重心は静止しないもののその代わり軌道を連続的に回転することに留意されたい。重力の方向における成分が重さを相殺するようにプライマリ軸１３０がエフェクタの推力の方向と一致していないが、重力に対して垂直な成分はマルチコプタの軌道の中心に対するマルチコプタの加速を常に生じさせる。それゆえ、上述の解法を用いる場合には、マルチコプタの重心は、空間の一点において静止することができないものの、その代わり空間における目標点周りの連続的な運動を有する。
【０２１７】
上述のプライマリ回転は、慣性の主軸周りに必要でないことに留意されたい。
【０２１８】
それゆえ、上記説明から明らかにされたものの中で上記において明らかにされた対象は、効率的に達成されることと、上記方法の実施に際して、及び本発明の精神と範囲を逸脱することなく明らかな構成においてある程度変更可能であることが認められ、上述の明細書に含まれ、添付の図面に示された全ての事項は、例示的なものと理解されるべきであり、これに限定されると理解されるべきではないということが意図されている。
【符号の説明】
【０２１９】
１００            故障により不能となったエフェクタ
１０２            エフェクタ
１０２ａ          エフェクタ１
１０２ｂ          エフェクタ２
１０２ｃ          エフェクタ３
１０２ｄ          エフェクタ４
１０４            プロペラ
１０６            モータ
１０８            プロペラの回転方向
１０８ａ          プロペラの回転の時計方向
１０８ｂ          プロペラの回転の半時計方向
１１０            プロペラの回転の駆動軸
１１２            マルチコプタの本体
１１４            機械的な構造部
１１８            プライマリ軸周りの連続的なマルチコプタの回転の方向
１２０            マルチコプタの重心
１３０            プライマリ軸
１４０            クアッドコプタ
１５０            プライマリ軸の目標配向
１６０            あらかじめ規定された基準系
３０２            飛行モジュール
３０４            入力ユニット
３０６            制御ユニット
３０８            推定ユニット
３１０            センシングユニット
３１２            メモリユニット
３１４            エフェクタに対する制御信号
６０２            外側の制御ループ
６０４            内側の制御ループ
６１０            ハイレベルな目標
６１２            並進運動制御装置
６１４            ハイレベルセンサ（例えば視覚、ＧＰＳ）
６１６            並進運動状態推定器
６４２            姿勢制御装置
６４４            慣性センサ
６４６            状態推定器
６６０            プロペラ
８０２            故障
８０４            マルチコプタはトルク発生可能？
８０６            トルクは合計でゼロとされ、３つ全ての次元において独立したトルクを発生可能？
８１０            標準のマルチコプタ制御方法を使用
８１２            マルチコプタ制御不能
８１６            界磁された制御方法を使用
ａ                目標加速度
ｆｄｅｓ          目標推進力の大きさ
ｆＤｉ            ロータｉのロータドラグトルク力ベクトル
ｆＴｉ            各プロペラｉのための推進力
ｇ                重力加速度
ｍ                マルチコプタの質量
ｍｇ              マルチコプタの重さ
2018083625.tif 000054
ＩＢ              慣性行列
ｆＴｉ            推進力ベクトル
ＩＢ              マルチコプタの本体の慣性行列
ＩＲｉ            プロペラｉの慣性行列
ｎ                プライマリ軸の配向
Ｒ                回転行列
ｘ，ｙ，ｚ        座標系の軸
τｉ              トルクベクトル
τｉ｜｜          プライマリ軸に対して平行なトルクベクトル成分
τｉ⊥            プライマリ軸に対して垂直なトルクベクトル成分
τｄ              流体力学的なトルク（スカラー）
τｄ              流体力学的なトルク（ベクトル）
τｉ              ロータｉのトルクベクトル
ωＢ              本体の角速度
ωＶ              慣性系におけるマルチコプタの角速度
ωＲｉ            マルチコプタ本体に関するロータｉの角速度（スカラー）
ωＲｉ            マルチコプタ本体に関するロータｉの角速度（ベクトル）
【図１】
2018083625.tif 000059
【図２】
2018083625.tif 000060
【図３】
2018083625.tif 000061
【図４】
2018083625.tif 000062
【図５】
2018083625.tif 000063
【図６】
2018083625.tif 000064
【図７】
2018083625.tif 000065
【図８】
2018083625.tif 000066
【図９】
2018083625.tif 000067
【図１０】
2018083625.tif 000068
【手続補正書】
【提出日】平成30年2月22日(2018.2.22)
【手続補正１】
【補正対象書類名】特許請求の範囲
【補正対象項目名】全文
【補正方法】変更
【補正の内容】
【特許請求の範囲】
【請求項１】
マルチコプタを動作させるための方法であって、マルチコプタは、
本体と、
それぞれ、該本体に取り付けられ、トルク及び推進力を発生するように構成された少なくとも４つのエフェクタと、
前記マルチコプタの飛行を制御することが可能な制御ユニットと
を備え、
前記方法は、
あらかじめ規定された基準系に関してあらかじめ規定された時間にわたって前記少なくとも４つのエフェクタのうち１つ又はこれより多くによって発生される推進力の合計に一致する軸である、あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向に基づき前記少なくとも４つのエフェクタのうち１つ又はこれより多くを制御するステップを実行するための制御ユニットを、
前記プライマリ軸の前記配向が前記あらかじめ規定された基準系に関する目標配向へ収束されるように前記マルチコプタを動かす、前記プライマリ軸に対して垂直なトルクを前記少なくとも４つのエフェクタのうち１つ又はこれより多くが発生させるように、及び
前記少なくとも４つのエフェクタのうち１つ又はこれより多くが前記プライマリ軸に沿った推進力を発生するように
用いるステップ
を含む方法。
【請求項２】
飛行時に前記プライマリ軸周りに前記マルチコプタが回転し、
前記１つ又はこれより多くのエフェクタのうちいずれかに、前記少なくとも４つのエフェクタのうち１つ又はこれより多くによって発生されるトルク及び／又は推進力に影響を与える故障が発生している場合に、故障のない１つ又はこれより多くの前記エフェクタを、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向及び前記マルチコプタの角速度に基づき制御するステップを実行する前記制御ユニットを、
前記少なくとも４つのエフェクタのうち故障のない１つ又はこれより多くが、前記プライマリ軸周りに前記マルチコプタを回転させる、前記プライマリ軸に沿ったトルクと、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関する目標配向へ収束するように前記マルチコプタを動かす前記プライマリ軸に対して垂直なトルクとをまとめて発生させるように、及び
前記少なくとも４つのエフェクタのうち故障のない１つ又はこれより多くが前記プライマリ軸に沿った推進力をまとめて発生するように
用いるステップ
を更に含む、請求項１に記載の方法。
【請求項３】
前記１つ又はこれより多くのエフェクタのうちいずれかに、前記少なくとも４つのエフェクタのうち１つ又はこれより多くによって発生されるトルク及び／又は推進力に影響を与える故障が発生していない場合に、前記少なくとも４つのエフェクタを、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向及び前記マルチコプタの角速度に基づき制御するステップを実行する前記制御ユニットを、
前記少なくとも４つのエフェクタが、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関する目標配向へ収束するように前記マルチコプタを動かす前記プライマリ軸に対して垂直なトルクをまとめて発生させるように、及び
前記少なくとも４つのエフェクタが前記プライマリ軸に沿った推進力をまとめて発生するように
用いるステップ
を更に含む、請求項１又は２に記載の方法。
【請求項４】
前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の推定を計算するステップと、
前記マルチコプタの角速度の推定を計算ステップと
を実行するための制御ユニットを用いるステップを含み、
前記少なくとも４つのエフェクタのうち１つ又はこれより多くが前記プライマリ軸に対して垂直なトルクを発生させるように、このとき、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関する目標配向へ収束するように前記プライマリ軸に対して垂直なトルクが前記マルチコプタを動かし、また、前記少なくとも４つのエフェクタのうち１つ又はこれより多くが前記プライマリ軸に沿った推進力を発生するように、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向及び前記マルチコプタの角速度に基づく、前記少なくとも４つのエフェクタのうち１つ又はこれより多くを制御する前記ステップが、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の前記推定に基づき、及び前記マルチコプタの角速度の前記推定に基づき、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関する目標配向へ収束するように前記プライマリ軸に対して垂直なトルクが前記マルチコプタを動かし、また、前記少なくとも４つのエフェクタのうち１つ又はこれより多くが前記プライマリ軸に沿った推進力を発生するように、前記少なくとも４つのエフェクタのうち１つ又はこれより多くを制御するステップを更に含む、請求項１〜３のいずれか１項に記載の方法。
【請求項５】
前記マルチコプタが更に推定ユニットを含み、前記マルチコプタが、飛行時に前記プライマリ軸周りに回転し、当該方法が、
推定ユニットを用いて、エフェクタによって発生されたトルク及び／又は推進力に影響を与える故障を識別するステップと、
故障の識別に応じて、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向及び前記マルチコプタの角速度に基づき、前記少なくとも４つのエフェクタのうち故障のない１つ又はこれより多くを制御するための制御ユニットを、前記少なくとも４つのエフェクタのうち故障のない１つ又はこれより多くが、前記プライマリ軸に沿ったトルク及び前記プライマリ軸に対して垂直なトルクをまとめて発生するように、このとき、前記プライマリ軸に沿ったトルクが前記マルチコプタを前記プライマリ軸周りに回転させ、前記プライマリ軸の配向が前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の目標配向へ収束するよう前記プライマリ軸に対して垂直なトルクが前記マルチコプタを動かし、また、前記少なくとも４つのエフェクタのうち故障のない１つ又はこれより多くが前記プライマリ軸に沿った推進力をまとめて発生するように用いるステップと
を更に含む、請求項１〜３のいずれか１項に記載の方法。
【請求項６】
推定ユニットを用いて故障を識別する前記ステップが、前記マルチコプタの運動を表すデータに基づき、前記推定ユニットを用いて故障を識別することを含む、請求項５に記載の方法。
【請求項７】
前記プライマリ軸に沿ったトルクが、毎秒０．５回転より大きな速度で前記マルチコプタを前記プライマリ軸周りに回転させる、請求項２〜５のいずれか１項に記載の方法。
【請求項８】
目標推進力の大きさを定義するステップを更に含み、
前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向と、前記マルチコプタの角速度とに基づく前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御する前記ステップが、前記プライマリ軸に沿った前記１つ又はこれにより多くのエフェクタによって個々に発生された推進力のそれぞれのあらかじめ規定された期間にわたって平均化された和の大きさが前記目標推進力の大きさと等しくなるように前記１つ又はこれより多くのエフェクタを制御するステップを含む、請求項１に記載の方法。
【請求項９】
目標高度位置を定義するステップを更に含み、
前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向と、前記マルチコプタの角速度とに基づく前記少なくとも４つのエフェクタのうち１つ又はこれより多くのエフェクタを制御する前記ステップが、前記プライマリ軸に沿った前記少なくとも４つのエフェクタのうち１つ又はこれより多くによって発生される推進力が前記マルチコプタの高度位置を前記目標高度位置へ収束させるように前記１つ又はこれより多くのエフェクタを制御するステップを含む、請求項１に記載の方法。
【請求項１０】
前記マルチコプタがクアッドコプタである、請求項１に記載の方法。
【請求項１１】
飛行中の故障を受けるマルチコプタを動作させるための方法であって、マルチコプタは、
本体と、
それぞれ、該本体に取り付けられ、トルク及び推進力の両方を発生するように動作可能である、少なくとも４つのエフェクタと
を含み、
前記方法は、
前記少なくとも４つのエフェクタのうち１つ又はこれより多くによって発生されるトルク及び／又は推進力の低下を生じさせる故障を推定ユニットを用いて識別するステップ
を含み、
前記故障の前記識別に応じて、
あらかじめ規定された基準系に関する前記本体のプライマリ軸の配向の推定を計算するステップであって、前記プライマリ軸が、前記あらかじめ規定された基準系に関してあらかじめ規定された時間にわたって前記少なくとも４つのエフェクタのうち１つ又はこれより多くによって発生される推進力の合計に一致する軸であり、
前記マルチコプタの角速度の推定を計算するステップと、
前記少なくとも４つのエフェクタのうち１つ又はこれより多くによって発生されるトルク及び／又は推進力の低下を、前記推定ユニットを用いて決定するステップと、
トルク及び／又は推進力の前記決定された低下と、前記あらかじめ規定された基準系に関する前記本体の前記プライマリ軸の配向の計算された推定と、前記マルチコプタの角速度の前記計算された推定とに基づき、前記少なくとも４つのエフェクタのうち１つ又はこれより多くを制御するための制御ユニットを、
前記少なくとも４つのエフェクタのうち１つ又はこれより多くが、前記プライマリ軸に沿ったトルクと、前記プライマリ軸に対して垂直なトルクをまとめて発生するように、このとき、前記プライマリ軸に沿ったトルクが前記プライマリ軸周りに前記マルチコプタを回転させ、前記プライマリ軸に対して垂直なトルクが、プライマリ軸の配向が前記あらかじめ規定された基準系に関して目標配向へ収束するように前記マルチコプタを動かし、
前記少なくとも４つのエフェクタのうち１つ又はこれより多くが前記プライマリ軸に沿った推進力をまとめて発生するように
用いるステップと
を含む方法。
【請求項１２】
推定ユニットを用いて故障を識別する前記ステップが、前記マルチコプタの運動を表すデータに基づき、前記推定ユニットを用いて故障を識別することを含む、請求項１１に記載の方法。
【請求項１３】
前記プライマリ軸線に沿ったトルクが、毎秒０．５回転より大きな速度で前記マルチコプタを前記プライマリ軸周りに回転させる、請求項１１に記載の方法。
【外国語明細書】
2018083625000001.pdf