JP6585673B2 - Aircraft attitude control method - Google Patents

Aircraft attitude control method Download PDF

Info

Publication number
JP6585673B2
JP6585673B2 JP2017169966A JP2017169966A JP6585673B2 JP 6585673 B2 JP6585673 B2 JP 6585673B2 JP 2017169966 A JP2017169966 A JP 2017169966A JP 2017169966 A JP2017169966 A JP 2017169966A JP 6585673 B2 JP6585673 B2 JP 6585673B2
Authority
JP
Japan
Prior art keywords
aircraft
control
attitude
movable object
flight
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2017169966A
Other languages
Japanese (ja)
Other versions
JP2018010671A (en
Inventor
ユー,ユン
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
SZ DJI Technology Co Ltd
Original Assignee
SZ DJI Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by SZ DJI Technology Co Ltd filed Critical SZ DJI Technology Co Ltd
Priority to JP2017169966A priority Critical patent/JP6585673B2/en
Publication of JP2018010671A publication Critical patent/JP2018010671A/en
Application granted granted Critical
Publication of JP6585673B2 publication Critical patent/JP6585673B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

無人航空機(UAV)などの航空機は、軍事および民間の用途のための監視、偵察、および探査作業を行うために使用できる。このような航空機は、特定の機能を行う搭載物を運ぶことができる。航空機は、多重回転翼航空機であり得る。   Aircraft such as unmanned aerial vehicles (UAVs) can be used to perform surveillance, reconnaissance, and exploration operations for military and civilian applications. Such aircraft can carry loads that perform specific functions. The aircraft can be a multiple rotorcraft.

多重回転翼航空機の典型的な飛行制御方法は、カスケード接続された比例積分微分(PID)制御を利用する。この場合、姿勢制御は、角速度制御とカスケード接続されている。従来のPID調節方法に基づいて、制御の内側ループ(角速度ループ)および制御の外側ループ(角度ループ)のパラメータを順次調整する。内側ループの較正結果には、依存性がある。内側ループの追従性能が正確でない場合、結果全体に直接影響を与える。しかし、従来のPID調整のプロセスは複雑かつ冗長であり、プロセス中にシステムの発散および不安定性の問題が生じやすい。更に、従来の制御方法は、外乱によって既に航空機が角速度を発生させた後でのみ調節を行い、特定の状況下では、外乱除去性能は、最適な状態を達成できない。 A typical flight control method for multiple rotorcraft utilizes cascaded proportional integral derivative (PID) control. In this case, the attitude control is cascaded with the angular velocity control. Based on the conventional PID adjustment method, the parameters of the inner loop of control (angular velocity loop) and the outer loop of control (angular loop) are sequentially adjusted. The calibration results of the inner loop, there is a dependency strong. If the tracking performance of the inner loop is not accurate, it directly affects the overall result. However, the conventional PID adjustment process is complex and redundant, and system divergence and instability problems are likely to occur during the process. Furthermore, the conventional control method adjusts only after the aircraft has already generated an angular velocity due to the disturbance, and under certain circumstances, the disturbance removal performance cannot achieve the optimum state.

ある場合、無人航空機(UAV)などの航空機の飛行を制御することが望ましいことがある。従来の姿勢制御方法よりも複雑でなく冗長でない技術を使用して、飛行中の航空機の姿勢を制御することが更に望ましいことがある。航空機が安定に飛行できるように制御する必要性がある。   In some cases, it may be desirable to control the flight of an aircraft such as an unmanned aerial vehicle (UAV). It may be further desirable to control the attitude of an aircraft in flight using techniques that are less complex and redundant than conventional attitude control methods. There is a need to control the aircraft so that it can fly stably.

本発明のある実施形態は、航空機の姿勢を制御する方法を対象とし、その方法は、以下の(a)〜(e)のステップを含む。(a)航空機の1つ以上の物理的特性に基づいて、1つ以上の航空機構成パラメータを計算するステップ、(b)航空機の目標姿勢を示す信号をプロセッサで受信するステップ、(c)航空機の1つ以上の推進ユニットに動作可能に接続された、航空機の少なくとも1つのアクチュエータに送達されるコマンド信号を、(1)(b)の目標姿勢を示す信号、および(2)(a)の1つ以上の航空機構成パラメータに基づき、かつフィードバック制御方式を更に使用して、プロセッサを用いて生成するステップ、(d)1つ以上の推進ユニットの作動に起因する航空機の動態を、航空機に動作可能に接続された1つ以上のセンサを用いて測定するステップ、(e)動態をプロセッサに供給して、(c)のコマンド信号を調節または確証するフィードバック制御方式をもたらすステップ。   An embodiment of the present invention is directed to a method for controlling the attitude of an aircraft, and the method includes the following steps (a) to (e): (A) calculating one or more aircraft configuration parameters based on one or more physical characteristics of the aircraft; (b) receiving at the processor a signal indicative of the target attitude of the aircraft; A command signal delivered to at least one actuator of the aircraft operatively connected to one or more propulsion units, (1) a signal indicating the target attitude of (b), and (2) one of (a) Generating using a processor based on one or more aircraft configuration parameters and further using a feedback control scheme; (d) enabling aircraft to operate aircraft dynamics resulting from the operation of one or more propulsion units; Measuring with one or more sensors connected to (e) supplying the dynamics to the processor and (c) adjusting or verifying the command signal. Steps leading to feedback control system.

航空機は無人航空機であってもよい。航空機は、複数の推進ユニットに動作可能に接続された複数のアクチュエータを含み得る。推進ユニットは、航空機の揚力を生成する回転翼を含み得る。   The aircraft may be an unmanned aircraft. The aircraft may include a plurality of actuators operably connected to the plurality of propulsion units. The propulsion unit may include a rotor wing that generates the lift of the aircraft.

航空機の目標姿勢を示す信号は、無線接続により遠隔の制御器から受信できる。   A signal indicating the target attitude of the aircraft can be received from a remote controller over a wireless connection.

ある実施形態では、ユーザーは、1つ以上の物理的特性を入力してもよい。航空機の1つ以上の物理的特性は、物理的寸法および重量を含み得る。本方法は、航空機の空力中心および重心を計算することを含み得る。本方法はまた、航空機の慣性モーメントを計算することを含み得る。フィードバック制御システムを使用する計算は、航空機の慣性モーメントを使用するフィードフォワード計算を含み得る。   In some embodiments, the user may enter one or more physical characteristics. One or more physical characteristics of the aircraft may include physical dimensions and weight. The method may include calculating an aerodynamic center and center of gravity of the aircraft. The method may also include calculating the moment of inertia of the aircraft. Calculations using the feedback control system may include feedforward calculations using aircraft moments of inertia.

フィードバック制御方式を使用する計算は、ピッチ軸、ロール軸、およびヨー軸を中心とした航空機姿勢に対して行われてもよい。本方法は、ミキサを使用して、ピッチ軸、ロール軸、およびヨー軸についての計算の結果、ならびに航空機構成パラメータを組み合わせて、少なくとも1つのアクチュエータに送達されるコマンド信号を計算することを更に含み得る。航空機構成パラメータは、アクチュエータから航空機の空力中心までの距離であってもよい。1つ以上のセンサは、慣性センサであってもよい。   Calculations using the feedback control scheme may be performed on aircraft attitudes about the pitch axis, roll axis, and yaw axis. The method further includes using the mixer to calculate the command signal delivered to the at least one actuator by combining the results of the calculations for the pitch, roll, and yaw axes and the aircraft configuration parameters. obtain. The aircraft configuration parameter may be the distance from the actuator to the aerodynamic center of the aircraft. The one or more sensors may be inertial sensors.

航空機の動態は、少なくとも1つの軸に対する航空機の姿勢、少なくとも1つの軸に対する角速度、および少なくとも1つの軸に対する角加速度を含み得る。   Aircraft dynamics may include aircraft attitude with respect to at least one axis, angular velocity with respect to at least one axis, and angular acceleration with respect to at least one axis.

本発明の更なる実施形態は、(a)航空機の1つ以上の物理的特性に基づいて、1つ以上の航空機構成パラメータを計算し、(b)航空機の目標姿勢を示す信号を受信し、(c)航空機の1つ以上の推進ユニットに動作可能に接続された航空機の少なくとも1つのアクチュエータに送達されるコマンド信号を生成する、個別または集合的に構成された1つ以上のプロセッサを備える、航空機姿勢制御システムを対象とし得る。ここで、コマンド信号は、(1)(b)の目標姿勢を示す信号、および(2)(a)の1つ以上の航空機構成パラメータに基づき、フィードバック制御方式を使用して生成される。1つ以上のセンサが、航空機に動作可能に接続され、1つ以上の推進ユニットの作動に起因する航空機の動態を測定する。測定された動態は、1つ以上のプロセッサに供給され、(c)のコマンド信号を調節または確証するフィードバック制御方式をもたらす。   Further embodiments of the present invention include: (a) calculating one or more aircraft configuration parameters based on one or more physical characteristics of the aircraft; (b) receiving a signal indicative of the target attitude of the aircraft; (C) comprising one or more processors configured individually or collectively for generating command signals to be delivered to at least one actuator of the aircraft operably connected to one or more propulsion units of the aircraft; An aircraft attitude control system may be targeted. Here, the command signal is generated using a feedback control method based on the signal indicating the target attitude of (1) and (b) and one or more aircraft configuration parameters of (2) and (a). One or more sensors are operably connected to the aircraft and measure aircraft dynamics resulting from operation of the one or more propulsion units. The measured dynamics are fed to one or more processors, resulting in a feedback control scheme that adjusts or validates the command signal of (c).

また、航空機は無人航空機であってもよい。航空機は、複数の推進ユニットに動作可能に接続された複数のアクチュエータを含み得る。推進ユニットは、航空機の揚力を生成する回転翼を含み得る。   The aircraft may be an unmanned aircraft. The aircraft may include a plurality of actuators operably connected to the plurality of propulsion units. The propulsion unit may include a rotor wing that generates the lift of the aircraft.

航空機の目標姿勢を示す信号は、無線接続により遠隔の制御器から受信できる。   A signal indicating the target attitude of the aircraft can be received from a remote controller over a wireless connection.

ユーザーは、1つ以上の物理的特性を入力してもよい。航空機の1つ以上の物理的特性は、物理的寸法および重量を含む。1つ以上のプロセッサは、個別または集合的に構成され、航空機の空力中心および重心を計算し得る。1つ以上のプロセッサは、個別または集合的に構成され、航空機の慣性モーメントを計算し得る。フィードバック制御システムを使用する計算は、航空機の慣性モーメントを使用するフィードフォワード計算を含み得る。   The user may enter one or more physical characteristics. One or more physical characteristics of an aircraft include physical dimensions and weight. One or more processors may be configured individually or collectively to calculate the aerodynamic center and center of gravity of the aircraft. One or more processors may be configured individually or collectively to calculate the moment of inertia of the aircraft. Calculations using the feedback control system may include feedforward calculations using aircraft moments of inertia.

また、フィードバック制御方式を使用する計算は、ピッチ軸、ロール軸、およびヨー軸を中心とした航空機姿勢に対して行われてもよい。本システムは、ピッチ軸、ロール軸、およびヨー軸についての計算の結果、ならびに航空機構成パラメータを組み合わせて、少なくとも1つのアクチュエータに送達されるコマンド信号を計算するミキサを含み得る。航空機構成パラメータは、アクチュエータから航空機の空力中心までの距離であってもよい。1つ以上のセンサは、慣性センサであってもよい。   Further, the calculation using the feedback control method may be performed with respect to the aircraft attitude around the pitch axis, the roll axis, and the yaw axis. The system may include a mixer that combines the results of the calculations for the pitch, roll, and yaw axes, and aircraft configuration parameters to calculate a command signal that is delivered to at least one actuator. The aircraft configuration parameter may be the distance from the actuator to the aerodynamic center of the aircraft. The one or more sensors may be inertial sensors.

航空機の動態は、少なくとも1つの軸に対する航空機の姿勢、少なくとも1つの軸に対する角速度、および少なくとも1つの軸に対する角加速度を含み得る。   Aircraft dynamics may include aircraft attitude with respect to at least one axis, angular velocity with respect to at least one axis, and angular acceleration with respect to at least one axis.

航空機姿勢を制御するための方法は、本発明の別の実施形態に従って提供してもよい。本方法は、以下の(a)〜(e)のステップを含み得る。(a)アクチュエータの推力とアクチュエータ出力との間の非線形関係を、プロセッサを用いて評価するステップ、(b)航空機の目標姿勢を示す信号をプロセッサで受信するステップ、(c)航空機の1つ以上の推進ユニットに動作可能に接続された、航空機の少なくとも1つのアクチュエータに送達されるコマンド信号を、(1)(b)の目標姿勢を示す信号、および(2)(a)の非線形関係に基づき、かつフィードバック制御方式を使用して、プロセッサを用いて生成するステップ、(d)1つ以上の推進ユニットの作動に起因する航空機の動態を、航空機に動作可能に接続された1つ以上のセンサを用いて測定するこステップ、(e)動態をプロセッサに供給して、(c)のコマンド信号を調節または確証するフィードバック制御方式をもたらすステップ。   A method for controlling aircraft attitude may be provided in accordance with another embodiment of the present invention. The method may include the following steps (a) to (e). (A) evaluating a non-linear relationship between actuator thrust and actuator output using a processor; (b) receiving a signal indicative of a target attitude of the aircraft; (c) one or more of the aircraft A command signal delivered to at least one actuator of the aircraft operatively connected to the propulsion unit of the aircraft, based on (1) a signal indicating the target attitude of (b), and (2) based on the non-linear relationship of (a) And using a feedback control scheme to generate with the processor, (d) one or more sensors operatively connected to the aircraft, the aircraft dynamics resulting from the operation of one or more propulsion units (E) providing feedback to the processor and adjusting or verifying the command signal of (c) Steps leading to the expression.

ある実施形態では、航空機は無人航空機である。航空機は、複数の推進ユニットに動作可能に接続された複数のアクチュエータを含むことができる。推進ユニットは、航空機の揚力を生成する回転翼を含むことができる。   In some embodiments, the aircraft is an unmanned aerial vehicle. The aircraft can include a plurality of actuators operably connected to a plurality of propulsion units. The propulsion unit may include a rotor wing that generates the lift of the aircraft.

航空機の目標姿勢を示す信号は、無線接続により遠隔の制御器から受信できる。非線形関係は、ユーザーによって入力されてもよい。非線形関係は、航空機の1つ以上のアクチュエータの較正中に計算され得る。本方法は、航空機の空力中心および重心を、航空機の1つ以上の物理的特性に基づいて計算することを含み得る。本方法は、航空機の慣性モーメントを、航空機の物理的特性に基づいて計算することを更に含み得る。フィードバック制御システムを使用する計算は、航空機の慣性モーメントを使用するフィードフォワード計算を含み得る。   A signal indicating the target attitude of the aircraft can be received from a remote controller over a wireless connection. The non-linear relationship may be entered by the user. The non-linear relationship can be calculated during calibration of one or more actuators in the aircraft. The method may include calculating an aerodynamic center and center of gravity of the aircraft based on one or more physical characteristics of the aircraft. The method may further include calculating an aircraft moment of inertia based on aircraft physical characteristics. Calculations using the feedback control system may include feedforward calculations using aircraft moments of inertia.

フィードバック制御方式を使用する計算は、ピッチ軸、ロール軸、およびヨー軸を中心とした航空機姿勢に対して行われてもよい。本方法は、ミキサを使用して、ピッチ軸、ロール軸、およびヨー軸についての計算の結果、ならびに航空機構成パラメータを組み合わせて、少なくとも1つのアクチュエータに送達されるコマンド信号を計算することを更に含み得る。航空機構成パラメータは、アクチュエータから航空機の空力中心までの距離であり得る。1つ以上のセンサは、慣性センサであってもよい。   Calculations using the feedback control scheme may be performed on aircraft attitudes about the pitch axis, roll axis, and yaw axis. The method further includes using the mixer to calculate the command signal delivered to the at least one actuator by combining the results of the calculations for the pitch, roll, and yaw axes and the aircraft configuration parameters. obtain. The aircraft configuration parameter may be the distance from the actuator to the aerodynamic center of the aircraft. The one or more sensors may be inertial sensors.

航空機の動態は、少なくとも1つの軸に対する航空機の姿勢、少なくとも1つの軸に対する角速度、および少なくとも1つの軸に対する角加速度を含み得る。   Aircraft dynamics may include aircraft attitude with respect to at least one axis, angular velocity with respect to at least one axis, and angular acceleration with respect to at least one axis.

更に、本発明は、その実施形態として、個別または集合的に構成され、以下の(a)〜(c)を実行する1つ以上のプロセッサを備える、航空機姿勢制御システムを提供し得る。(a)アクチュエータの推力とアクチュエータ出力との間の非線形関係を評価し、(b)航空機の目標姿勢を示す信号を受信し、(c)航空機の1つ以上の推進ユニットに動作可能に接続された航空機の少なくとも1つのアクチュエータに送達されるコマンド信号を生成する。ここで、コマンド信号は、(1)(b)の目標姿勢を示す信号、および(2)(a)の非線形関係に基づき、フィードバック制御方式を使用して生成される。1つ以上のセンサが、航空機に動作可能に接続され、1つ以上の推進ユニットの作動に起因する航空機の動態を測定する。測定された動態は、1つ以上のプロセッサに供給され、(c)のコマンド信号を調節または確証するフィードバック制御方式をもたらす。   Furthermore, as an embodiment, the present invention may provide an aircraft attitude control system that is configured individually or collectively, and includes one or more processors that execute the following (a) to (c). (A) evaluate a non-linear relationship between actuator thrust and actuator output; (b) receive a signal indicative of the target attitude of the aircraft; and (c) be operatively connected to one or more propulsion units of the aircraft. Generating a command signal to be delivered to at least one actuator of the aircraft. Here, the command signal is generated using a feedback control method based on the signal indicating the target posture of (1) and (b) and the nonlinear relationship of (2) and (a). One or more sensors are operably connected to the aircraft and measure aircraft dynamics resulting from operation of the one or more propulsion units. The measured dynamics are fed to one or more processors, resulting in a feedback control scheme that adjusts or validates the command signal of (c).

ある実施形態では、航空機は無人航空機であってもよい。航空機は、複数の推進ユニットに動作可能に接続された複数のアクチュエータを含むことができる。推進ユニットは、航空機の揚力を生成する回転翼を含むことができる。   In certain embodiments, the aircraft may be an unmanned aerial vehicle. The aircraft can include a plurality of actuators operably connected to a plurality of propulsion units. The propulsion unit may include a rotor wing that generates the lift of the aircraft.

航空機の目標姿勢を示す信号は、無線接続により遠隔の制御器から受信できる。ユーザーは、非線形関係を入力してもよい。非線形関係は、航空機の1つ以上のアクチュエータの較正中に計算され得る。1つ以上のプロセッサは、個別または集合的に構成され、航空機の1つ以上の物理的特性に基づいて航空機の空力中心および重心を計算する。1つ以上のプロセッサは、個別または集合的に構成され航空機の物理的特性に基づいて航空機の慣性モーメントを計算し得る。フィードバック制御システムを使用する計算は、航空機の慣性モーメントを使用するフィードフォワード計算を含み得る。   A signal indicating the target attitude of the aircraft can be received from a remote controller over a wireless connection. The user may enter a non-linear relationship. The non-linear relationship can be calculated during calibration of one or more actuators in the aircraft. One or more processors are configured individually or collectively to calculate the aerodynamic center and center of gravity of the aircraft based on one or more physical characteristics of the aircraft. One or more processors may be configured individually or collectively to calculate the moment of inertia of the aircraft based on the physical characteristics of the aircraft. Calculations using the feedback control system may include feedforward calculations using aircraft moments of inertia.

フィードバック制御方式を使用する計算は、ピッチ軸、ロール軸、およびヨー軸を中心とした航空機姿勢に対して行われてもよい。また、本システムは、ピッチ軸、ロール軸、およびヨー軸についての計算の結果、ならびに航空機構成パラメータを組み合わせて、少なくとも1つのアクチュエータに送達されるコマンド信号を計算するミキサを含み得る。航空機構成パラメータは、アクチュエータから航空機の空力中心までの距離であり得る。1つ以上のセンサは、慣性センサであってもよい。   Calculations using the feedback control scheme may be performed on aircraft attitudes about the pitch axis, roll axis, and yaw axis. The system may also include a mixer that combines the results of the calculations for the pitch, roll, and yaw axes, and aircraft configuration parameters to calculate a command signal that is delivered to at least one actuator. The aircraft configuration parameter may be the distance from the actuator to the aerodynamic center of the aircraft. The one or more sensors may be inertial sensors.

航空機の動態は、少なくとも1つの軸に対する航空機の姿勢、少なくとも1つの軸に対する角速度、および少なくとも1つの軸に対する角加速度を含み得る。   Aircraft dynamics may include aircraft attitude with respect to at least one axis, angular velocity with respect to at least one axis, and angular acceleration with respect to at least one axis.

本発明は更に、その実施形態として、航空機姿勢を制御する方法を提供できる。本方法は、以下の(a)〜(d)のステップを含み得る。(a)航空機の目標姿勢を示す信号をプロセッサで受信するステップ、(b)航空機の1つ以上の推進ユニットに動作可能に接続された、航空機の少なくとも1つのアクチュエータに送達されるコマンド信号を、(a)の目標姿勢を示す信号に基づき、かつ、(1)角加速度フィードバックを持つ角加速度ループ、および(2)目標加速度に基づく直接フィードフォワード計算を含む、フィードバック制御方式を使用して、プロセッサを用いて生成するステップ、(c)1つ以上の推進ユニットの作動に起因する航空機の動態を、航空機に動作可能に接続された1つ以上のセンサを用いて測定するステップ、(d)動態をプロセッサに供給して、(b)のコマンド信号を調節または確証するフィードバック制御方式をもたらすステップ。 The present invention can further provide a method for controlling an aircraft attitude as an embodiment thereof. The method may include the following steps (a) to (d). (A) receiving a signal indicative of a target attitude of the aircraft with a processor; (b) a command signal delivered to at least one actuator of the aircraft operatively connected to one or more propulsion units of the aircraft; Using a feedback control scheme based on (a) a signal indicating the target attitude and including (1) an angular acceleration loop with angular acceleration feedback, and (2) a direct feedforward calculation based on the target angular acceleration, Generating with a processor, (c) measuring aircraft dynamics resulting from the operation of one or more propulsion units using one or more sensors operably connected to the aircraft, (d) Providing dynamics to the processor to provide a feedback control scheme to adjust or validate the command signal of (b).

航空機は無人航空機であってもよい。航空機は、複数の推進ユニットに動作可能に接続された複数のアクチュエータを含むことができる。推進ユニットは、航空機の揚力を生成する回転翼を含むことができる。   The aircraft may be an unmanned aircraft. The aircraft can include a plurality of actuators operably connected to a plurality of propulsion units. The propulsion unit may include a rotor wing that generates the lift of the aircraft.

航空機の目標姿勢を示す信号は、無線接続により遠隔の制御器から受信できる。本方法は、航空機の空力中心および重心を、航空機の1つ以上の物理的特性に基づいて計算するステップ、を更に含み得る。本方法は、航空機の慣性モーメントを、航空機の物理的特性に基づいて計算するステップ、を更に含み得る。フィードフォワード計算は、航空機の慣性モーメントを使用してもよい。フィードバック制御方式を使用する計算は、ピッチ軸、ロール軸、およびヨー軸を中心とした航空機姿勢に対して行われてもよい。   A signal indicating the target attitude of the aircraft can be received from a remote controller over a wireless connection. The method may further include calculating an aerodynamic center and center of gravity of the aircraft based on one or more physical characteristics of the aircraft. The method may further include the step of calculating the moment of inertia of the aircraft based on the physical characteristics of the aircraft. The feed forward calculation may use the moment of inertia of the aircraft. Calculations using the feedback control scheme may be performed on aircraft attitudes about the pitch axis, roll axis, and yaw axis.

本方法は、ミキサを使用して、ピッチ軸、ロール軸、およびヨー軸についての計算の結果、ならびに航空機構成パラメータを組み合わせて、少なくとも1つのアクチュエータに送達されるコマンド信号を計算することを更に含み得る。航空機構成パラメータは、アクチュエータから航空機の空力中心までの距離であってもよい。1つ以上のセンサは、慣性センサであってもよい。   The method further includes using the mixer to calculate the command signal delivered to the at least one actuator by combining the results of the calculations for the pitch, roll, and yaw axes and the aircraft configuration parameters. obtain. The aircraft configuration parameter may be the distance from the actuator to the aerodynamic center of the aircraft. The one or more sensors may be inertial sensors.

航空機の動態は、少なくとも1つの軸に対する航空機の姿勢、少なくとも1つの軸に対する角速度、および少なくとも1つの軸に対する角加速度を含み得る。   Aircraft dynamics may include aircraft attitude with respect to at least one axis, angular velocity with respect to at least one axis, and angular acceleration with respect to at least one axis.

本発明の実施形態は、個別または集合的に構成され、以下の(a)〜(b)の動作を実行する1つ以上のプロセッサを備える、航空機姿勢制御システムを対象とし得る。(a)航空機の目標姿勢を示す信号を受信し、(b)航空機の1つ以上の推進ユニットに動作可能に接続された航空機の少なくとも1つのアクチュエータに送達されるコマンド信号を生成する。ここで、コマンド信号は、(1)(b)の目標姿勢を示す信号、および(2)(a)の非線形関係に基づき、フィードバック制御方式を使用して生成される。1つ以上のセンサが、航空機に動作可能に接続され、1つ以上の推進ユニットの作動に起因する航空機の動態を測定する。測定された動態は、1つ以上のプロセッサに供給され、(c)のコマンド信号を調節または確証するフィードバック制御方式をもたらす。   Embodiments of the present invention may be directed to an aircraft attitude control system that is configured individually or collectively and includes one or more processors that perform the following operations (a) to (b). (A) receiving a signal indicative of the target attitude of the aircraft; and (b) generating a command signal that is delivered to at least one actuator of the aircraft operatively connected to one or more propulsion units of the aircraft. Here, the command signal is generated using a feedback control method based on the signal indicating the target posture of (1) and (b) and the nonlinear relationship of (2) and (a). One or more sensors are operably connected to the aircraft and measure aircraft dynamics resulting from operation of the one or more propulsion units. The measured dynamics are fed to one or more processors, resulting in a feedback control scheme that adjusts or validates the command signal of (c).

ある実施形態では、航空機は無人航空機であってもよい。航空機は、複数の推進ユニットに動作可能に接続された複数のアクチュエータを含むことができる。推進ユニットは、航空機の揚力を生成する回転翼を含むことができる。   In certain embodiments, the aircraft may be an unmanned aerial vehicle. The aircraft can include a plurality of actuators operably connected to a plurality of propulsion units. The propulsion unit may include a rotor wing that generates the lift of the aircraft.

航空機の目標姿勢を示す信号は、無線接続により遠隔の制御器から受信できる。1つ以上のプロセッサは、個別または集合的に構成され、航空機の1つ以上の物理的特性に基づいて航空機の空力中心および重心を計算し得る。1つ以上のプロセッサは、個別または集合的に構成され、航空機の物理的特性に基づいて航空機の慣性モーメントを計算し得る。フィードフォワード計算は、航空機の慣性モーメントを使用してもよい。また、フィードバック制御方式を使用する計算は、ピッチ軸、ロール軸、およびヨー軸を中心とした航空機姿勢に対して行われてもよい。   A signal indicating the target attitude of the aircraft can be received from a remote controller over a wireless connection. One or more processors may be configured individually or collectively to calculate the aerodynamic center and center of gravity of the aircraft based on one or more physical characteristics of the aircraft. One or more processors may be configured individually or collectively to calculate the moment of inertia of the aircraft based on the physical characteristics of the aircraft. The feed forward calculation may use the moment of inertia of the aircraft. Further, the calculation using the feedback control method may be performed with respect to the aircraft attitude around the pitch axis, the roll axis, and the yaw axis.

本システムは、ピッチ軸、ロール軸、およびヨー軸についての計算の結果、ならびに航空機構成パラメータを組み合わせて、少なくとも1つのアクチュエータに送達されるコマンド信号を計算するように構成されるミキサを含み得る。航空機構成パラメータは、アクチュエータから航空機の空力中心までの距離であってもよい。1つ以上のセンサは、慣性センサであってもよい。   The system may include a mixer configured to combine the results of the calculations for the pitch, roll, and yaw axes, and aircraft configuration parameters to calculate a command signal that is delivered to at least one actuator. The aircraft configuration parameter may be the distance from the actuator to the aerodynamic center of the aircraft. The one or more sensors may be inertial sensors.

ある実施形態に従い、航空機の動態は、少なくとも1つの軸に対する航空機の姿勢、少なくとも1つの軸に対する角速度、および少なくとも1つの軸に対する角加速度を含み得る。   According to certain embodiments, aircraft dynamics may include an aircraft attitude with respect to at least one axis, an angular velocity with respect to at least one axis, and an angular acceleration with respect to at least one axis.

本発明の様々な実施形態は、個別に、集合的に、または相互に組み合わせて認識され得ることを理解されたい。本明細書で説明される本発明の様々な実施形態は、以下に示される任意の特定の用途、または任意の他の類型の可動物体に適用され得る。無人航空機などの航空機に関する本発明の任意の説明は、任意の航空機などの任意の可動物体に適用および使用され得る。加えて、空中運動(例えば、飛行)の文脈において本明細書で説明するシステム、デバイス、および方法はまた、地上もしくは水上の運動、水中の運動、または宇宙での運動などの他の類型の運動の文脈において適用され得る。   It should be understood that the various embodiments of the invention may be recognized individually, collectively, or in combination with each other. The various embodiments of the present invention described herein may be applied to any particular application shown below, or any other type of movable object. Any description of the invention relating to an aircraft, such as an unmanned aerial vehicle, can be applied and used for any movable object, such as any aircraft. In addition, the systems, devices, and methods described herein in the context of aerial motion (eg, flight) may also include other types of motion, such as ground or water motion, underwater motion, or space motion. Can be applied in the context of

本発明の他の目的および特徴は、明細書、特許請求の範囲、および添付の図面の検討によって明らかになるであろう。   Other objects and features of the present invention will become apparent upon review of the specification, claims and appended drawings.

(参照による組み込み)
本明細書で言及した全ての刊行物、特許、および特許出願は、個別の刊行物、特許、または特許出願のそれぞれが具体的にかつ個別に示されて参照によって組み込まれるのと同程度に参照によって本明細書に組み込まれる。
(Incorporation by reference)
All publications, patents, and patent applications mentioned in this specification are referenced to the same extent as if each individual publication, patent, or patent application was specifically and individually indicated and incorporated by reference. Is incorporated herein by reference.

本発明の新規の特徴は、添付の特許請求の範囲において、詳細に示される。本発明の特徴および利点のより良い理解が、その中で本発明の原理が利用される例示的な実施形態を示す以下の詳細な説明、および以下の付随する図面を参照することによって得られるであろう。   The novel features of the invention are set forth with particularity in the appended claims. A better understanding of the features and advantages of the present invention will be obtained by reference to the following detailed description that sets forth illustrative embodiments, in which the principles of the invention are utilized, and the accompanying drawings of which: I will.

本発明を適用した、多段姿勢制御方法を示す図である。It is a figure which shows the multistage attitude | position control method to which this invention is applied. 本発明の実施形態に関わる、航空機の物理的パラメータがどのように航空機の姿勢制御方法と関連付けられ得るかを示す図である。FIG. 2 illustrates how aircraft physical parameters can be associated with an aircraft attitude control method in accordance with an embodiment of the present invention. A〜Cは、本発明の実施形態に関わる、航空機の1つ以上の物理的パラメータに対して検討できる種々の物理的特性を示す図である。FIGS. 4A to 4C are diagrams illustrating various physical characteristics that can be considered for one or more physical parameters of an aircraft, according to embodiments of the present invention. 本発明の実施形態に関わる、航空機の1つ以上の物理的パラメータに対して検討することができる種々の物理的特性を示す図である。FIG. 6 illustrates various physical characteristics that can be considered for one or more physical parameters of an aircraft, according to embodiments of the present invention. 本発明の実施形態に関わる、航空機の制御方法における1つ以上のパラメータを決定するために、航空機モデルをどのように使用することができるかを示す図である。FIG. 2 illustrates how an aircraft model can be used to determine one or more parameters in an aircraft control method according to an embodiment of the present invention. 本発明を適用した、飛行制御器を持つ航空機を示す図である。It is a figure which shows the aircraft with a flight controller to which this invention is applied. 本発明の実施形態に関わる、航空機が実装し得る姿勢制御方式を示す図である。It is a figure which shows the attitude | position control system which can implement the aircraft in connection with embodiment of this invention. 本発明の実施形態に関わる、航空機が実装し得る姿勢制御方式を示す図である。It is a figure which shows the attitude | position control system which can implement the aircraft in connection with embodiment of this invention. 本発明の実施形態に関わる、制御内側ループの一部分を示す図である。FIG. 3 is a diagram showing a part of a control inner loop according to an embodiment of the present invention. 本発明の実施形態に関わる、姿勢制御方式を示す図である。It is a figure which shows the attitude | position control system in connection with embodiment of this invention. 本発明の実施形態に関わる、追従誤差を示す図である。It is a figure which shows the tracking error in connection with embodiment of this invention. 本発明の実施形態に関わる、追従誤差を示す更なる図である。FIG. 6 is a further diagram illustrating a tracking error according to an embodiment of the present invention. 従来の制御器と比較した、本発明を適用した制御器の応答との間の比較を示す図である。FIG. 4 shows a comparison between the response of a controller to which the present invention is applied compared to a conventional controller. 本発明の実施形態に関わる、無人航空機を示す図である。It is a figure showing an unmanned aerial vehicle in connection with an embodiment of the present invention. 本発明の実施形態に関わる、支持機構および搭載物を含む可動物体を示す図である。It is a figure which shows the movable object in connection with embodiment of this invention including a support mechanism and a load. 本発明の実施形態に関わる、可動物体を制御するシステムの、ブロック図である。It is a block diagram of the system which controls a movable object in connection with embodiment of this invention.

本発明は、航空機の飛行の姿勢制御を行うシステム、デバイス、および方法を提供する。航空機は、無人航空機(UAV)、または任意の他の類型の可動物体であってもよい。航空機は、多重回転翼航空機であってもよい。   The present invention provides systems, devices, and methods for performing attitude control of aircraft flight. The aircraft may be an unmanned aerial vehicle (UAV) or any other type of movable object. The aircraft may be a multi-rotor wing aircraft.

多重回転翼航空機制御方式のための典型的な姿勢制御方法は、カスケード接続された比例積分微分(PID)制御を利用する。この場合、姿勢制御は、角速度制御とカスケード接続される。従来のPID調節方法に基づいて、内側ループ(角速度ループ)および外側ループ(角度ループ)のパラメータを順次調整し得る。   A typical attitude control method for a multi-rotor aircraft control scheme utilizes cascaded proportional integral derivative (PID) control. In this case, the attitude control is cascaded with the angular velocity control. Based on a conventional PID adjustment method, the parameters of the inner loop (angular velocity loop) and the outer loop (angular loop) may be adjusted sequentially.

従来のカスケード接続された制御器に関しては、内側ループの較正結果に強く依存し、内側ループの追従性能が良好でない場合、それは結果全体に直接影響を与える。したがって、内側ループの設計およびパラメータの調整は非常に重要である。しかし、従来のPID調整のプロセスは複雑かつ冗長であり、プロセス中にシステムの発散および不安定性の問題が生じやすい。制御パラメータは、典型的に実際の調整結果を使用するのが標準であるが、システム依存性が強い。システムが変化する場合(例えば、航空機構造、回転翼距離、重量が変化する場合)は、改めてパラメータを調整する必要がある。その上、調整周期が比較的長い。主な理由は、システムモデルの完全な理解の欠如によるものであり、パラメータ間に関係が存在しない。   For a conventional cascaded controller, it relies heavily on the inner loop calibration results, and if the inner loop tracking performance is not good, it directly affects the overall results. Therefore, the inner loop design and parameter adjustment are very important. However, the conventional PID adjustment process is complex and redundant, and system divergence and instability problems are likely to occur during the process. Control parameters are typically standard using actual adjustment results, but are highly system dependent. If the system changes (e.g., aircraft structure, rotor wing distance, weight changes), the parameters need to be adjusted again. In addition, the adjustment period is relatively long. The main reason is due to the lack of complete understanding of the system model and there is no relationship between the parameters.

従来のカスケード接続されたPID制御の下で、内側角速度ループは主に速度外乱に耐えるように設計されている。そのため、正常な状況下では、制御器は外乱によって既に航空機が角速度を発生させた後でのみ調節を行う。特定の状況下では、外乱除去性能は、最適な状態を達成できない。   Under conventional cascaded PID control, the inner angular velocity loop is designed primarily to withstand velocity disturbances. Thus, under normal circumstances, the controller only makes adjustments after the aircraft has already generated an angular velocity due to disturbance. Under certain circumstances, disturbance rejection performance cannot achieve optimal conditions.

改善された飛行制御方法およびシステムを本発明において提供する。例えば、飛行姿勢制御方法は、航空機の物理的パラメータまたは動的パラメータの少なくとも一方を考慮に入れることができる。例えば、航空機構造および推進に従い、性能限界を自動的に評価し、制御のための基準として使用できる。航空機モデルを基数として使用し、物理的パラメータまたは動的パラメータの少なくとも一方を制御器の係数とできる。これにより、異なる航空機モデルに対してPID制御を調節することが容易となり得る。事前評価を行い得ることで、制御システムを異なる航空機モデルに対して区別でき、異なるモデルに容易に適用できる。ある例では、非線形パラメータを検討できる。   Improved flight control methods and systems are provided in the present invention. For example, the flight attitude control method can take into account at least one of aircraft physical parameters or dynamic parameters. For example, according to aircraft structure and propulsion, performance limits can be automatically evaluated and used as a basis for control. An aircraft model can be used as a radix and at least one of physical parameters or dynamic parameters can be a coefficient of the controller. This can facilitate adjusting PID control for different aircraft models. By being able to perform prior assessment, the control system can be distinguished for different aircraft models and can be easily applied to different models. In one example, nonlinear parameters can be considered.

ある実施形態では、航空機の物理的パラメータを評価して、航空機全体の慣性モーメントを決定し得る。また、物理的パラメータを評価して、航空機の空力中心を計算し、航空機のモーターまたは推進ユニットから空力中心までの軸方向距離も決定できる。また、物理的パラメータを使用して、航空機の1つ以上のモーターに対するモーター推力/揚力曲線も決定できる。これらのパラメータは、航空機の姿勢制御に使用できる航空機構成パラメータであってもよい。これらのパラメータは、リアルタイムで評価できるか、事前評価できる。航空機構成パラメータは、航空機の種々のモデルと関連付けられ得る。航空機モデルを選択でき、適切な航空機構成パラメータを、姿勢制御方式にも適用できる。   In some embodiments, aircraft physical parameters may be evaluated to determine the moment of inertia of the entire aircraft. The physical parameters can also be evaluated to calculate the aerodynamic center of the aircraft and to determine the axial distance from the aircraft motor or propulsion unit to the aerodynamic center. The physical parameters can also be used to determine a motor thrust / lift curve for one or more motors of the aircraft. These parameters may be aircraft configuration parameters that can be used for aircraft attitude control. These parameters can be evaluated in real time or pre-evaluated. Aircraft configuration parameters may be associated with various models of aircraft. Aircraft models can be selected and appropriate aircraft configuration parameters can be applied to attitude control methods.

更に、改善された飛行制御方法は、PID制御方式に角加速度ループを追加することを含み得る。本飛行制御方法はまた、直接制御を行うこと、ならびに外乱除去および追従性能を強化することを含み得る。角加速度ループは直接制御として作動できるため、強い耐外乱特性によって応答時間が短くなり得る。外乱を直接抑制することにより、応答時間を削減できる。   Further, the improved flight control method may include adding an angular acceleration loop to the PID control scheme. The flight control method may also include performing direct control and enhancing disturbance rejection and tracking performance. Since the angular acceleration loop can be operated as a direct control, the response time can be shortened due to strong disturbance resistance characteristics. By directly suppressing disturbance, response time can be reduced.

図1には、本発明を適用した、多段姿勢制御方法が示されている。多段姿勢制御を使用して、UAVまたは任意の他の類型の航空機などの航空機の姿勢を制御できる。航空機は、有人または無人であってもよい。航空機は、航空機に揚力を提供できる2つ以上の回転翼を含み得る多重回転翼航空機であってもよい。航空機はシングル回転翼航空機であってもよい。航空機の飛行制御に関する本明細書中の一切の記載は、任意の他の可動物体に適用できる。例えば、本明細書に記載の姿勢制御方法は、宇宙船または水中船の少なくとも一方に適用してもよい。姿勢制御の1つ以上の実施形態は、航空機、大気圏外航空機、陸用航空機、または水用航空機に適用してもよい。   FIG. 1 shows a multistage attitude control method to which the present invention is applied. Multi-stage attitude control can be used to control the attitude of an aircraft, such as a UAV or any other type of aircraft. The aircraft may be manned or unmanned. The aircraft may be a multi-rotor aircraft that may include two or more rotors that can provide lift to the aircraft. The aircraft may be a single rotorcraft. Any statement herein relating to aircraft flight control is applicable to any other movable object. For example, the attitude control method described in this specification may be applied to at least one of a spacecraft or an underwater ship. One or more embodiments of attitude control may apply to an aircraft, an out-of-atmosphere aircraft, a land aircraft, or a water aircraft.

姿勢制御は、航空機を中心とした1つ以上の回転軸を中心として実装できる。例えば、姿勢制御は、ピッチ軸、ロール軸、またはヨー軸の少なくとも1つを中心として実装してもよい。姿勢制御は、これらの軸のうちの1つ、これらの軸のうちの2つ、またはこれらの軸のうちの3つ全てを中心として実装してもよい。   Attitude control can be implemented around one or more axes of rotation about the aircraft. For example, the attitude control may be implemented around at least one of the pitch axis, the roll axis, and the yaw axis. Attitude control may be implemented around one of these axes, two of these axes, or all three of these axes.

姿勢制御方法は、複数の段階で実装できる。例えば、事前構成段階および飛行段階を設けることができる。事前構成段階および飛行段階は、異なる時点または異なる場所の少なくとも一方で行うことができる。   The attitude control method can be implemented in multiple stages. For example, a pre-configuration stage and a flight stage can be provided. The pre-configuration stage and the flight stage can be performed at different times or at least at different locations.

ある実施形態では、事前構成段階は、航空機の1つ以上の物理的パラメータを評価し得る間に行ってもよい。1つ以上の計算は、航空機の物理的パラメータに基づいて行い得る。航空機の物理的パラメータは、高さ、幅、長さ、直径、対角線、または円周などの空間寸法を含み得る。物理的パラメータはまた、航空機胴体または任意の伸長部分の少なくとも一方の形状などの、航空機の形態学を考慮に入れてもよい。物理的パラメータはまた、重量、重量配分、重心、または密度などの他の要因を考慮に入れてもよい。物理的パラメータの更なる例は、本明細書の他の箇所に記載する。   In some embodiments, the pre-configuration phase may be performed while one or more physical parameters of the aircraft may be evaluated. One or more calculations may be based on aircraft physical parameters. Aircraft physical parameters may include spatial dimensions such as height, width, length, diameter, diagonal, or circumference. The physical parameters may also take into account the morphology of the aircraft, such as the shape of the aircraft fuselage or at least one of the elongated portions. The physical parameters may also take into account other factors such as weight, weight distribution, center of gravity, or density. Additional examples of physical parameters are described elsewhere herein.

動的パラメータは、事前設定段階中に評価できる。あるいは、動的パラメータは、後の段階で検討してもよい。動的パラメータは、推力または電力などの、電池関連の仕様もしくは他の電源仕様、またはモーター特性を含み得る。動的パラメータの更なる例は、本明細書の他の箇所に記載する。   Dynamic parameters can be evaluated during the pre-setting phase. Alternatively, dynamic parameters may be considered at a later stage. Dynamic parameters may include battery related specifications, such as thrust or power, or other power supply specifications, or motor characteristics. Additional examples of dynamic parameters are described elsewhere herein.

事前構成段階は、航空機の1つ以上のモデルに対して行うことができる。例えば、異なる航空機モデルは、異なる物理的パラメータまたは動的パラメータの少なくとも一方を有し得る。例えば、異なる航空機モデルは、異なる形状、大きさ、重量、重量配分、電源特性、モーター特性、または他の異なる特徴もしくは特性を有してもよい。また、事前構成は、航空機の1つ以上のモデルの製造業者または販売業者が行うことができる。事前構成は、航空機の1つ以上のモデルに適用できる制御システムの製造業者または販売業者が行うことができる。事前構成は、航空機の制御を補助するための事前構成からの情報を提供できる任意の第三者によっても行うことができる。情報は、航空機を制御する飛行制御器がアクセス可能であり得るメモリに記憶できる。また、事前構成は、航空機のエンドユーザーによって実行されない。例えば、事前構成は、航空機を操作するユーザーとは異なる存在が実行してもよい。事前構成は、エンドユーザーが航空機にアクセスする前に実行できる。例えば、事前構成は、ユーザーが航空機にアクセスする、またはユーザーが航空機を操作する、数時間、数日、数週、数か月、数四半期、または数年前に行ってもよい。   The pre-configuration phase can be performed on one or more models of the aircraft. For example, different aircraft models may have at least one of different physical parameters or dynamic parameters. For example, different aircraft models may have different shapes, sizes, weights, weight distributions, power supply characteristics, motor characteristics, or other different features or characteristics. Also, preconfiguration can be performed by the manufacturer or distributor of one or more models of the aircraft. Preconfiguration can be performed by a manufacturer or distributor of a control system that can be applied to one or more models of the aircraft. Preconfiguration can also be done by any third party that can provide information from the preconfiguration to assist in controlling the aircraft. The information can be stored in a memory that can be accessed by a flight controller that controls the aircraft. Also, preconfiguration is not performed by the end user of the aircraft. For example, the pre-configuration may be performed by a different entity than the user operating the aircraft. Preconfiguration can be performed before the end user accesses the aircraft. For example, preconfiguration may be performed hours, days, weeks, months, quarters, or years before the user accesses the aircraft or the user operates the aircraft.

ある実施形態では、事前構成は、航空機の較正として実行できる。較正は、ユーザーが航空機にアクセスする前に行ってもよく、またはユーザーの航空機との相互作用とは無関係であってもよい。航空機は、事前構成情報にアクセス可能であり得る。事前構成情報は、航空機上に記憶できるか、または航空機外のメモリから航空機を介してアクセス可能であり得る。   In some embodiments, the pre-configuration can be performed as an aircraft calibration. Calibration may be performed before the user accesses the aircraft or may be independent of the user's interaction with the aircraft. The aircraft may be able to access preconfigured information. The pre-configuration information can be stored on the aircraft or can be accessible via the aircraft from memory outside the aircraft.

また、飛行段階は、事前構成段階の後に行うことができる。飛行段階は、ユーザーが航空機にアクセスする時に設けることができる。飛行段階は、ユーザーが航空機を操作できる時であり得る。飛行段階中、姿勢制御方法は、航空機上で使用できる。姿勢制御システムは、飛行中に航空機の姿勢を制御するために、航空機によって使用され得る。姿勢制御システムは、事前構成段階中早期に収集され得る事前構成情報を使用してもよい。   Also, the flight phase can be performed after the pre-configuration phase. The flight phase can be provided when the user accesses the aircraft. The flight phase can be when the user can operate the aircraft. During the flight phase, the attitude control method can be used on an aircraft. The attitude control system may be used by an aircraft to control the attitude of the aircraft during flight. The attitude control system may use pre-configuration information that can be collected early during the pre-configuration phase.

更なる較正を飛行段階で行っても行わなくてもよい。ある実施形態では、ユーザーが航空機をオンにする度に、幾つかの較正が生じ得る。あるいは、較正は、ユーザーが初めて航空機を受け取り、それを最初に操作するときに、行ってもよい。別の実施形態では、較正は、要請に応じて行ってもよい。較正情報は、航空機の物理的寸法を決定するために使用してもしなくてもよい。較正情報は、航空機の動的特性を決定するために使用してもしなくてもよい。飛行段階の較正情報は、飛行姿勢制御方法に対する1つ以上の係数を決定するための事前構成情報と結合してもしなくてもよい。   Further calibration may or may not be performed during the flight phase. In some embodiments, several calibrations can occur each time the user turns on the aircraft. Alternatively, calibration may be performed when the user first receives the aircraft and operates it for the first time. In another embodiment, calibration may be performed on demand. The calibration information may or may not be used to determine the physical dimensions of the aircraft. The calibration information may or may not be used to determine aircraft dynamic characteristics. The flight stage calibration information may or may not be combined with pre-configuration information for determining one or more coefficients for the flight attitude control method.

図2には、本発明の実施形態に関わる、航空機の物理的パラメータがどのように航空機の姿勢制御方法と関連付けられ得るかが示されている。ある実施形態では、これらのステップは、事前構成段階中に行うことができる。   FIG. 2 shows how aircraft physical parameters can be associated with an aircraft attitude control method according to an embodiment of the present invention. In certain embodiments, these steps can be performed during the pre-configuration phase.

航空機の1つ以上の物理的パラメータを評価できる。ある実施形態では、これらのパラメータは、人間が手作業で測定してもよく、またはプロセッサを用いて自動で測定してもよい。また、生物がデバイスを用いてデータを入力して、メモリに記憶してもよい。例えば、人間が航空機の寸法を測定し、データを入力することができる。別の実施形態では、1つ以上の機械を使用して航空機の物理的パラメータを決定してもよく、データを、情報を記憶するメモリに自動的に提供してもよい。例えば、航空機の重量を測定し、自動的にメモリに通信してもよい。   One or more physical parameters of the aircraft can be evaluated. In some embodiments, these parameters may be measured manually by a human or automatically using a processor. In addition, a living organism may input data using a device and store it in a memory. For example, a human can measure the dimensions of an aircraft and enter data. In another embodiment, one or more machines may be used to determine aircraft physical parameters, and the data may be automatically provided to a memory storing information. For example, the weight of the aircraft may be measured and automatically communicated to the memory.

物理的パラメータの例としては、航空機構造または航空機動態の少なくとも一方に関係する要因が挙げられる。物理的パラメータは、高さ、幅、長さ、直径、対角線、または円周などの空間寸法を含み得る。物理的パラメータはまた、航空機胴体または任意の伸長部分の少なくとも一方の形状などの、航空機の形態学を考慮に入れてもよい。物理的パラメータはまた、重量、重量配分、重心、または密度などの他の要因を考慮に入れてもよい。また、密度、剛性、柔軟性、または弾性を考慮に入れてもよいように、航空機の1つ以上の材料特性を考慮に入れてもよい。このような物理的パラメータは、航空機構造に関係し得る。物理的パラメータは、航空機全体または航空機の1つ以上の構成要素の少なくとも一方に対して収集できる。例えば、物理的パラメータは、機体フレーム、電源(例えば、電池)、アビオニクスシステム、支持機構、搭載物、センサ、モーター、着陸装置、通信ユニット、または任意の他の構成要素に関連し得る。   Examples of physical parameters include factors related to at least one of aircraft structure or aircraft dynamics. Physical parameters can include spatial dimensions such as height, width, length, diameter, diagonal, or circumference. The physical parameters may also take into account the morphology of the aircraft, such as the shape of the aircraft fuselage or at least one of the elongated portions. The physical parameters may also take into account other factors such as weight, weight distribution, center of gravity, or density. One or more material properties of the aircraft may also be taken into account, such as density, stiffness, flexibility, or elasticity may be taken into account. Such physical parameters may be related to the aircraft structure. The physical parameters can be collected for the entire aircraft or at least one of one or more components of the aircraft. For example, the physical parameters may relate to a fuselage frame, power supply (eg, battery), avionics system, support mechanism, payload, sensor, motor, landing gear, communication unit, or any other component.

物理的パラメータはまた、航空機の動態を含んでもよい。これは、最大電池電流、最大電力出力、エネルギー密度、電池容量、放電率、定格電圧、電池寿命、または任意の他の特徴などの電源仕様を含み得る。また、電池ケミストリまたはバッテリの類型に関する情報を指定または決定できる。これはまた、推力または電力などのモーター特性を含んでもよい。また、モーター特性は、最大信頼、最大電力を含み得る。電子速度制御の電流および電力も決定できる。   The physical parameters may also include aircraft dynamics. This may include power supply specifications such as maximum battery current, maximum power output, energy density, battery capacity, discharge rate, rated voltage, battery life, or any other feature. In addition, information regarding battery chemistry or battery type can be specified or determined. This may also include motor characteristics such as thrust or power. The motor characteristics may include maximum reliability and maximum power. The current and power for electronic speed control can also be determined.

航空機に関係する任意の他の物理的パラメータを評価してもよい。航空機の物理的パラメータのうちの1つ以上に関する情報を、メモリに記憶できる。例えば、物理的パラメータデータは、1つ以上のデータベースに記憶し得る。データベースは、航空機の外部にあってもよい。データベースを、クラウドコンピューティング環境に用意すること、または複数のデバイスにわたって分配すること、の少なくとも一方が可能である。あるいは、データベースを、航空機上に用意してもよい。 Any other physical parameter related to the aircraft may be evaluated. Information about one or more of the aircraft's physical parameters can be stored in memory. For example, physical parameter data may be stored in one or more databases. The database may be external to the aircraft. The database can be prepared in a cloud computing environment and / or distributed across multiple devices. Alternatively, the database may be prepared on the aircraft.

1つ以上の計算を物理的パラメータに実行して、1つ以上の航空機構成パラメータを決定できる。物理的パラメータは、直接測定可能であり得る航空機の物理的特性を表し得る。航空機構成パラメータは、物理的パラメータに基づいて計算できる。航空機構成パラメータは、プロセッサを用いて計算できる。   One or more calculations can be performed on the physical parameters to determine one or more aircraft configuration parameters. A physical parameter may represent a physical characteristic of an aircraft that may be directly measurable. Aircraft configuration parameters can be calculated based on physical parameters. Aircraft configuration parameters can be calculated using a processor.

ある実施形態において、航空機構成パラメータは、航空機の空力中心、航空機の重心、または全航空機もしくは航空機の構成要素の慣性モーメントが挙げられるが、これらに限定されない。航空機の空力特性または安定性の少なくとも一方を分析してもよい。   In certain embodiments, aircraft configuration parameters include, but are not limited to, the aerodynamic center of the aircraft, the center of gravity of the aircraft, or the moment of inertia of the entire aircraft or aircraft components. The aerodynamic characteristics or stability of the aircraft may be analyzed.

図3には、本発明の実施形態に関わる、航空機の1つ以上の物理的パラメータに対して検討できる種々の物理的特性が示されている。図3Aは、どのように航空機の重心を計算できるかの実施例を示す。図示のように、航空機の重心が揚力面下にある場合、航空機の横飛行が一定平衡速度に到達し得る場合、揚力の水平成分は抗力に対抗、または垂直成分は重力に対抗、の少なくとも一方が可能である。また、空力中心と重力とは一致してもしなくてもよい。空力中心と重心とが一致しない状況においては、垂直揚力成分および重力が偶力を形成することにより、航空機は機首上げピッチングモーメントを経験し得る。これが航空機を水平方向に向かわせることができ、それにより航空機は安定したシステムとなり得る。したがって、航空機の設計時に、重心の位置を変更して、航空機の安定性を調節できる。航空機の重心は、物理的パラメータに基づいて計算できる。また、航空機の種々の構成要素の重量配分量および位置決定を検討して、航空機の重心を決定してもよい。重心は航空機モデルにより異なり得る。   FIG. 3 illustrates various physical characteristics that can be considered for one or more physical parameters of an aircraft according to an embodiment of the present invention. FIG. 3A shows an example of how an aircraft center of gravity can be calculated. As shown, if the aircraft's center of gravity is below the lift plane and the aircraft's lateral flight can reach a constant equilibrium speed, the horizontal component of lift is at least one of drag and the vertical component is at least one of gravity. Is possible. Further, the aerodynamic center and gravity may or may not coincide. In situations where the aerodynamic center and the center of gravity do not coincide, the aircraft can experience a nose-up pitching moment due to the vertical lift component and gravity forming a couple. This can turn the aircraft horizontally, which can make the aircraft a stable system. Therefore, the stability of the aircraft can be adjusted by changing the position of the center of gravity when designing the aircraft. The center of gravity of the aircraft can be calculated based on physical parameters. Alternatively, the center of gravity of the aircraft may be determined by considering weight distribution amounts and position determination of various components of the aircraft. The center of gravity can vary from aircraft model to aircraft model.

図3Bは、どのように航空機の慣性モーメントを計算できるかの実施例を示す。ある実施例では、航空機全体の慣性モーメント分配を分析してもよい。航空機モデルの影響および搭載物の構成を、航空機全体の慣性モーメントへのそれらの影響に対して評価してもよい。これらは、航空機の全体構成を調節するための基準として使用できる。   FIG. 3B shows an example of how an aircraft moment of inertia can be calculated. In one embodiment, the moment of inertia distribution for the entire aircraft may be analyzed. Aircraft model effects and payload configurations may be evaluated against their effects on the overall moment of inertia of the aircraft. These can be used as a reference for adjusting the overall configuration of the aircraft.

航空機の各構成要素を成す基本的物理モデルを確立してもよい。航空機構成要素の例としては、機体フレーム、電源(例えば、電池)、アビオニクスシステム、支持機構、搭載物、センサ、モーター、推進ユニット、着陸装置、または通信ユニットが挙げられるが、これらに限定されない。基本モデルは、設置場所、重量、および各構成要素の慣性モーメントに関係する規約を含んでもよい。次に、平衡軸の定理を使用して、各構成要素の慣性モーメントに基づく航空機全体の慣性モーメント。図示のように、種々の構成要素または航空機全体の形状の少なくとも一方、ならびに重量分配を、慣性モーメントの計算において検討してもよい。慣性モーメントは、収集した物理的パラメータに基づいて、プロセッサを用いて計算できる。ある実施形態では、有限要素解析(FEM)を用いてもよい。平衡軸の定理を、慣性モーメントの計算に使用してもよい。   A basic physical model that constitutes each component of the aircraft may be established. Examples of aircraft components include, but are not limited to, fuselage frames, power supplies (eg, batteries), avionics systems, support mechanisms, loads, sensors, motors, propulsion units, landing gear, or communication units. The basic model may include conventions relating to installation location, weight, and moment of inertia of each component. Next, the moment of inertia of the entire aircraft based on the moment of inertia of each component, using the equilibrium axis theorem. As shown, at least one of various components or the overall shape of the aircraft, as well as weight distribution, may be considered in the moment of inertia calculation. The moment of inertia can be calculated using a processor based on the collected physical parameters. In some embodiments, finite element analysis (FEM) may be used. The equilibrium axis theorem may be used to calculate the moment of inertia.

慣性モーメント計算のある計算例は、以下のように提供できる。
1)質点:
I=M*L^2
2)シリンダの一部分に関して:
I=1/3*M*L^2
3)シリンダの中心に関して:
I=1/2*M*R^2
式中、Iは慣性モーメント、Mは質量、Lは、質点またはシリンダ(または任意の他の形状)の中心から回転軸までの距離、およびRはシリンダの半径である。
An example calculation with moment of inertia calculation can be provided as follows.
1) Material point:
I = M * L ^ 2
2) Regarding part of the cylinder:
I = 1/3 * M * L ^ 2
3) Regarding the center of the cylinder:
I = 1/2 * M * R ^ 2
Where I is the moment of inertia, M is the mass, L is the distance from the center of the mass or cylinder (or any other shape) to the axis of rotation, and R is the radius of the cylinder.

更なる計算はトルクおよび角速度計算を含んでもよく、以下のように提供できる。
トルク=L*F
角速度=トルク/慣性モーメント
Further calculations may include torque and angular velocity calculations and can be provided as follows.
Torque = L * F
Angular velocity = torque / moment of inertia

多数の航空機モデルの理論的分析および計算に基づいて、求められている航空機の一次慣性モーメントは、電子機器および推進ユニット(例えば、プロペラ/回転翼ブレード)によって割り当てられた約50%であり得る。慣性モーメントおよび回転翼距離は平方関係でつながってよく、トルクは直線的に増加するため、同一の推進をもって、小さい回転翼距離条件下ではより優れた駆動特性があり得、大きい回転翼距離下ではより優れた安定特性があり得る。   Based on theoretical analysis and calculations of a number of aircraft models, the sought-after primary moment of inertia of the aircraft may be approximately 50% assigned by the electronics and propulsion unit (eg, propeller / rotor blade). The moment of inertia and the rotor blade distance may be connected in a square relationship, and the torque increases linearly, so with the same propulsion, there can be better driving characteristics under small rotor blade distance conditions, and under a large rotor blade distance There may be better stability characteristics.

加えて、検討できる他の航空機構成パラメータとしては、電源(例えば電池)パラメータ、アクチュエータ(例えばモーター)パラメータ、または電子速度制御(ESC)パラメータの少なくとも1つが挙げられる。   In addition, other aircraft configuration parameters that can be considered include at least one of a power (eg, battery) parameter, an actuator (eg, motor) parameter, or an electronic speed control (ESC) parameter.

例えば、物理的パラメータを使用して、これらの航空機構成パラメータを計算してもよい。最大電池電流、最大電力出力、またはエネルギー密度の少なくとも1つ、モーターの最大推力または電力の少なくとも一方、及び/又は、ESCの最大電流または電力の少なくとも一方、は以下のように評価できる。
最大電池電流電池容量×放電率
最大電力出力最大電池電流×定格電圧
モーターの最大推力または電力の少なくとも一方:実験から
ESCの最大電流または電力の少なくとも一方:実験から
For example, these aircraft configuration parameters may be calculated using physical parameters. Maximum battery current, the maximum power output, or at least one of energy density, at least one of the maximum thrust or power of the motor, and / or the maximum current or at least hand power of ESC, can be evaluated as follows.
Maximum battery current = battery capacity x discharge rate
Maximum power output = maximum battery current x rated voltage
At least one of maximum motor thrust or power : from experiments
ESC maximum current or power : From experiment

更に、推進システムの安全性またはコンプライアンスの少なくとも一方を評価することが望ましい場合がある。例えば、電池が提供できる電流>ESCの最大電流>モーターの電流であることが望ましい場合がある。   Furthermore, it may be desirable to evaluate at least one of safety or compliance of the propulsion system. For example, it may be desirable that the current that the battery can provide> the maximum current of the ESC> the current of the motor.

物理的パラメータからの航空機構成パラメータの更なる計算は、ホバー性能評価を含み得る。例えば、航空機の重量および動態に基づき、ホバー電力出力、電力使用量、効率、電力、または推定ホバー時間の少なくとも1つの計算ができる。計算は、プロセッサを用いて実行できる。   Further calculation of aircraft configuration parameters from physical parameters may include hover performance evaluation. For example, at least one calculation of hover power output, power usage, efficiency, power, or estimated hover time can be made based on the weight and dynamics of the aircraft. The calculation can be performed using a processor.

モーター出力は、1つ以上のデータベース内のモーターに関するデータにアクセスすることから決定できる。また、モーターに関するデータは、航空機の重量およびモーター張力曲線に基づくルックアップテーブルであってもよく、効率は、モーター出力に基づくルックアップテーブルから決定できる。ルックアップテーブルは、経験的試験データに基づいて作成してもよい。あるいは、ルックアップテーブルは、模擬または予測データに基づいて作成できる。また、ループアップテーブル上のデータは、個人が入力してもよい。また、モーター張力曲線は非線形であってもよい。   The motor output can be determined from accessing data about the motor in one or more databases. The motor data may also be a look-up table based on aircraft weight and motor tension curves, and efficiency may be determined from a look-up table based on motor power. The lookup table may be created based on empirical test data. Alternatively, the lookup table can be created based on simulated or predicted data. The data on the loop-up table may be input by an individual. The motor tension curve may be non-linear.

1つ以上のホバー特性は、以下のように計算できる。
ホバー電力=重量/効率
ホバー電流=ホバー電力/電圧
時間=電池容量/ホバー電流
One or more hover characteristics can be calculated as follows.
Hover power = weight / efficiency hover current = hover power / voltage time = battery capacity / hover current

また、物理的パラメータを使用して、作動性能評価を行うことができる。作動性能評価からの1つ以上の航空機構成パラメータとしては、推力対重量比、速度に関するパラメータ(例えば、最大上昇速度、最大降下速度、設計された制動距離に基づく上限速度)、角に関するパラメータ(例えば、理論的最大姿勢角、補償後の姿勢角、限界姿勢角)、トルクに関するパラメータ(例えば、3軸トルク)、角速度に関するパラメータ(例えば、制動角を使用して最大角速度を計算)、モーター回転に関するパラメータ(例えば、ヨー軸上のモーター回転方向の影響、または関連する補償の少なくとも1つを計算)が挙げられるが、これらに限定されない。   In addition, physical performance can be used to evaluate operating performance. One or more aircraft configuration parameters from operational performance evaluation include thrust to weight ratio, speed parameters (eg, maximum ascent speed, maximum descent speed, upper speed limit based on the designed braking distance), angular parameters (eg, , Theoretical maximum attitude angle, compensated attitude angle, limit attitude angle), parameters related to torque (eg, triaxial torque), parameters related to angular velocity (eg, calculation of maximum angular velocity using braking angle), motor rotation Parameters, such as, but not limited to, calculating at least one of the effects of motor rotation direction on the yaw axis or the associated compensation.

図3Cは、本発明の実施形態に関わる、航空機の1つ以上の物理的パラメータに対して検討できる種々の物理的特性を示す図である。航空機構成パラメータのうちの1つ以上はまた、以下のように計算できる。
推力対重量比=最大推力/重量
ホバー揚力(N)=航空機全体の重量(kg)*9.8(m/s^2)
ホバースロットル=ルックアップ(揚力)、単位:%
ホバー効率=ルックアップ(ホバースロットル)、単位:g/ワット
ホバー制動効率=ルックアップ(ホバースロットル)、単位:g/ワット
ホバー電流=航空機全体の重量/効率
ホバー時間=電池容量/ホバー電流
最大姿勢角=アルコス(ホバー揚力/最大揚力)
FIG. 3C is a diagram illustrating various physical characteristics that can be considered for one or more physical parameters of an aircraft in accordance with an embodiment of the present invention. One or more of the aircraft configuration parameters can also be calculated as follows.
Thrust-to-weight ratio = Maximum thrust / weight Hover lift (N) = Overall aircraft weight (kg) * 9.8 (m / s ^ 2)
Hover throttle = lookup (lift), unit:%
Hover efficiency = Lookup (hover throttle), Unit: g / Watt Hover braking efficiency = Lookup (Hover throttle), Unit: g / Watt Hover current = Overall aircraft weight / efficiency Hover time = Battery capacity / Hover current Maximum attitude Angle = Arcos (hover lift / maximum lift)

図2に示すように、航空機構成パラメータは、航空機からの1つ以上の物理的パラメータに基づいて計算できる。航空機構成パラメータは、航空機モデルと関連付けることができる。例えば、異なる航空機モデル(例えば、UAVモデル、有人型航空機モデル)は、異なる物理的パラメータおよび関連する航空機構成パラメータを有し得る。航空機構成パラメータは、モデルの各々に対して収集または記憶の少なくとも一方が可能である。また、航空機構成パラメータの一部としては、経験的に受信したデータ、ユーザーが手動で入力したデータ、モデル化もしくは模擬データ、または任意の既存データに基づいて計算したデータが挙げられる。   As shown in FIG. 2, aircraft configuration parameters can be calculated based on one or more physical parameters from the aircraft. Aircraft configuration parameters can be associated with an aircraft model. For example, different aircraft models (eg, UAV model, manned aircraft model) may have different physical parameters and associated aircraft configuration parameters. Aircraft configuration parameters can be collected and / or stored for each of the models. Also, some of the aircraft configuration parameters include empirically received data, data manually entered by the user, modeled or simulated data, or data calculated based on any existing data.

1つ以上の航空機構成パラメータとしては、航空機飛行制御器を調整するために使用できる制御器パラメータが挙げられる。例えば、航空機の慣性モーメント、モーター張力曲線、および動的加速/減速性能を使用して、制御器パラメータを自動で調整できる。このような調整は、追従誤差に従って行うことができる。航空機構成パラメータを使用することで、パラメータ調整プロセスを簡素化し、制御器性能を強化できる。   One or more aircraft configuration parameters include controller parameters that can be used to adjust the aircraft flight controller. For example, aircraft parameters of inertia, motor tension curves, and dynamic acceleration / deceleration performance can be used to automatically adjust controller parameters. Such adjustment can be performed according to the tracking error. Using aircraft configuration parameters can simplify the parameter adjustment process and enhance controller performance.

ある実施形態では、航空機の慣性モーメント、モーター揚力出力曲線、または軸方向距離(例えば、モーターから空力中心までの距離)の少なくとも1つを提供することで、制御器性能を強化できる。このようなパラメータは、異なる航空機モデルを区別するために有用であり得る。このようなパラメータは、航空機モデルと関連付けることができる。したがって、ユーザーが航空機を受け取るとき、ユーザーが航空機モデルを指定してもよいし、または航空機モデルが既に事前プログラムされていてもよい。特定の航空機モデルのパラメータを飛行制御システムで使用して、航空機の姿勢を制御できる。   In certain embodiments, controller performance can be enhanced by providing at least one of an aircraft moment of inertia, a motor lift output curve, or an axial distance (eg, the distance from the motor to the aerodynamic center). Such parameters can be useful for distinguishing different aircraft models. Such parameters can be associated with the aircraft model. Thus, when a user receives an aircraft, the user may specify an aircraft model or the aircraft model may already be preprogrammed. Certain aircraft model parameters can be used in the flight control system to control the attitude of the aircraft.

図3Dは、本発明の実施形態に関わる、航空機の動作原理のセットを示す。航空機はまた、3自由度を有してもよい。例えば、航空機は、3つの回転軸を中心として、かつ揚力を生成するために、回転することが可能であり得る。例えば、回転翼機において、回転翼は、回転して航空機の揚力を生成することができる。回転翼が回転することで、航空機は、同時に1つ、2つ、または3つの回転の軸を中心として回転することが可能となり得る。また、回転の軸は、相互に直交していること、または航空機の飛行中に相互に直交したままでいること、の少なくとも一方であってよい(例えば、θ、φ、ψ)。回転の軸は、ピッチ、ヨー、またはロールの少なくとも1つの回転の軸を含み得る。   FIG. 3D shows a set of aircraft operating principles according to an embodiment of the present invention. The aircraft may also have three degrees of freedom. For example, an aircraft may be able to rotate about three axes of rotation and to generate lift. For example, in a rotary wing aircraft, the rotary wings can rotate to generate aircraft lift. The rotation of the rotor may allow the aircraft to rotate about one, two, or three axes of rotation at the same time. Also, the axes of rotation may be at least one of mutually orthogonal or remain orthogonal to each other during aircraft flight (eg, θ, φ, ψ). The axis of rotation may include at least one axis of rotation of pitch, yaw, or roll.

ある実施形態では、回転翼機は、各々が回転翼機に揚力を生成できる複数の回転翼(例えば、F、F、F、F)を有してもよい。ある実施形態では、4つの回転翼を設けることができる。回転翼は、同一の量の揚力、または異なる量の揚力を生成し得る。回転翼は、同一の角速度で、または異なる角速度で回転し得る(例えば、ω、ω、ω、ω)。 In some embodiments, the rotorcraft may have multiple rotor blades (eg, F 1 , F 2 , F 3 , F 4 ) each capable of generating lift to the rotorcraft. In some embodiments, four rotor blades can be provided. The rotors can produce the same amount of lift or different amounts of lift. The rotor blades may rotate at the same angular velocity or at different angular velocities (eg, ω 1 , ω 2 , ω 3 , ω 4 ).

ロバスト適応制御戦略は、多重回転翼航空機に対して有用であり得る。多重回転翼航空機の飛行を管理するシステムは、元来不安定であり得、適当な制御法則が適用されない場合は数秒で発散し得る。システムは非線形であってもよい。システムの非線形性および空中動態の複雑性は、制御器設計の改善を必要とする。   A robust adaptive control strategy may be useful for multi-rotor aircraft. Systems that manage the flight of multi-rotor aircraft can be inherently unstable and can diverge in seconds if appropriate control laws are not applied. The system may be non-linear. System non-linearities and aerodynamic complexity require improved controller design.

本発明に関わるシステムおよび方法は、航空機飛行の動態をモデル化し、制御方式を発展させ、構成多様体が非線形であり得る多重回転翼航空機の姿勢を安定化し得る。動態および提案の制御システムは、特殊直交群SO(3)上に表して、オイラー角および四元数などの他の姿勢表現と関連付けられる特異点および曖昧性を回避できる。多重回転翼航空機のモデル化は、多重回転翼の運動および動態分析、ならびにアクチュエータ(例えば、モーター、回転翼、またはプロペラの少なくとも1つ)のシステム同定を含み得る。   The systems and methods according to the present invention can model aircraft flight dynamics, develop control strategies, and stabilize attitudes of multi-rotor aircraft where the configuration manifold can be non-linear. The dynamic and proposed control system can be represented on the special orthogonal group SO (3) to avoid singularities and ambiguities associated with other posture representations such as Euler angles and quaternions. Modeling a multi-rotor aircraft may include multi-rotor motion and dynamic analysis and system identification of an actuator (eg, at least one of a motor, rotor, or propeller).

有限要素解析(FEM)を使用して、システムの慣性モーメントを推定できる。時間遅れを持つ一次慣性システムは、システム同定のための近似モデルと見なし得る。本明細書の他の箇所に記載するように、制御システムは、SO(3)の比例制御と、フィードフォワード補償を伴う動態のカスケードPID(比例、積分、および微分)制御とに分類できる。SO(3)の制御に対しては、誤差は、SO(3)の自然誤差として画定できる(測地の観点から提供でき、それが望ましい場合がある)。比例制御は、それが線形空間であるため、SO(3)の指数座標上に画定できる。制御方式は、リアプノフ関数によって検証して、非線形多様体上での安定性を確保できる。動態のカスケードPID制御に対しては、制御器は、SO(3)の指数座標、角速度、および角加速度の順に構築し得る。不完全微分PID制御器およびスミス予測器を使用する技術を用いて、更にノイズを抑制し、制御品質を改善することができる。更に、フィードフォワード補償を追加して、過渡応答を改善することができる。多重回転翼航空機のための制御方式の更なる説明は、本明細書中の他の箇所に記載する。   Finite element analysis (FEM) can be used to estimate the moment of inertia of the system. A first order inertial system with a time delay can be regarded as an approximate model for system identification. As described elsewhere herein, the control system can be classified into SO (3) proportional control and kinetic cascade PID (proportional, integral and derivative) control with feedforward compensation. For the control of SO (3), the error can be defined as the natural error of SO (3) (can be provided from a geodetic point of view and may be desirable). A proportional control can be defined on the exponential coordinates of SO (3) because it is a linear space. The control method can be verified by the Lyapunov function to ensure stability on the nonlinear manifold. For dynamic cascade PID control, the controller may construct SO (3) in exponential order, angular velocity, and angular acceleration. A technique using an incomplete differential PID controller and a Smith predictor can be used to further suppress noise and improve control quality. In addition, feedforward compensation can be added to improve transient response. Further descriptions of control schemes for multi-rotor aircraft are set forth elsewhere herein.

図4には、本発明の実施形態に関わる、航空機の制御方法における1つ以上のパラメータを決定するために、航空機モデルをどのように使用することができるかが示されている。例えば、航空機は、飛行制御器として機能できる1つ以上の機内プロセッサを有してもよい。   FIG. 4 illustrates how an aircraft model can be used to determine one or more parameters in an aircraft control method according to an embodiment of the present invention. For example, an aircraft may have one or more onboard processors that can function as flight controllers.

ユーザーが航空機を受け取るとき、ユーザーは、航空機モデルを入力できる場合がある。例えば、ユーザーは、航空機モデルを航空機に直接入力し得る。別の実施例では、ユーザーは、航空機と通信できる外部のデバイスに、航空機モデルを入力してもよい。外部のデバイスは、航空機の制御器、または航空機からのデータを表示する表示デバイスであり得る。本明細書の他の箇所に記載するように、外部のデバイスは、コンピュータ、スマートフォン、タブレット、または任意の他の類型のデバイスもしくは端末であってもよい。   When a user receives an aircraft, the user may be able to enter an aircraft model. For example, a user may enter an aircraft model directly into the aircraft. In another example, the user may enter the aircraft model on an external device that can communicate with the aircraft. The external device may be an aircraft controller or a display device that displays data from the aircraft. As described elsewhere herein, the external device may be a computer, smartphone, tablet, or any other type of device or terminal.

また、航空機は、既に航空機モデル情報を事前プログラムされていてもよい。航空機モデル情報は、変更可能であってもなくてもよい。   Also, the aircraft may already be preprogrammed with aircraft model information. The aircraft model information may or may not be changeable.

ある実施形態では、航空機モデルの情報を使用して、選択された航空機モデルの1つ以上の航空機構成パラメータにアクセスできる。また、データは、航空機モデルと関連付けることができる1つ以上の航空機構成パラメータについてメモリに記憶できる。例えば、航空機モデルAおよび航空機モデルBは、1つ以上の異なる物理的特性を有し得る。異なる物理的特性は、異なる慣性モーメント、モーター揚力出力曲線、または軸方向距離の少なくとも1つなどの、異なる航空機構成パラメータをもたらし得る。飛行制御器が異なる航空機構成パラメータを使用して、航空機の飛行を制御してもよい。また、データは、航空機の異なるモデルに対する種々の構成パラメータにアクセス可能であり得るルックアップテーブルとして記憶できる。例えば、航空機モデルXの構成パラメータに対する要求がされる場合、それらはルックアップテーブルから提供され得る。また、ルックアップテーブルは、航空機上に記憶できる。したがって、ユーザーは、航空機モデルを入力または改変して、飛行制御器が使用する構成パラメータを画定または改変できる。あるいは、ルックアップテーブルは、航空機外に記憶してもよい。航空機は、外部のデバイスと通信して、ルックアップテーブルからのデータにアクセス可能であり得る。例えば、航空機は、航空機モデルのインジケータを送信でき、外部のデバイスは、選択された航空機モデルに関連付けられる航空機構成パラメータを送信できる。   In some embodiments, aircraft model information can be used to access one or more aircraft configuration parameters of a selected aircraft model. Data can also be stored in memory for one or more aircraft configuration parameters that can be associated with the aircraft model. For example, aircraft model A and aircraft model B may have one or more different physical characteristics. Different physical characteristics may result in different aircraft configuration parameters, such as at least one of different moments of inertia, motor lift output curves, or axial distances. The flight controller may use different aircraft configuration parameters to control the flight of the aircraft. The data can also be stored as a lookup table that may be accessible to various configuration parameters for different models of aircraft. For example, if requests for configuration parameters of aircraft model X are made, they can be provided from a lookup table. The look-up table can also be stored on the aircraft. Thus, a user can enter or modify an aircraft model to define or modify configuration parameters used by the flight controller. Alternatively, the look-up table may be stored outside the aircraft. The aircraft may be able to communicate with external devices and access data from the lookup table. For example, an aircraft can transmit an aircraft model indicator and an external device can transmit aircraft configuration parameters associated with the selected aircraft model.

また、航空機は、その中に事前プログラムされる1つ以上の航空機構成パラメータを有してもよい。航空機構成パラメータは、ユーザーが航空機を受け取るときに、航空機上に記憶してもよい。ユーザーは、航空機モデルを指定する必要があってもなくてもよい。また、製造業者の現場で、または他の現場で、航空機モデルについての決定がされてもよく、飛行制御器は、航空機の物理的パラメータに基づいて決定できる航空機構成パラメータを事前プログラムしてあってもよい。航空機構成パラメータは、複数の航空機モデルのデータを含むルックアップテーブルからアクセスできる。例えば、製造業者の現場で、製造業者は航空機モデルXが製造されていることを指定し、関連する航空機構成パラメータにアクセスし、それを航空機に事前プログラムすることができる。ユーザーは、航空機構成パラメータを改変することができてもできなくてもよい。また、ユーザーは、航空機の新たな構成パラメータに対する要求を入力できてもよい(航空機上に直接、または航空機と通信可能な外部のデバイスを使用して)。このような要求は、航空機モデルに基づいて行い得るか、または航空機の新たな物理的特性の入力を含んでもよい。また、航空機構成パラメータは、事前計算でき、要求に応じてアクセス可能にデータ中に記憶できる。あるいは、新たな物理的パラメータデータを入力または測定でき、新たな航空機構成パラメータを計算できる。このような計算は、リアルタイムで行うことができる。例えば、ユーザーは、1つ以上の航空機構成パラメータを変更し得る方法で、既存の航空機を修正できる。例えば、ユーザーは、重量または重量配分の少なくとも一方を変更できる新たなカメラをUAVに追加してもよい。慣性モーメントまたは他の航空機構成パラメータの少なくとも一方は、変更に適応するように再計算することができる。   The aircraft may also have one or more aircraft configuration parameters preprogrammed therein. Aircraft configuration parameters may be stored on the aircraft when the user receives the aircraft. The user may or may not need to specify an aircraft model. Also, decisions about aircraft models may be made at the manufacturer's site or at other sites, and the flight controller is pre-programmed with aircraft configuration parameters that can be determined based on the aircraft's physical parameters. Also good. Aircraft configuration parameters can be accessed from a look-up table containing data for multiple aircraft models. For example, at the manufacturer's site, the manufacturer can specify that aircraft model X is being manufactured, access the associated aircraft configuration parameters, and pre-program the aircraft. The user may or may not be able to modify aircraft configuration parameters. The user may also be able to enter requests for new configuration parameters of the aircraft (either directly on the aircraft or using an external device that can communicate with the aircraft). Such a request may be made based on the aircraft model or may include the input of new physical characteristics of the aircraft. Also, aircraft configuration parameters can be pre-calculated and stored in the data so that it can be accessed on demand. Alternatively, new physical parameter data can be entered or measured and new aircraft configuration parameters can be calculated. Such a calculation can be performed in real time. For example, a user can modify an existing aircraft in a manner that can change one or more aircraft configuration parameters. For example, the user may add a new camera to the UAV that can change at least one of weight or weight distribution. At least one of moment of inertia or other aircraft configuration parameters can be recalculated to accommodate the change.

ある実施形態では、航空機についての情報は、航空機の機内メモリまたはプロセッサの少なくとも一方の中に記憶できる。プロセッサは、航空機をオンにするときに1つ以上のパラメータを評価し得る。また、プロセッサは、記憶されている航空機モデルに基づいて事前計算したパラメータにアクセスできる。他の例では、ある診断または測定は、航空機をオンにするときに行ってもよく、1つ以上の航空機構成パラメータを生成するために使用してもよい。   In some embodiments, information about the aircraft may be stored in at least one of the aircraft's onboard memory or processor. The processor may evaluate one or more parameters when turning on the aircraft. The processor can also access pre-calculated parameters based on the stored aircraft model. In other examples, certain diagnostics or measurements may be made when the aircraft is turned on and may be used to generate one or more aircraft configuration parameters.

飛行中、航空機は飛行制御デバイスからの入力によって制御できる。飛行制御デバイスは、航空機とは別の外部のデバイスであり得る。また、飛行制御デバイスは、航空機が飛行している間、地上でユーザーが操作する遠隔制御であってもよい。飛行制御デバイスは、無線で航空機と通信できる。あるいは、飛行制御デバイスは、航空機中に組み込んでもよい。例えば、ユーザーは、ユーザーが航空機に搭乗している間に飛行制御デバイスを操作できる。ユーザーは、航空機のパイロットであってもよく、コックピットから飛行制御デバイスを操作できる。飛行制御デバイスは、航空機の方向または速度の少なくとも一方に関連し得る情報を含んでもよい。飛行制御デバイスからの入力を使用して、航空機の目標姿勢を決定できる。航空機の目標姿勢は、1つ、2つ、または3つの回転軸を中心として決定できる。例えば、航空機の目標姿勢は、ピッチ軸、ロール軸、またはヨー軸の少なくとも1つを中心として決定できる。   During flight, the aircraft can be controlled by input from a flight control device. The flight control device may be an external device that is separate from the aircraft. The flight control device may also be a remote control operated by the user on the ground while the aircraft is flying. The flight control device can communicate with the aircraft wirelessly. Alternatively, the flight control device may be incorporated into the aircraft. For example, the user can operate the flight control device while the user is on board the aircraft. The user may be an aircraft pilot and can operate the flight control device from the cockpit. The flight control device may include information that may relate to at least one of aircraft direction or speed. Input from the flight control device can be used to determine the target attitude of the aircraft. The target attitude of the aircraft can be determined around one, two, or three axes of rotation. For example, the target attitude of the aircraft can be determined around at least one of the pitch axis, roll axis, or yaw axis.

航空機は、飛行制御器を有し得る。飛行制御器は、航空機上の1つ以上のプロセッサを含むことができる。飛行制御器は、飛行制御デバイスからの入力を示す信号を受信できる。飛行制御器は、飛行制御デバイスからの入力に応答して、航空機の飛行を制御できる。飛行制御器は、航空機飛行構成パラメータのうちの1つ以上に応答して、航空機の飛行を制御できる。飛行制御器は、飛行制御デバイスからの信号(例えば、目標姿勢)、および航空機構成パラメータに基づいて、航空機姿勢制御を行い得る。飛行制御器は、目標のロール、ヨー、およびピッチ軸、ならびに航空機構成パラメータに基づいて、航空機のロール、ヨー、およびピッチ軸を中心とした姿勢制御を行い得る。   The aircraft may have a flight controller. The flight controller can include one or more processors on the aircraft. The flight controller can receive a signal indicative of input from the flight control device. The flight controller can control the flight of the aircraft in response to input from the flight control device. The flight controller can control the flight of the aircraft in response to one or more of the aircraft flight configuration parameters. The flight controller may perform aircraft attitude control based on signals from the flight control device (eg, target attitude) and aircraft configuration parameters. The flight controller may perform attitude control around the aircraft roll, yaw, and pitch axes based on the target roll, yaw, and pitch axes and aircraft configuration parameters.

図5には、本発明を適用した、飛行制御器を持つ航空機が示されている。航空機510は、1つ以上の機内飛行制御器520を有し得る。飛行制御器は、航空機の飛行を制御するためのコマンド信号を個別または集合的に生成できる1つ以上のプロセッサを含み得る。   FIG. 5 shows an aircraft having a flight controller to which the present invention is applied. Aircraft 510 may have one or more onboard flight controllers 520. The flight controller may include one or more processors that can individually or collectively generate command signals for controlling aircraft flight.

飛行制御器520は、航空機の1つ以上のアクチュエータ560a、560bと通信できる。アクチュエータは、航空機の1つ以上の推進ユニットに接続できるモーターであり得る。推進ユニットは、回転して航空機の揚力を生成する回転翼を含み得る。ある実施形態では、航空機は、複数の回転翼を有する多重回転翼航空機であってもよく、それらの各々が航空機の揚力を生成できる。コマンド信号は、モーターに供給される出力を決定し得る。これはモーターに接続した回転翼が回転できる速度を決定し得る。また、各回転翼は、個別のモーターに接続できる。また、1つの回転翼が複数の回転翼に接続されてもよく、または複数のモーターを使用して単一の回転翼を駆動してもよい。モーターは、個別に制御可能であり得る。例えば、1つのモーターは、異なる環境にある別のモーターとは異なる電源出力を有し得る。推進ユニットは、全て同じ類型の推進ユニットであってもよいし、または異なる類型の推進ユニットを含んでもよい。例えば、全ての推進ユニットは、回転翼ブレード/プロペラを含み得る。ある実施形態では、回転翼ブレードまたはプロペラの少なくとも一方は、同一の構成または寸法の少なくとも一方、または異なる構成または寸法の少なくとも一方を有し得る。任意の数のモーターまたは推進ユニットの少なくとも一方を、航空機に設けることができる。例えば、1個、2個、3個、4個、5個、6個、7個、8個、9個、10個、11個、12個、またはそれ以上のモーターまたは推進ユニットの少なくとも一方を、航空機上に設けることができる。   The flight controller 520 can communicate with one or more actuators 560a, 560b of the aircraft. The actuator can be a motor that can be connected to one or more propulsion units of the aircraft. The propulsion unit may include a rotating wing that rotates to generate aircraft lift. In some embodiments, the aircraft may be a multi-rotor aircraft having a plurality of rotors, each of which can generate aircraft lift. The command signal can determine the output supplied to the motor. This can determine the speed at which the rotor connected to the motor can rotate. Each rotor can be connected to a separate motor. In addition, one rotor blade may be connected to a plurality of rotor blades, or a plurality of motors may be used to drive a single rotor blade. The motors can be individually controllable. For example, one motor may have a different power output than another motor in a different environment. The propulsion units may all be the same type of propulsion unit or may include different types of propulsion units. For example, all propulsion units may include a rotor blade / propeller. In certain embodiments, at least one of the rotor blades or propellers may have at least one of the same configuration or dimensions, or at least one of different configurations or dimensions. Any number of motors or propulsion units may be provided on the aircraft. For example, one, two, three, four, five, six, seven, eight, nine, ten, eleven, twelve, or more motors or propulsion units Can be provided on an aircraft.

各モーターは個別に制御できる。例えば、別々のコマンド信号が、各モーターに提供されてもよい。各モーターは、航空機の他のモーターと同一の、または異なるモーター出力を有してもよい。各モーターへの出力は、航空機の所望の目標姿勢に応じて異なり得る。例えば、航空機の姿勢を調節することが望ましい場合、1つ以上のモーターは、航空機の姿勢を変化させるために、異なる出力で動作できる(例えば、異なる速度またはrpmで回転できる)。   Each motor can be controlled individually. For example, separate command signals may be provided for each motor. Each motor may have the same or different motor output as other motors in the aircraft. The output to each motor may vary depending on the desired target attitude of the aircraft. For example, if it is desired to adjust the attitude of the aircraft, one or more motors can operate at different outputs (eg, rotate at different speeds or rpms) to change the attitude of the aircraft.

ある実施形態では、1つ以上の航空機構成パラメータ530を含むメモリを航空機上に設けてもよい。航空機構成パラメータは、航空機全体の慣性モーメント、モーター揚力出力曲線、または軸方向距離(例えば、モーターから空力中心までの距離)の少なくとも1つを含み得る。他の航空機構成パラメータは、他の箇所に記載のものなどのように記憶できる。航空機構成パラメータは、航空機または航空機モデルの1つ以上の物理的特性に由来してもよい。航空機構成パラメータは、メモリに事前プログラムできる。あるいは、航空機構成パラメータは、外部のデバイスからメモリにダウンロードしてもよい。航空機構成パラメータは、メモリに記憶してもよく、コマンド信号を生成する際に飛行制御器520を使用し得る。   In some embodiments, a memory that includes one or more aircraft configuration parameters 530 may be provided on the aircraft. The aircraft configuration parameters may include at least one of an overall aircraft moment of inertia, a motor lift output curve, or an axial distance (eg, a distance from the motor to the aerodynamic center). Other aircraft configuration parameters can be stored, such as those described elsewhere. Aircraft configuration parameters may be derived from one or more physical characteristics of the aircraft or aircraft model. Aircraft configuration parameters can be preprogrammed into memory. Alternatively, aircraft configuration parameters may be downloaded to memory from an external device. Aircraft configuration parameters may be stored in memory and flight controller 520 may be used in generating command signals.

また、1つ以上のセンサ540を航空機上に設けてもよい。センサの例としては、撮像デバイス(例えば、カメラ、ビジョンセンサ、赤外線/熱撮像デバイス、UV撮像デバイス、または他の類型のスペクトル撮像デバイス)、慣性センサ(例えば、ジャイロスコープ、加速度計、磁力計)、超音波センサ、ライダー、ソナー、または任意の他の類型のセンサを含むが、これらに限定されない。また、センサは、全地球測位システム(GPS)衛星などの外部のデバイスと通信できる。センサは、GPS受信機であり得る。他の例では、センサは、1つ以上のタワーまたは中継機と通信できる。センサは、航空機を囲む環境についての情報を収集できる。センサは、航空機の航行を補助するために使用してもしなくてもよい。また、センサ540は、航空機の飛行制御器520と通信できる。また、1つ以上のアクチュエータにコマンド信号を生成する際に、飛行制御器がセンサからの信号を使用してもよい。センサからの信号は、1つ以上の軸を中心とした航空機の姿勢を制御する際に使用してもしなくてもよい。   One or more sensors 540 may also be provided on the aircraft. Examples of sensors include imaging devices (eg, cameras, vision sensors, infrared / thermal imaging devices, UV imaging devices, or other types of spectral imaging devices), inertial sensors (eg, gyroscopes, accelerometers, magnetometers). , Ultrasonic sensors, riders, sonars, or any other type of sensor, including but not limited to. Sensors can also communicate with external devices such as global positioning system (GPS) satellites. The sensor can be a GPS receiver. In other examples, the sensor can communicate with one or more towers or repeaters. The sensor can collect information about the environment surrounding the aircraft. The sensor may or may not be used to assist in aircraft navigation. Sensor 540 can also communicate with aircraft flight controller 520. In addition, the flight controller may use signals from the sensors in generating command signals for one or more actuators. The signal from the sensor may or may not be used in controlling the attitude of the aircraft about one or more axes.

ある実施形態では、センサは、航空機の動態についての情報を収集するのに有用であり得る。例えば、センサを使用して、1つ以上の回転の軸を中心とした、航空機姿勢、角速度、または角加速度の少なくとも1つについての情報を収集できる。例えば、センサは、ジャイロスコープ、または、ピッチ軸、ロール軸、またはヨー軸の少なくとも1つを中心とした、航空機姿勢、角速度、または加速度の少なくとも1つについての情報を収集できる他のセンサを含み得る。センサは、慣性センサであってもよいし、または慣性測定ユニット(IMU)の一部であってもよい。IMUは、1つ以上の加速度計、1つ以上のジャイロスコープ、1つ以上の磁力計、またはそれらの好適な組合せを含み得る。例えば、IMUは、最大3つの並進の軸に沿う可動物体の線形加速度を測定する最大3つの直交する加速度計と、最大3つの回転の軸の周りの角加速度を測定する最大3つの直交するジャイロスコープとを含み得る。IMUは、航空機の運動がIMUの運動に対応するように、航空機に堅く接続され得る。あるいは、IMUは、最大6自由度に関して航空機に対して移動することができる。IMUは、航空機に直接に取り付けることができるか、または航空機に取り付けられた支持構造に接続され得る。IMUは、可動物体の筐体の外に、または筐体の中に設けることができる。IMUは、可動物体に恒久的または着脱可能に取り付けることができる。IMUは、航空機の位置、方向、速度、または加速度の少なくとも1つなどの航空機の運動(例えば、並進の1、2、もしくは3軸、または、回転の1、2、もしくは3軸の少なくとも一方に関して)を示す信号を提供することができる。例えば、IMUは、航空機の加速度を表す信号を検出でき、その信号を1度積分することで速度情報を提供し、2度積分することで場所情報または方向情報の少なくとも一方を提供することができる。IMUは、一切の外部環境要因と相互作用することなく、または航空機の外部から一切の信号を受け取ることなく、航空機の加速度、速度、または場所/方向の少なくとも1つを決定することが可能となり得る。   In certain embodiments, the sensors may be useful for collecting information about aircraft dynamics. For example, a sensor can be used to collect information about at least one of aircraft attitude, angular velocity, or angular acceleration about one or more axes of rotation. For example, the sensors include a gyroscope or other sensor that can collect information about at least one of aircraft attitude, angular velocity, or acceleration about at least one of the pitch, roll, or yaw axes. obtain. The sensor may be an inertial sensor or may be part of an inertial measurement unit (IMU). The IMU may include one or more accelerometers, one or more gyroscopes, one or more magnetometers, or a suitable combination thereof. For example, an IMU can measure up to three orthogonal accelerometers that measure linear acceleration of a movable object along up to three translational axes and up to three orthogonal gyroscopes that measure angular acceleration around up to three rotational axes. Scope. The IMU may be firmly connected to the aircraft such that the aircraft motion corresponds to the IMU motion. Alternatively, the IMU can move relative to the aircraft for up to 6 degrees of freedom. The IMU can be attached directly to the aircraft or can be connected to a support structure attached to the aircraft. The IMU can be provided outside or within the housing of the movable object. The IMU can be permanently or detachably attached to the movable object. An IMU is an aircraft motion, such as at least one of aircraft position, direction, velocity, or acceleration (eg, with respect to at least one of 1, 2, or 3 axes of translation, or 1, 2, or 3 axes of rotation). ) Can be provided. For example, an IMU can detect a signal representing aircraft acceleration, integrate the signal once to provide speed information, and integrate twice to provide at least one of location information or direction information. . The IMU may be able to determine at least one of aircraft acceleration, speed, or location / direction without interacting with any external environmental factors or receiving any signal from outside the aircraft .

IMUは、飛行制御器520に信号を提供することができ、それは航空機の1つ以上のモーター560にコマンド信号を生成するのに有用であり得る。ある実施形態では、飛行制御器は、IMUからの情報を利用し得る制御フィードバック方式を使用してもよい。   The IMU can provide signals to the flight controller 520, which can be useful for generating command signals to one or more motors 560 of the aircraft. In some embodiments, the flight controller may use a control feedback scheme that may utilize information from the IMU.

他のセンサを利用して、航空機の姿勢、角速度、または角加速度の少なくとも1つを決定できる。他のセンサは、航空機上にあってもなくてもよい。他のセンサは、航空機の外部にある更なるデバイスと通信してもしなくてもよい。例えば、センサは、航空機から一切の外部信号を受信することなく、情報を決定することができてもよい。   Other sensors can be utilized to determine at least one of aircraft attitude, angular velocity, or angular acceleration. Other sensors may or may not be on the aircraft. Other sensors may or may not communicate with additional devices external to the aircraft. For example, the sensor may be able to determine information without receiving any external signals from the aircraft.

また、外部のデバイス550は、飛行制御器と通信してもよい。外部のデバイスは、航空機外に設けることができる。外部のデバイスは、無線で航空機と通信可能であり得る。外部のデバイスは、航空機に関係する航行または位置情報などの任意の情報を有し得る。ある実施形態では、外部のデバイスは、航空機構成パラメータデータを含んでもよい。また、外部のデバイスは、航空機のために航空機構成パラメータデータを記憶するメモリに、航空機構成パラメータデータを通信してもよい。航空機上のデータは、外部のデバイスからの新たなデータで更新され得る。更新は、自動で、またはユーザーからもしくは航空機からの要求に応じて、行うことができる。 The external device 550 may also communicate with the flight controller. External devices can be provided outside the aircraft. The external device may be able to communicate with the aircraft wirelessly. The external device may have any information such as navigation or position information related to the aircraft. In some embodiments, the external device may include aircraft configuration parameter data. Also, external devices, the memory for storing the aircraft configuration parameter data for the aircraft may communicate aircraft configuration parameter data. Data on the aircraft can be updated with new data from external devices. The update can be done automatically or upon request from the user or from the aircraft.

ある実施形態では、外部のデバイスは、飛行制御器に1つ以上の飛行命令を提供できる飛行制御デバイスであり得る。例えば、ユーザーは、航空機と無線で通信できる遠隔の制御器を使用してもよい。ユーザーは、所定の経路をプログラムする、またはリアルタイムで命令を提供するなどの、異なる飛行命令を指定できる。飛行命令は、1つ以上の軸を中心とした航空機の目標姿勢についての情報を含み得る。例えば、飛行命令は、航空機の姿勢を一定程度調節せよという命令となり得る。命令はまた、航空機の目標角速度または目標角加速度の少なくとも一方についての情報を含んでも含まなくてもよい。   In certain embodiments, the external device may be a flight control device that can provide one or more flight instructions to the flight controller. For example, the user may use a remote controller that can communicate wirelessly with the aircraft. The user can specify different flight instructions, such as programming a predetermined route or providing instructions in real time. The flight instructions may include information about the target attitude of the aircraft about one or more axes. For example, the flight command can be a command to adjust the attitude of the aircraft to a certain degree. The instructions may also include or not include information about at least one of the target angular velocity or target angular acceleration of the aircraft.

飛行制御器520は、航空機の1つ以上のアクチュエータ560a、560bにコマンド信号を生成してもよく、それにより推進ユニットの作動が起こり、航空機の飛行を制御できる。これは、3つの直交軸(例えば、ピッチ、ヨー、およびロール)を中心とした航空機の姿勢制御を含み得る。飛行制御器は、1つ以上の航空機構成パラメータ530に基づいて、コマンド信号を計算できる。航空機構成パラメータ530は、航空機の物理的特性、航空機姿勢についてのフィードバック入力(例えば、3つの直交軸を中心とした、航空機の姿勢、角速度、または角加速度の少なくとも1つについての情報)に由来し得る、またはそれらを表し得る。また、航空機構成パラメータ530は、航空機の外部にあってもよい飛行制御デバイス550からの1つ以上の飛行命令に由来し得る、またはそれらを表し得る。飛行制御器は、飛行構成パラメータを組み込んだフィードバック制御を使用して、航空機の姿勢を制御し得る。   The flight controller 520 may generate command signals to one or more actuators 560a, 560b of the aircraft, thereby causing the operation of the propulsion unit and controlling flight of the aircraft. This may include attitude control of the aircraft around three orthogonal axes (eg, pitch, yaw, and roll). The flight controller can calculate a command signal based on one or more aircraft configuration parameters 530. Aircraft configuration parameters 530 are derived from feedback on aircraft physical characteristics, aircraft attitude (eg, information about at least one of aircraft attitude, angular velocity, or angular acceleration about three orthogonal axes). Or may represent them. Also, aircraft configuration parameters 530 may be derived from or represent one or more flight instructions from flight control device 550 that may be external to the aircraft. The flight controller may control the attitude of the aircraft using feedback control incorporating flight configuration parameters.

図6Aは、本発明の実施形態に関わる、航空機が実施形態し得る姿勢制御方式を示す図である。姿勢制御方式を使用して、1つ、2つ、または3つの軸を中心とした航空機の姿勢を制御してもよい。例えば、姿勢制御方式を使用して、ピッチ軸、ロール軸、およびヨー軸を中心とした航空機の姿勢を制御できる。   FIG. 6A is a diagram illustrating an attitude control method that can be implemented by an aircraft according to an embodiment of the present invention. An attitude control scheme may be used to control the attitude of the aircraft about one, two, or three axes. For example, the attitude control method can be used to control the attitude of the aircraft around the pitch axis, roll axis, and yaw axis.

飛行プランナ610を設けて、航空機の飛行を決定するコマンド信号を生成してもよい。飛行プランナは、航空機上に設けてもよいし、または航空機外に設けて航空機と通信してもよい。飛行プランナは、1つ以上のメモリユニット、および本明細書に記載するステップのうちの1つ以上を個々または集合的に行うことができる1つ以上のプロセッサを含み得る。メモリは、本明細書に記載するような1つ以上のステップを行うための、コード、ロジック、または命令を含み得る非一時的コンピュータ可読媒体を含んでもよい。1つ以上のプロセッサは、非一時的コンピュータ可読媒体に従って、1つ以上のステップを実行し得る。   A flight planner 610 may be provided to generate command signals that determine flight of the aircraft. The flight planner may be provided on the aircraft or may be provided outside the aircraft to communicate with the aircraft. The flight planner can include one or more memory units and one or more processors that can individually or collectively perform one or more of the steps described herein. The memory may include non-transitory computer readable media that may include code, logic, or instructions for performing one or more steps as described herein. One or more processors may perform one or more steps in accordance with a non-transitory computer readable medium.

本発明の実施形態に従って、遠隔の制御器605または他の類型の飛行制御デバイスを設けることができる。遠隔の制御器をユーザーが操作して、航空機の飛行を制御できる。これは、航空機の場所、および航空機の角度方向を含み得る。ある実施形態では、ユーザーは、リアルタイムで航空機飛行に関する命令を直接入力できる。例えば、ユーザーは、命令を入力して、航空機の姿勢を調節できる。あるいは、ユーザーは、所定のまたは事前プログラムされた経路に従うようにという航空機に対する命令を与えてもよい。また、遠隔の制御器は、航空機から分離でき、無線接続により航空機と通信できる。他の例では、飛行制御デバイスは、航空機に組み込まれてもよく、遠隔の制御器についての本明細書中の一切の記載は、航空機の一部である飛行制御デバイスにも適用できる。例えば、ユーザーは、航空機に搭乗し、機上の飛行制御デバイスを使用して飛行のための命令を与えてもよい。   In accordance with embodiments of the present invention, a remote controller 605 or other type of flight control device may be provided. A remote controller can be operated by the user to control the flight of the aircraft. This may include the location of the aircraft and the angular orientation of the aircraft. In some embodiments, the user can directly enter aircraft flight instructions in real time. For example, the user can input a command to adjust the attitude of the aircraft. Alternatively, the user may give instructions to the aircraft to follow a predetermined or pre-programmed route. Also, the remote controller can be separated from the aircraft and can communicate with the aircraft via a wireless connection. In other examples, the flight control device may be incorporated into an aircraft and any description herein for a remote controller is applicable to a flight control device that is part of an aircraft. For example, a user may board an aircraft and give instructions for flight using an on-board flight control device.

遠隔の制御器605は、1つ以上の目標姿勢θ_Tarを示す信号をプランナ610に提供することができる。目標姿勢は、1つ、2つ、または3つの回転の軸を中心とした航空機の目標姿勢であり得る。例えば、目標姿勢は、ピッチ、ロール、およびヨー軸を中心とした航空機の姿勢を示してもよい。プランナは、航空機のモーターに提供する1つ以上の信号を計算して、目標姿勢の達成を試みることができる。   The remote controller 605 can provide a signal to the planner 610 indicating one or more target attitudes θ_Tar. The target attitude may be the target attitude of the aircraft about one, two, or three axes of rotation. For example, the target attitude may indicate the attitude of the aircraft around the pitch, roll, and yaw axes. The planner may attempt to achieve the target attitude by calculating one or more signals to provide to the aircraft motor.

プランナ610はまた、航空機の動態650についての情報を受信してもよい。ある実施形態では、航空機の動態についての情報は、1つ以上のセンサによって提供され得る。ある実施形態では、航空機の動態についての情報は、航空機内からの1つ以上の慣性センサ(例えば、1つ以上のジャイロスコープまたは加速度計)から提供されてもよい。航空機の動態についての情報は、ピッチ軸、ロール軸、およびヨー軸という軸のうちの1つ、2つ、または3つを中心とした、姿勢、角速度、または角加速度の少なくとも1つを含み得る。ある実施形態では、航空機の現在の姿勢θ_Curをプランナに伝達できる。プランナは、目標姿勢θ_Tarを現在の姿勢θ_Curと比較できる。この比較は、ピッチ、ロール、およびヨー軸の各々について行い得る。角度の差は、姿勢の誤差θ_Errであると判定できる。   Planner 610 may also receive information about aircraft dynamics 650. In certain embodiments, information about aircraft dynamics may be provided by one or more sensors. In certain embodiments, information about aircraft dynamics may be provided from one or more inertial sensors (eg, one or more gyroscopes or accelerometers) from within the aircraft. Information about aircraft dynamics may include at least one of attitude, angular velocity, or angular acceleration about one, two, or three of the axes: pitch axis, roll axis, and yaw axis. . In some embodiments, the current attitude θ_Cur of the aircraft can be communicated to the planner. The planner can compare the target posture θ_Tar with the current posture θ_Cur. This comparison can be made for each of the pitch, roll, and yaw axes. It can be determined that the angle difference is an attitude error θ_Err.

ピッチ制御620aのみを詳細に示すが、同一の制御方式が、ロール制御620bおよびヨー制御620cにも適用できる。ピッチ制御または一切の角度制御一般についての一切の考察は、これらの軸のうちいずれかまたは全てに適用できる。姿勢、角速度、または角加速度の少なくとも1つについての一切の説明は、これらの軸のうちのいずれかまたは全てに適用できる。3つの軸は、相互に分離していてもよい。   Although only the pitch control 620a is shown in detail, the same control scheme can be applied to the roll control 620b and the yaw control 620c. Any consideration of pitch control or any angle control in general can be applied to any or all of these axes. Any description of at least one of attitude, angular velocity, or angular acceleration is applicable to any or all of these axes. The three axes may be separated from each other.

姿勢の誤差θ_Errをファジー論理621と共に使用して、航空機の角度を制御できる。制御はフィードバック制御であり得る。ある実施形態では、フィードバック制御は、比例、積分、または微分制御方式の少なくとも1つを使用し得る。フィードバック制御は、ファジー比例積分微分(PID)制御であってもよい。また、目標姿勢は、比例積分(PI)622またはPID制御できる。角度制御ループ設けられてもよい。 Attitude error θ_Err can be used with fuzzy logic 621 to control aircraft angle. The control can be feedback control. In some embodiments, feedback control may use at least one of proportional, integral, or derivative control schemes. The feedback control may be fuzzy proportional integral derivative (PID) control. In addition, the target attitude is, proportional-integral (PI) 622 or PID system as possible out of control. Angle control loop may be provided.

目標角速度ω_Tarが生じ得る。目標角速度を、測定した角速度ω623と比較できる。測定した角速度は、1つ以上のセンサにより測定できる航空機の動態650の一部であり得る。目標角速度を、測定した角速度と比較して、角速度の誤差ω_Errを決定できる。   A target angular velocity ω_Tar can occur. The target angular velocity can be compared with the measured angular velocity ω623. The measured angular velocity can be part of aircraft dynamics 650 that can be measured by one or more sensors. Comparing the target angular velocity with the measured angular velocity, the angular velocity error ω_Err can be determined.

角速度の誤差ω_Errは、航空機の角速度を制御するために、ファジー論理と共に使用してもしなくてもよい。制御はフィードバック制御であり得る。ある実施形態では、フィードバック制御は、比例、積分、または微分制御方式の少なくとも1つを使用し得る。フィードバック制御は、比例積分微分(PID)制御であり得る。また、目標角速度は、比例(P)制御624できる。角度速度ループ設けられてもよい。 The angular velocity error ω_Err may or may not be used with fuzzy logic to control the angular velocity of the aircraft. The control can be feedback control. In some embodiments, feedback control may use at least one of proportional, integral, or derivative control schemes. The feedback control can be a proportional integral derivative (PID) control. Also, the target angular velocity can be proportional (P) control 624. Angle velocity loop may be provided.

目標角加速度α_Tarが生じ得る。目標角加速度を、測定した角加速度α625と比較できる。測定した角加速度は、1つ以上のセンサにより測定できる航空機の動態650の一部であり得る。目標角加速度を、測定した角加速度と比較して、角加速度の誤差α_Errを決定できる。   A target angular acceleration α_Tar can occur. The target angular acceleration can be compared with the measured angular acceleration α625. The measured angular acceleration can be part of aircraft dynamics 650 that can be measured by one or more sensors. The angular acceleration error α_Err can be determined by comparing the target angular acceleration with the measured angular acceleration.

角加速度の誤差α_Errは、航空機の角速度を制御するために、ファジー論理と共に使用してもしなくてもよい。制御はフィードバック制御であり得る。ある実施形態では、フィードバック制御は、比例、積分、または微分制御方式の少なくとも1つを使用し得る。フィードバック制御は、比例積分微分(PID)制御であり得る。また、目標角加速度は、比例積分(PI)626またはPID制御できる。角加速度ループ設けられてもよい。 The angular acceleration error α_Err may or may not be used with fuzzy logic to control the angular velocity of the aircraft. The control can be feedback control. In some embodiments, feedback control may use at least one of proportional, integral, or derivative control schemes. The feedback control can be a proportional integral derivative (PID) control. In addition, the target angular acceleration is proportional-integral (PI) 626 or PID system as possible out of control. Angular acceleration loop may be provided.

フィードフォワードループ627も設けることができる。フィードフォワードループは、角加速度に対して設けてもよい。例えば、目標角加速度α_Tarは、フィードフォワードループにおいて使用できる。ある実施形態では、航空機の1つ以上の物理的特性に由来し得る1つ以上の航空機構成パラメータ660は、フィードフォワードループに組み込むことができる。例えば、航空機の慣性モーメントIを、フィードフォワードループに提供することができる。ある実施形態では、航空機のトルクτは、目標角加速度α_Tarに慣性モーメントIを乗じて計算できる。したがって、角加速度ループは、慣性モーメントを使用して出力を直接計算でき、同時に、現在の角加速度値に従って補償量としてPID制御を行うことができる。   A feed forward loop 627 can also be provided. A feedforward loop may be provided for angular acceleration. For example, the target angular acceleration α_Tar can be used in a feedforward loop. In certain embodiments, one or more aircraft configuration parameters 660 that may be derived from one or more physical characteristics of the aircraft may be incorporated into the feed forward loop. For example, the moment of inertia I of the aircraft can be provided to the feedforward loop. In one embodiment, the aircraft torque τ can be calculated by multiplying the target angular acceleration α_Tar by the moment of inertia I. Therefore, the angular acceleration loop can directly calculate the output using the moment of inertia, and at the same time, can perform PID control as a compensation amount according to the current angular acceleration value.

したがって、フィードフォワードとフィードバックとの両方を、角加速度の制御に使用できる。フィードフォワードモデルパラメータは、制御システムの応答時間を改善でき、一方フィードバック制御は、モデル誤差および動的外乱を補償できる。角速度制御は、航空機全体の回転トルク制御であると直接的に見なし得る。したがって、角速度制御方式を使用しないシステムよりも、外部の外乱に対する応答時間は更に短くなり得、抑制作用はより優れている。フィードフォワードループは、角加速度ループが直接制御として作動することを可能にするため、応答時間が短くなり得る。外乱を直接抑制でき、それにより応答時間を削減できる。   Therefore, both feedforward and feedback can be used to control angular acceleration. Feedforward model parameters can improve the response time of the control system, while feedback control can compensate for model errors and dynamic disturbances. Angular velocity control can be directly regarded as rotational torque control for the entire aircraft. Therefore, the response time to external disturbance can be further shortened and the suppressing action is better than a system that does not use the angular velocity control method. The feed forward loop allows the angular acceleration loop to operate as a direct control, so response time can be shortened. Disturbances can be directly suppressed, thereby reducing response time.

ミキサ630を、本発明の実施形態に従って設けることができる。ミキサは、本発明の実施形態に従う、飛行制御器の一部であり得る。ミキサは、飛行プランナ610に対して使用したプロセッサと同一のものであってもなくてもよい、1つ以上のプロセッサを含み得る。ミキサは、ピッチ制御、ロール制御、またはヨー制御の少なくとも1つのための姿勢に関連する情報を受信することができる。例えば、角加速度に関連するフィードフォワードおよびフィードバックループ後のデータは、ピッチ軸、ヨー軸、ロール軸の回転の軸の各々に対してミキサに提供することができる。計算結果の全てが合計され得るA mixer 630 can be provided in accordance with an embodiment of the present invention. The mixer may be part of a flight controller according to an embodiment of the present invention. The mixer may include one or more processors that may or may not be the same processor used for flight planner 610. The mixer can receive information related to attitude for at least one of pitch control, roll control, or yaw control. For example, data after the feedforward and feedback loops associated with the angular acceleration can provide pitch axis, yaw axis, the mixer for each of the axes of rotation of the roll shaft. All of the calculation results can be summed.

ミキサ630は、航空機構成パラメータ660に関する情報を受信できる。航空機構成パラメータは、航空機または航空機モデルの物理的特性に由来し得る。ある実施形態では、ミキサは、航空機の軸方向距離を受信できる。軸方向距離は、航空機のモーターと空力中心との間の距離であることができる。あるいは、軸方向距離は、航空機の推進ユニットと空力中心との間の距離であってもよい。また、航空機は、複数のモーター640a、640b、640c、640dを有し得る。軸方向距離は、モーターの各々に対して同一であり得る。あるいは、異なるモーターは異なる軸方向距離を有してもよい。また、軸方向距離は、推進ユニットが創出する推力の方向で、推進ユニットまたは回転翼の少なくとも1つを貫通する軸と、空力中心との間の距離であり得る。 Mixer 630 can receive information regarding aircraft configuration parameters 660. Aircraft configuration parameters may be derived from the physical characteristics of the aircraft or aircraft model. In one embodiment, the mixer can receive an aircraft axial distance l . The axial distance can be the distance between the aircraft motor and the aerodynamic center. Alternatively, the axial distance may be the distance between the aircraft propulsion unit and the aerodynamic center. The aircraft may also have a plurality of motors 640a, 640b, 640c, 640d. The axial distance can be the same for each of the motors. Alternatively, different motors may have different axial distances. Further, the axial distance may be a distance between an axis penetrating at least one of the propulsion unit or the rotor blade and an aerodynamic center in a direction of thrust generated by the propulsion unit.

ミキサ630は、各推進ユニットが及ぼす所望の力を計算できる。力は、航空機構成パラメータ660、およびピッチ軸、ヨー軸、ロール軸の回転の軸の各々に対する制御方式からの情報に基づいて計算できる。フィードフォワードループ627で計算したトルクτ、および軸方向距離を使用して、各モーターの力を計算してもよい。力Fは、τ/と計算できる。各モーターに及ぼされる所望の更なる力は、ミキサによって計算することができる。所望の更なる力は、各モーターにコマンド信号として伝達できる。各モーターに対する力は同一であってもよいし、または異なってもよい。例えば、第1のモーターM1640aに対しては、所望の力はΔF1であってもよく、第のモーターM2640bに対しては、所望の力はΔF2であってもよく、第のモーターM3640cに対しては、所望の力はΔF3であってもよく第のモーターM4640dに対しては、所望の力はΔF4であってもよい。これらの例は、少なくとも一つまたはすべてがそのようであってよい。モーターは、所望の力またはおよその所望の力を生成するレベルで動作できる。ある実施形態では、モーター出力を決定する際に、モーター揚力曲線670を使用できる。曲線は、モーター動作の割合当たりに生成される揚力を含み得る。モーター揚力曲線は、動作割合当たりの推力であり得る。曲線は非線形関係を示し得る。モーター揚力曲線は、航空機の1つ以上の物理的特性に由来し得る航空機構成パラメータであり得る。1つ以上の物理的パラメータに由来する航空機構成パラメータのうちの1つ以上は、非線形パラメータであり得る。 The mixer 630 can calculate the desired force exerted by each propulsion unit. Force, aircraft configuration parameters 660, and the pitch axis, yaw axis can be calculated based on information from the control system for each axis of rotation of the roll shaft. The torque of each motor may be calculated using the torque τ calculated in the feed forward loop 627 and the axial distance l . The force F can be calculated as τ / l . The desired additional force exerted on each motor can be calculated by the mixer. The desired further force can be transmitted as a command signal to each motor. The force on each motor may be the same or different. For example, for the first motor M1640a, the desired force may be ΔF1, and for the second motor M2640b, the desired force may be ΔF2, and the third motor M3640c it is against, for desired force may be ΔF3 fourth motor M4640d, the desired force may be Derutaefu4. In these examples, at least one or all may be such. The motor can operate at a level that produces the desired or approximate desired force. In some embodiments, a motor lift curve 670 can be used in determining the motor output. The curve may include lift generated per rate of motor operation. The motor lift curve may be the thrust per operating rate. The curve may show a non-linear relationship. The motor lift curve may be an aircraft configuration parameter that may be derived from one or more physical characteristics of the aircraft. One or more of the aircraft configuration parameters derived from the one or more physical parameters may be non-linear parameters.

モーター640a、640b、640c、640dからの出力を使用して、航空機の1つ以上の推進ユニットを駆動できる。これは、航空機の位置決定、速度、または加速度の少なくとも1つを決定し得る。モーターからの出力は、航空機の姿勢、角速度、または角加速度の少なくとも1つに影響し得る。任意の数のモーターまたは推進ユニットの少なくとも一方を設けることができる。各モーターに対する出力を決定するために生成されるコマンド信号を個別に決定して、遠隔の制御器から航空機を目標姿勢に向かわせることができる。   The output from motors 640a, 640b, 640c, 640d can be used to drive one or more propulsion units of the aircraft. This may determine at least one of aircraft positioning, speed, or acceleration. The output from the motor can affect at least one of aircraft attitude, angular velocity, or angular acceleration. Any number of motors or propulsion units can be provided. The command signals generated to determine the output for each motor can be determined individually to direct the aircraft to a target attitude from a remote controller.

動態650システムは、航空機に関係する位置情報を記録できる。例えば、1つ以上の慣性センサは、航空機姿勢、角速度、または角加速度の少なくとも1つを決定し、その情報を制御システムに供給し返すことができる。ある実施形態では、モーターへの出力または測定したモーターからの出力を使用して、航空機姿勢、角速度、または角加速度の少なくとも1つを計算してもよい。他の機内または機外センサを使用して、航空機の動態を決定してもよい。   The dynamic 650 system can record location information related to the aircraft. For example, one or more inertial sensors can determine at least one of aircraft attitude, angular velocity, or angular acceleration and provide that information back to the control system. In some embodiments, the output to the motor or the output from the measured motor may be used to calculate at least one of aircraft attitude, angular velocity, or angular acceleration. Other in-flight or out-of-flight sensors may be used to determine aircraft dynamics.

任意の飛行制御ステップは、航空機上に設けることができるソフトウェアを用いて実行し得る。ソフトウェアは、航空機構成パラメータの値を組み込むまたは受け入れることができる。航空機構成パラメータは、航空機または航空機モデルの1つ以上の物理的特性を含む、またはそれに由来し得る。したがって、飛行制御ソフトウェアは、航空機または航空機モデルに特有であることができ、より正確な制御を提供することができる。   Any flight control steps may be performed using software that may be provided on the aircraft. The software can incorporate or accept values for aircraft configuration parameters. Aircraft configuration parameters may include or be derived from one or more physical characteristics of an aircraft or aircraft model. Thus, flight control software can be specific to the aircraft or aircraft model and can provide more accurate control.

図6Bは、本発明の実施形態に関わる、航空機が実装し得る姿勢制御方式を示す図である。姿勢制御方式は、図6Aに示す姿勢制御方式の1つ以上の特徴または特性を有してもよい。   FIG. 6B is a diagram illustrating an attitude control method that can be implemented by an aircraft according to an embodiment of the present invention. The attitude control scheme may have one or more features or characteristics of the attitude control scheme illustrated in FIG. 6A.

目標は、任意の姿勢コマンドを追跡することであり得る。

構成多様体は非線形であり得るため、課題が生じる場合がある。
The goal may be to track any posture command.

Constituent manifolds can be non-linear, which can create challenges.

飛行プランナ(se(3))610bを設けて、航空機の飛行を決定するコマンド信号を生成できる。飛行プランナは、航空機上に設けてもよいし、または航空機外に設けて航空機と通信してもよい。ある実施形態では、SO(3)の指数座標は、線形空間に設けることができる。これは、測地の観点から最適または好ましい場合がある。また、特異点(オイラー角)または曖昧性(四元数、2−>1)の少なくとも一方は存在しなくてもよい。 A flight planner (se (3)) 610b can be provided to generate a command signal that determines the flight of the aircraft. The flight planner may be provided on the aircraft or may be provided outside the aircraft to communicate with the aircraft. In some embodiments, the exponential coordinates of SO (3) can be provided in a linear space. This may be optimal or preferred from a geodetic point of view. Further, at least one of a singular point (Euler angle) or ambiguity (quaternion, 2-> 1) may not exist.

遠隔の制御器605bまたは他の類型の飛行制御デバイスを、本発明の実施形態に従って設けることができる。遠隔の制御器をユーザーが操作して、航空機の飛行を制御できる。これは、航空機の場所、および航空機の角度方向を含み得る。ある実施形態では、ユーザーは、リアルタイムで航空機飛行に関する命令を直接入力できる。例えば、ユーザーは、入力を提供して、航空機の姿勢を調節できる。他の実施形態では、ユーザーは、所定のまたは事前プログラムされた経路に従うようにという航空機に対する命令を与えてもよい。また、遠隔の制御器は、航空機から分離でき、無線接続により航空機と通信できる。また、飛行制御デバイスは、航空機に組み込まれてもよく、遠隔の制御器についての本明細書中の一切の記載は、航空機の一部である飛行制御デバイスにも適用することができる。例えば、ユーザーは、航空機に搭乗し、機上の飛行制御デバイスにより飛行のための命令を提供してもよい。 A remote controller 605b or other type of flight control device may be provided in accordance with embodiments of the present invention. A remote controller can be operated by the user to control the flight of the aircraft. This may include the location of the aircraft and the angular orientation of the aircraft. In some embodiments, the user can directly enter aircraft flight instructions in real time. For example, the user can provide input to adjust the attitude of the aircraft. In other embodiments, the user may give instructions to the aircraft to follow a predetermined or pre-programmed route. Also, the remote controller can be separated from the aircraft and can communicate with the aircraft via a wireless connection. Also, the flight control device may be incorporated into an aircraft, and any description herein for a remote controller can also be applied to a flight control device that is part of an aircraft. For example, a user may board an aircraft and provide instructions for flight through an onboard flight control device.

遠隔の制御器605bは、1つ以上の目標姿勢θ_Tarを示す信号をプランナ610bに提供することができる。目標姿勢は、1つ、2つ、または3つの回転の軸を中心とした航空機の目標姿勢であり得る。例えば、目標姿勢は、ピッチ、ロール、およびヨー軸を中心とした航空機の姿勢を示してもよい。プランナは、航空機のモーターに提供する1つ以上の信号を計算して、目標姿勢の達成を試みることができる。   The remote controller 605b can provide a signal to the planner 610b indicating one or more target attitudes θ_Tar. The target attitude may be the target attitude of the aircraft about one, two, or three axes of rotation. For example, the target attitude may indicate the attitude of the aircraft around the pitch, roll, and yaw axes. The planner may attempt to achieve the target attitude by calculating one or more signals to provide to the aircraft motor.

プランナ610bはまた、航空機の動態650bについての情報を受信してもよい。ある実施形態では、航空機の動態についての情報は、1つ以上のセンサによって提供され得る。ある実施形態では、航空機の動態についての情報は、航空機内からの1つ以上の慣性センサ(例えば、1つ以上のジャイロスコープまたは加速度計)から提供されてもよい。航空機の動態についての情報は、ピッチ軸、ロール軸、およびヨー軸という軸のうちの1つ、2つ、または3つを中心とした、姿勢、角速度、または角加速度の少なくとも1つを含み得る。また、航空機の現在の姿勢θ_Curをプランナに伝達することができる。プランナは、目標姿勢θ_Tarを現在の姿勢θ_Curと比較することができる。この比較は、ピッチ、ロール、およびヨー軸の各々について行い得る。角度の差は、姿勢の誤差θ_Errであると判定できる。   Planner 610b may also receive information about aircraft dynamics 650b. In certain embodiments, information about aircraft dynamics may be provided by one or more sensors. In certain embodiments, information about aircraft dynamics may be provided from one or more inertial sensors (eg, one or more gyroscopes or accelerometers) from within the aircraft. Information about aircraft dynamics may include at least one of attitude, angular velocity, or angular acceleration about one, two, or three of the axes: pitch axis, roll axis, and yaw axis. . In addition, the current attitude θ_Cur of the aircraft can be transmitted to the planner. The planner can compare the target posture θ_Tar with the current posture θ_Cur. This comparison can be made for each of the pitch, roll, and yaw axes. It can be determined that the angle difference is an attitude error θ_Err.

ピッチ制御620dのみを詳細に示すが、同一の制御方式が、ロール制御620eおよびヨー制御620fにも適用できる。ピッチ制御または一切の角度制御一般についての一切の考察は、これらの軸のうちいずれかまたは全てに適用できる。姿勢、角速度、または角加速度の少なくとも1つについての一切の説明は、これらの軸のうちのいずれかまたは全てに適用できる。3つの軸は、相互に分離していてもよい。   Although only the pitch control 620d is shown in detail, the same control method can be applied to the roll control 620e and the yaw control 620f. Any consideration of pitch control or any angle control in general can be applied to any or all of these axes. Any description of at least one of attitude, angular velocity, or angular acceleration is applicable to any or all of these axes. The three axes may be separated from each other.

姿勢の誤差θ_Errをファジー論理621bと共に使用して、航空機の角度を制御できる。制御はフィードバック制御であり得る。ある実施形態では、フィードバック制御は、比例、積分、または微分制御方式の少なくとも一方を使用し得る。フィードバック制御は、ファジー比例積分微分(PID)制御であってもよい。また、目標姿勢は、比例(P)622bまたはPID制御できる。角度制御ループ設けられてもよい。 Attitude error θ_Err can be used with fuzzy logic 621b to control the angle of the aircraft. The control can be feedback control. In some embodiments, feedback control may use at least one of proportional, integral, or derivative control schemes. The feedback control may be fuzzy proportional integral derivative (PID) control. In addition, the target attitude is, proportional (P) 622b or PID system as possible out of control. Angle control loop may be provided.

目標角速度ω_Tarが生じ得る。目標角速度を、測定した角速度ω623bと比較できる。測定した角速度は、1つ以上のセンサにより測定できる航空機の動態650bの一部であり得る。目標角速度を、測定した角速度と比較して、角速度の誤差ω_Errを決定できる。   A target angular velocity ω_Tar can occur. The target angular velocity can be compared with the measured angular velocity ω623b. The measured angular velocity can be part of aircraft dynamics 650b that can be measured by one or more sensors. Comparing the target angular velocity with the measured angular velocity, the angular velocity error ω_Err can be determined.

角速度の誤差ω_Errは、航空機の角速度を制御するために、ファジー論理と共に使用してもしなくてもよい。制御はフィードバック制御であり得る。ある実施形態では、フィードバック制御は、比例、積分、または微分制御方式の少なくとも一方を使用し得る。フィードバック制御は、比例積分微分(PID)制御であり得る。また、目標角速度は、比例微分(PD)制御624bできる。角速度ループ設けられてもよい。 The angular velocity error ω_Err may or may not be used with fuzzy logic to control the angular velocity of the aircraft. The control can be feedback control. In some embodiments, feedback control may use at least one of proportional, integral, or derivative control schemes. The feedback control can be a proportional integral derivative (PID) control. Further, the target angular velocity can be proportionally differentiated (PD) controlled 624b. Angular velocity loop may be provided.

目標の角速度の変化ω_Tarが生じ得る。角速度の変化は、角加速度であり得る。目標角加速度を、測定した角速度の変化ω625bと比較できる。測定した角速度の変化は、1つ以上のセンサにより測定できる航空機の動態650bの一部であり得る。目標の角速度の変化を、測定した角速度の変化と比較して、角速度の変化の誤差ω_Errを決定できる。   A target angular velocity change ω_Tar can occur. The change in angular velocity can be angular acceleration. The target angular acceleration can be compared with the measured angular velocity change ω 625b. The measured change in angular velocity can be part of aircraft dynamics 650b that can be measured by one or more sensors. The change in the target angular velocity can be compared with the measured change in angular velocity to determine the angular velocity change error ω_Err.

角速度の変化の誤差ω_Errは、航空機の角速度の変化を制御するために、ファジー論理と共に使用してもしなくてもよい。制御はフィードバック制御であり得る。ある実施形態では、フィードバック制御は、比例、積分、または微分制御方式の少なくとも一方を使用し得る。フィードバック制御は、比例積分微分(PID)制御であり得る。また、目標の角速度の変化は、比例積分(PI)626bまたはPID制御できる。角加速度ループ設けられてもよい。 Angular velocity change error ω_Err may or may not be used with fuzzy logic to control aircraft angular velocity changes. The control can be feedback control. In some embodiments, feedback control may use at least one of proportional, integral, or derivative control schemes. The feedback control can be a proportional integral derivative (PID) control. In addition, a change in the target of the angular velocity is proportional-integral (PI) 626b or PID system as possible out of control. Angular acceleration loop may be provided.

フィードフォワードループ627bも設けることができる。フィードフォワードループ627bは、角速度の変化に対して設けてもよい。例えば、目標の角速度の変化ω_Tarは、フィードフォワードループ627bにおいて使用できる。ある実施形態では、航空機の1つ以上の物理的特性に由来し得る1つ以上の航空機構成パラメータ660bは、フィードフォワードループ627bに組み込むことができる。例えば、航空機の慣性モーメントJを、フィードフォワードループ627bに提供することができる。また、航空機のトルクτは、Jω+ω×Jωと計算できる。したがって、角速度の変化に対するループは、慣性モーメントを使用して出力を計算でき、同時に、角速度値の現在の変化および現在の角加速度値に従って補償量としてPID制御を行うことができる。 A feed forward loop 627b can also be provided. The feed forward loop 627b may be provided for changes in angular velocity. For example, the target angular velocity change ω_Tar can be used in the feed forward loop 627b . In certain embodiments, one or more aircraft configuration parameters 660b that may be derived from one or more physical characteristics of the aircraft can be incorporated into the feedforward loop 627b . For example, the moment of inertia J of the aircraft can be provided to the feed forward loop 627b . The aircraft torque τ can be calculated as Jω + ω b × Jω b . Therefore, the loop for the change in angular velocity can calculate the output using the moment of inertia, and at the same time, can perform PID control as a compensation amount according to the current change in angular velocity value and the current angular acceleration value.

したがって、フィードフォワードとフィードバックとの両方を、角速度の変化(また、角加速度であってもよい)の制御に使用できる。フィードフォワードモデルパラメータは、制御システムの応答時間を改善することができ、一方フィードバック制御は、モデル誤差および動的外乱を補償できる。角速度制御は航空機全体の回転トルク制御と直接的に見なし得るため、この制御方式を使用しないシステムよりも、外部の外乱に対する応答時間は更に短くなり得、抑制作用はより優れている。フィードフォワードループは、角加速度ループが直接制御として作動することを可能にするため、応答時間が短くなり得る。外乱を直接抑制でき、それにより応答時間を削減できる。   Thus, both feedforward and feedback can be used to control the change in angular velocity (which can also be angular acceleration). Feedforward model parameters can improve the response time of the control system, while feedback control can compensate for model errors and dynamic disturbances. Since angular velocity control can be directly regarded as rotational torque control of the entire aircraft, the response time to external disturbance can be further shortened and the suppression action is better than a system that does not use this control method. The feed forward loop allows the angular acceleration loop to operate as a direct control, so response time can be shortened. Disturbances can be directly suppressed, thereby reducing response time.

ミキサ60bを、本発明の実施形態に従って設けることができる。ミキサは、本発明の実施形態に従う、飛行制御器の一部であり得る。ミキサは、飛行プランナ610bに対して使用したプロセッサと同一のものであってもなくてもよい、1つ以上のプロセッサを含み得る。ミキサは、ピッチ制御、ロール制御、またはヨー制御の少なくとも1つのための姿勢に関連する情報を受信することができる。例えば、角速度の変化に関連するフィードフォワードおよびフィードバックループ後のデータは、ピッチ軸、ヨー軸、ロール軸の回転の軸の各々に対してミキサに提供することができる。計算結果の全てが合計され得るThe mixer 6 3 0b, can be provided in accordance with an embodiment of the present invention. The mixer may be part of a flight controller according to an embodiment of the present invention. The mixer may include one or more processors that may or may not be the same processor used for flight planner 610b. The mixer can receive information related to attitude for at least one of pitch control, roll control, or yaw control. For example, data after the feedforward and feedback loops associated with a change of the angular velocity can provide pitch axis, yaw axis, the mixer for each of the axes of rotation of the roll shaft. All of the calculation results can be summed.

ミキサ60bは、航空機構成パラメータ660bに関する情報を受信できる。航空機構成パラメータは、航空機または航空機モデルの物理的特性に由来し得る。ある実施形態では、ミキサは、航空機の軸方向距離を受信できる。軸方向距離は、航空機のモーターと空力中心との間の距離であることができる。あるいは、軸方向距離は、航空機の推進ユニットと空力中心との間の距離であってもよい。また、航空機は、複数のモーター641a、641b、641c、641dを有し得る。軸方向距離は、モーターの各々に対して同一であり得る。あるいは、異なるモーターは異なる軸方向距離を有してもよい。また、軸方向距離は、推進ユニットが創出する推力の方向で、推進ユニットまたは回転翼の少なくとも1つを貫通する軸と、空力中心との間の距離であり得る。 Mixer 6 3 0b can receive information about the aircraft configuration parameters 660b. Aircraft configuration parameters may be derived from the physical characteristics of the aircraft or aircraft model. In one embodiment, the mixer can receive an aircraft axial distance l . The axial distance can be the distance between the aircraft motor and the aerodynamic center. Alternatively, the axial distance may be the distance between the aircraft propulsion unit and the aerodynamic center. The aircraft may also have a plurality of motors 641a, 641b, 641c, 641d. The axial distance can be the same for each of the motors. Alternatively, different motors may have different axial distances. Further, the axial distance may be a distance between an axis penetrating at least one of the propulsion unit or the rotor blade and an aerodynamic center in a direction of thrust generated by the propulsion unit.

ミキサ60bは、各推進ユニットが及ぼす所望の力を計算できる。力は、航空機構成パラメータ660b、およびピッチ軸、ヨー軸、ロール軸の回転の軸の各々に対する制御方式からの情報に基づいて計算できる。フィードフォワードループ627bで計算したトルクτ、および軸方向距離を使用して、各モーターの力を計算してもよい。力Fは、τ/と計算できる。各モーターに及ぼされる所望の更なる力は、ミキサによって計算することができる。所望の更なる力は、各モーターにコマンド信号として伝達できる。各モーターに対する力は同一であってもよいし、または異なってもよい。例えば、第1のモーターM1641aに対しては、所望の力はΔF1であってもよく、第のモーターM2641bに対しては、所望の力はΔF2であってもよく、第のモーターM3641cに対しては、所望の力はΔF3であってもよく、または、あるいは及び、第のモーターM4641dに対しては、所望の力はΔF4であってもよい。モーターは、所望の力またはおよその所望の力を生成するレベルで動作できる。ある実施形態では、モーター出力を決定する際に、モーター揚力曲線670bを使用することができる。曲線は、モーター動作の割合当たりに生成される揚力を含み得る。モーター揚力曲線は、動作割合当たりの推力であり得る。曲線は非線形関係を示し得る。モーター揚力曲線は、航空機の1つ以上の物理的特性に由来し得る航空機構成パラメータであり得る。1つ以上の物理的パラメータに由来する航空機構成パラメータのうちの1つ以上は、非線形パラメータであり得る。 Mixer 6 3 0b can calculate the desired force the propulsion unit on. Force, aircraft configuration parameters 660b, and pitch axis, yaw axis can be calculated based on information from the control system for each axis of rotation of the roll shaft. The torque of each motor may be calculated using the torque τ calculated in the feedforward loop 627b and the axial distance l . The force F can be calculated as τ / l . The desired additional force exerted on each motor can be calculated by the mixer. The desired further force can be transmitted as a command signal to each motor. The force on each motor may be the same or different. For example, for the first motor M1641a, the desired force may be ΔF1, and for the second motor M2641b, the desired force may be ΔF2, and the third motor M3641c On the other hand, the desired force may be ΔF3, or alternatively, for the fourth motor M4641d, the desired force may be ΔF4. The motor can operate at a level that produces the desired or approximate desired force. In some embodiments, the motor lift curve 670b can be used in determining the motor output. The curve may include lift generated per rate of motor operation. The motor lift curve may be the thrust per operating rate. The curve may show a non-linear relationship. The motor lift curve may be an aircraft configuration parameter that may be derived from one or more physical characteristics of the aircraft. One or more of the aircraft configuration parameters derived from the one or more physical parameters may be non-linear parameters.

モーター641a、641b、641c、641dからの出力を使用して、航空機の1つ以上の推進ユニットを駆動できる。これは、航空機の位置決定、速度、または加速度の少なくとも一方を決定し得る。モーターからの出力は、航空機の姿勢、角速度、または角加速度の少なくとも1つに影響し得る。任意の数のモーターまたは推進ユニットの少なくとも一方を設けることができる。各モーターに対する出力を決定するために生成されるコマンド信号を個別に決定して、遠隔の制御器から航空機を目標姿勢に向かわせることができる。   The output from the motors 641a, 641b, 641c, 641d can be used to drive one or more propulsion units of the aircraft. This may determine at least one of aircraft positioning, speed, or acceleration. The output from the motor can affect at least one of aircraft attitude, angular velocity, or angular acceleration. Any number of motors or propulsion units can be provided. The command signals generated to determine the output for each motor can be determined individually to direct the aircraft to a target attitude from a remote controller.

動態650bシステムは、航空機に関係する位置情報を記録できる。例えば、1つ以上の慣性センサは、航空機姿勢、角速度、または角加速度の少なくとも1つを決定し、その情報を制御システムに供給し返すことができる。ある実施形態では、モーターへの出力または測定したモーターからの出力を使用して、航空機姿勢、角速度、または角加速度の少なくとも1つを計算してもよい。他の機内または機外センサを使用して、航空機の動態を決定してもよい。   The dynamic 650b system can record position information related to the aircraft. For example, one or more inertial sensors can determine at least one of aircraft attitude, angular velocity, or angular acceleration and provide that information back to the control system. In some embodiments, the output to the motor or the output from the measured motor may be used to calculate at least one of aircraft attitude, angular velocity, or angular acceleration. Other in-flight or out-of-flight sensors may be used to determine aircraft dynamics.

ある実施形態では、システムの運動学を検討することができる。一次完全作動システムを設けてもよい。

式中、




比例制御を適用することができる。
In some embodiments, the kinematics of the system can be considered. A primary fully operational system may be provided.

Where




Proportional control can be applied.

幾何学的制御をSO(3)に設けてもよい。
規制の場合:


追従の場合:

式中、

gは現在の方向であり、
は所望の方向であり、
は制御器の利得である。
Geometric control may be provided for SO (3).
For regulations:


For tracking:

Where

g is the current direction,
g d is the desired direction,
k p is the gain of the controller.

動態は以下であってもよく、

式中、










制御方式のフィードフォワードループに既に実装したように、線形制御を設けることができる。これは、角速度制御を含み得る。


角速度制御は以下を含み得る。

The kinetics may be

Where










Linear control can be provided as already implemented in the feedforward loop of the control scheme. This can include angular velocity control.


Angular velocity control may include:

図6Cは、本発明の実施形態に関わる、制御内側ループの一部分を示す図である。アクチュエータのシステム同定を行うことができる。アクチュエータは、プロペラ、回転翼、モーター、または他の類型のアクチュエータを含み得る。時間遅れを持つ一次システムのためのアクチュエータモデルは、以下であってもよい。
FIG. 6C is a diagram illustrating a portion of a control inner loop, according to an embodiment of the present invention. System identification of the actuator can be performed. The actuator may include a propeller, rotor, motor, or other type of actuator. The actuator model for a primary system with time delay may be:

図6Cは、制御方式で利用できるスミス予測器の実施例を示す。スミス予測器は、内側ループ制御の一部であることができる。スミス予測器は、航空機の動態を予測および補正できる。スミス予測器は、純時間遅れを持つシステムに使用できる予測制御器であり得る。   FIG. 6C shows an example of a Smith predictor that can be used in the control scheme. The Smith predictor can be part of the inner loop control. The Smith predictor can predict and correct aircraft dynamics. The Smith predictor can be a predictive controller that can be used in a system with a pure time delay.

図6Dは、本発明の実施形態に関わる、姿勢制御方式を示す図である。ステップ信号(例えば、ステップ)を入力として設けることができる。DC信号を用いることができる。示す姿勢制御方式の上部は従来の制御器設計であってもよいが、下部は、予測器と共にカスケード制御を使用する、提案の制御設計であってもよい。   FIG. 6D is a diagram illustrating an attitude control method according to the embodiment of the present invention. A step signal (eg, step) can be provided as an input. A DC signal can be used. The upper part of the attitude control scheme shown may be a conventional controller design, while the lower part may be a proposed control design that uses cascade control with a predictor.

制御方式の一部分は、1つ以上のPID制御器(例えば、PID制御器4、PID制御器1)を含み得る。これらは、内側PIDループおよび外側PIDループを含み得る。任意の数のPIDループを設けることができる(例えば、1、2、3、4、5、またはそれ以上のループ)。ある実施形態では、PIDループのうちの1つ以上は、相互に入れ子にできる。スイッチ(例えば、スイッチ)を設けることができる。スイッチは、信号飽和が生じるときに位置を変更し得る。結果としての信号は、システム伝達関数(例えば、システム伝達関数1)を受け、1つ以上の積分器(例えば、積分器、積分器4)と相互作用できる。フィードバックプロセスでは、輸送遅れ(例えば、輸送遅れ2、輸送遅れ9)があり得る。   A portion of the control scheme may include one or more PID controllers (eg, PID controller 4, PID controller 1). These can include an inner PID loop and an outer PID loop. Any number of PID loops can be provided (eg, 1, 2, 3, 4, 5, or more loops). In some embodiments, one or more of the PID loops can be nested within each other. A switch (eg, a switch) can be provided. The switch may change position when signal saturation occurs. The resulting signal can receive a system transfer function (eg, system transfer function 1) and interact with one or more integrators (eg, integrator, integrator 4). In the feedback process, there may be a transport delay (eg, transport delay 2, transport delay 9).

制御方式の一部分は、航空機の角度または角速度の少なくとも1つに基づいて角度を制御するために使用する制御器であり得る。   A portion of the control scheme may be a controller used to control the angle based on at least one of the aircraft angle or angular velocity.

制御方式の別の部分は、1つ以上のPID制御器(例えば、PID制御器2、PID制御器3、PID制御器5)を含み得る。これは、1つ以上の内側PIDループまたは外側PIDループの少なくとも一方を含んでもよい。任意の数のPIDループを、相互に入れ子にできるように設けることができる。スイッチ(例えば、スイッチ3)を設けることができる。スイッチは、信号飽和が生じるときに位置を変更し得る。結果としての信号は、システム伝達関数(例えば、システム伝達関数2)を受け、1つ以上の積分器(例えば、積分器2、積分器5)と相互作用できる。フィードバックプロセスでは、輸送遅れ(例えば、輸送遅れ5、輸送遅れ6、輸送遅れ8、輸送遅れ10)があり得る。フィードバックでは、モデル伝達関数(例えば、モデル伝達関数1、モデル伝達関数2、モデル伝達関数3)、および関連するスイッチ(例えば、スイッチ4、スイッチ5、スイッチ)があり得る。   Another part of the control scheme may include one or more PID controllers (eg, PID controller 2, PID controller 3, PID controller 5). This may include at least one of one or more inner PID loops or outer PID loops. Any number of PID loops can be provided to be nested within each other. A switch (eg, switch 3) can be provided. The switch may change position when signal saturation occurs. The resulting signal can receive a system transfer function (eg, system transfer function 2) and interact with one or more integrators (eg, integrator 2, integrator 5). In the feedback process, there may be a transport delay (eg, transport delay 5, transport delay 6, transport delay 8, transport delay 10). In feedback, there can be a model transfer function (eg, model transfer function 1, model transfer function 2, model transfer function 3) and associated switches (eg, switch 4, switch 5, switch).

制御方式の他の部分は、航空機の角度、角速度、または角加速度の少なくとも1つに基づいて航空機の角度を制御できる制御器であり得る。加えて、スミス予測器は、制御方式の一部分に含むことができる。   Another part of the control scheme may be a controller that can control the aircraft angle based on at least one of the aircraft angle, angular velocity, or angular acceleration. In addition, the Smith predictor can be included as part of the control scheme.

ある実施形態では、出力は、スコープに提供することができる。これらの更なる特徴を組み込むことにより改善された制御方式を使用した結果を、図8に示すことができる。 In some embodiments, the output may be provided to the scope. The result of using an improved control scheme by incorporating these additional features can be shown in FIG.

図7Aは、本発明の実施形態に関わる、追従誤差を示す図である。これは、前述のように、姿勢制御の一部として組み込むことができる。目標をフィードバック値と比較して、誤差を得ることができる。これは、角度、角速度、または角加速度の少なくとも1つに対して行ってもよい。これは、ピッチ軸、ロール軸、またはヨー軸などの1つ以上の軸に行ってもよい。   FIG. 7A is a diagram illustrating a tracking error according to the embodiment of the present invention. This can be incorporated as part of attitude control, as described above. An error can be obtained by comparing the target with a feedback value. This may be done for at least one of angle, angular velocity, or angular acceleration. This may be done on one or more axes such as a pitch axis, roll axis, or yaw axis.

誤差は、航空機の姿勢特徴(例えば、角度、角速度、または角加速度)を制御するために、ファジー論理と共に使用してもしなくてもよい。制御はフィードバック制御であり得る。ある実施形態では、フィードバック制御は、比例、積分、または微分制御方式の少なくとも1つを使用し得る。フィードバック制御は、比例積分微分(PID)制御であり得る。また、目標姿勢特徴は、比例(P)制御710できる。姿勢特徴の誤差720は、制御器710に提供できる。ファジー論理730を用いて、航空機の姿勢特徴(例えば、角度、角速度、角加速度)を制御してもよい。   The error may or may not be used with fuzzy logic to control aircraft attitude characteristics (eg, angle, angular velocity, or angular acceleration). The control can be feedback control. In some embodiments, feedback control may use at least one of proportional, integral, or derivative control schemes. The feedback control can be a proportional integral derivative (PID) control. The target posture feature can be proportionally (P) controlled 710. The attitude feature error 720 can be provided to the controller 710. Fuzzy logic 730 may be used to control aircraft attitude characteristics (eg, angle, angular velocity, angular acceleration).

また、フィードバック値を得てもよい。例えば、制御された姿勢特徴の誤差.P(誤差)740の誤差値を得ることができる。ある実施形態では、誤差740値を決定する際に、ファジー論理750を用いてもよい。誤差値は、1つ以上の測定した航空機動態を用いて決定できる。例えば、航空機の姿勢特徴は、1つ以上のセンサを用いて測定できる。制御器の利得は、ファジー論理エンジンが動的に調節し得る。この方式は、誤差が大きい場合に、応答速度を改善でき、有利となる。同時に、本方式は、誤差が小さい場合には、安定性を改善できる。   Further, a feedback value may be obtained. For example, errors in controlled pose features. An error value of P (error) 740 can be obtained. In some embodiments, fuzzy logic 750 may be used in determining the error 740 value. The error value can be determined using one or more measured aircraft dynamics. For example, aircraft attitude characteristics can be measured using one or more sensors. The gain of the controller can be adjusted dynamically by the fuzzy logic engine. This method is advantageous in that the response speed can be improved when the error is large. At the same time, this method can improve stability when the error is small.

図7Bは、本発明の実施形態に関わる、追従誤差を示す更なる図である。メンバーシップ度の例を表示する。更に、誤差の関数としての比例利得(kp)を計算または決定の少なくとも一方ができる。比例利得kpは、誤差の非線形関数であり得る。この非線形関数は、航空機姿勢制御に使用できる。非線形比例利得関数は、航空機制御の誤差追従に使用できる。   FIG. 7B is a further diagram illustrating the tracking error according to an embodiment of the present invention. Show example membership degrees. Furthermore, a proportional gain (kp) as a function of error can be calculated and / or determined. The proportional gain kp can be a non-linear function of the error. This nonlinear function can be used for aircraft attitude control. The nonlinear proportional gain function can be used for error tracking in aircraft control.

図8には、従来の制御器と比較した、本発明を適用した制御器の応答との間の比較が示されている。本制御器により、従来の制御器よりも早い応答および小さいオーバーシュートを得ることができる。その上、定常状態に落ち着くためにより短い時間を使用し得る。   FIG. 8 shows a comparison between the response of a controller to which the present invention is applied compared to a conventional controller. With this controller, it is possible to obtain faster response and smaller overshoot than conventional controllers. Moreover, a shorter time can be used to settle to a steady state.

目標角度を示すことができる。例えば、特定の時点における特定の程度値を有する目標角度に到達することが望ましい場合がある。例えば、0.5単位時間で、コマンドは、目標角度を40(例えば、40度)に変更するように提供できる。本明細書に記載する提案の制御器および従来の制御器への応答を提供する。提案の制御器は、本明細書の他の箇所に記載する制御方式を実装してもよい。提案の制御器は、航空機の物理的特性を考慮に入れることができる。提案の制御器は、加速度についてのフィードフォワードおよびフィードバックループを使用できる。ある実施形態では、従来の制御器は、航空機の物理的特性を考慮に入れない。従来の制御器は、航空機の慣性モーメントを計算せず、慣性モーメントを制御方式に組み込まない。従来の制御器は、また、加速度についてのフィードフォワードおよびフィードバックループを含まなくてもよい。   A target angle can be indicated. For example, it may be desirable to reach a target angle having a specific degree value at a specific time. For example, in 0.5 unit time, the command can be provided to change the target angle to 40 (eg, 40 degrees). It provides a response to the proposed controller and the conventional controller described herein. The proposed controller may implement the control scheme described elsewhere in this specification. The proposed controller can take into account the physical characteristics of the aircraft. The proposed controller can use feedforward and feedback loops for acceleration. In some embodiments, conventional controllers do not take into account the physical characteristics of the aircraft. Conventional controllers do not calculate the moment of inertia of the aircraft and do not incorporate the moment of inertia into the control scheme. Conventional controllers may also not include feedforward and feedback loops for acceleration.

提案の制御器の応答は、図示する通り、従来の制御器の応答よりも速くてもよい。ある実施形態では、提案の制御器の応答は、従来の制御器の応答よりも約2倍速くてもよい。例えば、提案の制御器により、航空機は、従来の制御器を使用する航空機よりも約2倍早く目標角度に到達し得る。また、提案の制御器は、従来の制御器よりも、1.1倍早く、1.2倍早く、1.3倍早く、1.5倍早く、2倍早く、2.5倍早く、3倍早く、3.5倍早く、4倍早く、5倍早く、6倍早く、7倍早く、または10倍早く、目標角度に到達し得る。したがって、本明細書に記載する提案の制御方式により、航空機は、より迅速に応答して目標角度に到達し得る。   The response of the proposed controller may be faster than the response of a conventional controller, as shown. In certain embodiments, the response of the proposed controller may be about twice as fast as the response of a conventional controller. For example, with the proposed controller, the aircraft can reach the target angle approximately twice as fast as an aircraft using a conventional controller. The proposed controller is 1.1 times faster, 1.2 times faster, 1.3 times faster, 1.5 times faster, 2 times faster, 2.5 times faster than the conventional controller. The target angle may be reached twice as fast, 3.5 times faster, 4 times faster, 5 times faster, 6 times faster, 7 times faster, or 10 times faster. Thus, the proposed control scheme described herein allows the aircraft to respond more quickly to reach the target angle.

提案の制御器は、従来の制御器よりも微弱な振動を有し得る。提案の制御器は、ほとんどまたは全く振動を有さなくてもよい。振動とは、目標角度前後の航空機の姿勢における変動を指し得る。例えば、航空機が目標角度に接近しているとき、航空機が目標角度に到達し、そこで安定する前に、多少の変動を引き起こす多少のオーバーショットまたは過補償の少なくとも一方がある場合がある。   The proposed controller may have weaker vibrations than conventional controllers. The proposed controller may have little or no vibration. Vibration can refer to variations in the attitude of the aircraft around a target angle. For example, when the aircraft is approaching the target angle, there may be at least one of some overshot or overcompensation that causes some variation before the aircraft reaches the target angle and stabilizes there.

本発明に関わる方法およびシステムは、1つ、2つ、または3つの回転の軸に対する改善した航空機の姿勢制御を提供することができる。簡略化したパラメータ調整を提供することができる。航空機性能のパラメータを評価するとき、飛行制御器が直接パラメータ評価を実行でき、それにより従来のシステムに比べてパラメータ調整時間を大幅に削減できる。航空機の寸法および重量の変更ならびに変動に適応できる。飛行制御パラメータ調整は、航空機の基本パラメータを調節することにより、容易かつ確実に完了できる。したがって、制御システムは、異なる物理的特性を持つ航空機の異なるモデル、または既存の航空機に生じ得る物理的変化を考慮に入れることができる。   The methods and systems in accordance with the present invention can provide improved aircraft attitude control about one, two, or three axes of rotation. Simplified parameter adjustment can be provided. When evaluating aircraft performance parameters, the flight controller can directly perform parameter evaluation, thereby significantly reducing parameter adjustment time compared to conventional systems. Adaptable to changes and variations in aircraft dimensions and weight. The flight control parameter adjustment can be completed easily and reliably by adjusting the basic parameters of the aircraft. Thus, the control system can take into account different models of aircraft with different physical characteristics, or physical changes that may occur in existing aircraft.

加えて、本明細書に記載する角加速度ループは、動的追従性能および外乱耐性を強化できる。角加速度ループ制御は直接制御として作動できるため、従来の制御システムと比較して、応答時間が短くなり得、かつ強い耐外乱特性を有し得る。例えば、従来のシステムは角速度ループ制御を使用し、飛行機がまだ回転速度を発生させていないときに、制御に遅れが出る場合がある。記載するように角加速度ループを使用することにより、外乱を直接抑制でき、応答時間を削減できる。   In addition, the angular acceleration loop described herein can enhance dynamic tracking performance and disturbance tolerance. Since the angular acceleration loop control can operate as a direct control, the response time can be shortened and strong anti-disturbance characteristics can be obtained as compared with the conventional control system. For example, conventional systems use angular velocity loop control, and control may be delayed when the aircraft has not yet generated a rotational speed. By using an angular acceleration loop as described, disturbance can be directly suppressed and response time can be reduced.

本発明に関わるシステム、装置、及び方法は、幅広い可動物体に適用できる。上述したように、航空機に関する説明を、任意の可動物体に適用し使用することが可能である。航空機についての本明細書中の一切の記載は、特にUAVに適用できる。本発明における可動物体は、空気中で(例えば、固定翼機、回転翼航空機、または固定翼も回転翼も有さない航空機)、水中で(例えば、船舶または潜水艦)、地上で(例えば、車、トラック、バス、バン、オートバイ、自転車等の自動車、ステッキ、釣竿等の可動構造またはフレーム、または列車)、地下で(例えば、地下鉄)、宇宙で(例えば、宇宙飛行機、衛星、または宇宙探査機)等の任意の適切な環境の中で、またはこれらの環境の任意の組合せの中で移動きる。可動物体は、本明細書の他の箇所に説明される乗り物等の輸送手段であり得る。また、可動物体は、人間もしくは動物等の生体を使用して運ぶことができ、生体から発進することもできる。その場合、適切な動物は、鳥類、イヌ科の動物、ネコ科の動物、ウマ科の動物、ウシ科の動物、羊、豚、イルカ、齧歯動物、または昆虫を含み得る。 The system, apparatus and method according to the present invention can be applied to a wide range of movable objects. As described above, the description relating to the aircraft can be applied to and used with any movable object. Any description herein for aircraft is particularly applicable to UAVs. The movable object in the present invention may be in the air (eg, fixed wing aircraft, rotary wing aircraft, or aircraft having no fixed wing or rotary wing), underwater (eg, a ship or submarine), or on the ground (eg, a vehicle). , Trucks, buses, vans, motorcycles, bicycles, etc., movable structures or frames such as walking sticks, fishing rods, or trains), underground (eg subways), in space (eg spaceplanes, satellites, or space probes) ) In any suitable environment, or in any combination of these environments. The movable object may be a vehicle such as a vehicle described elsewhere herein. The movable object can be carried using a living body such as a human being or an animal, and can start from the living body. In that case, a suitable animal is, Ru include birds, canine, feline, equine, bovine animals, sheep, pigs, dolphins, rodents, or insects.

可動物質は6自由度(例えば、並進で3自由度と回転で3自由度)に関する環境内で自由に移動可能であり得る。一方、可動物体の移動は、所定の経路、軌道、または位置等によって、1つ以上の自由度に関して制約されることがある。移動は、エンジンまたはモーター等の任意の適切な作動機構によって実現できる。可動物体の作動機構は、電気エネルギー、磁気エネルギー、太陽エネルギー、風力エネルギー、重力エネルギー、化学エネルギー、核エネルギー、またはその任意の適切な組合せ等の任意の適切なエネルギー源によって電力を供給され得る。可動物体は、本明細書の他の箇所に説明されるように、推進システムを使用する自走式であり得る。また、推進システムは、電気エネルギー、磁気エネルギー、太陽エネルギー、風力エネルギー、重力エネルギー、化学エネルギー、核エネルギー、またはその任意の適切な組合せで実行してよい。また、可動物体は生物によって運ばれ得る。   The movable material may be freely movable in an environment with 6 degrees of freedom (eg, 3 degrees of freedom for translation and 3 degrees of freedom for rotation). On the other hand, movement of a movable object may be constrained with respect to one or more degrees of freedom by a predetermined path, trajectory, position, or the like. Movement can be achieved by any suitable actuation mechanism such as an engine or motor. The actuation mechanism of the movable object may be powered by any suitable energy source, such as electrical energy, magnetic energy, solar energy, wind energy, gravity energy, chemical energy, nuclear energy, or any suitable combination thereof. The movable object may be self-propelled using a propulsion system, as described elsewhere herein. The propulsion system may also be implemented with electrical energy, magnetic energy, solar energy, wind energy, gravity energy, chemical energy, nuclear energy, or any suitable combination thereof. Movable objects can also be carried by living beings.

場合によっては、可動物体は乗り物であり得る。適切な乗り物は、水上乗り物、航空機、宇宙船、または、地上車を含み得る。例えば、航空機は固定翼機(例えば、飛行機、グライダー)、回転翼航空機(例えば、ヘリコプター、回転翼機)、固定翼と回転翼の両方を有する航空機、またはどちらも有さない航空機(例えば、小型飛行船、熱気球)であり得る。航空機は、空気を通した自走式等、自走式であり得る。自走式車両は、1つ以上のエンジン、モーター、車輪、車軸、磁石、回転翼、プロペラ、羽根、ノズル、またはその任意の適切な組合せを含んだ推進システム等の推進システムを利用できる。また、推進システムは、可動物体が表面から離陸する、表面に着陸する、その現在位置または向きの少なくとも一方を維持する(例えば、ホバリングする)、向きまたは位置の少なくとも一方を変更可能に使用できる。   In some cases, the movable object may be a vehicle. Suitable vehicles may include water vehicles, aircraft, spacecraft, or ground vehicles. For example, an aircraft may be a fixed wing aircraft (eg, airplane, glider), a rotary wing aircraft (eg, helicopter, rotary wing aircraft), an aircraft with both fixed and rotary wings, or an aircraft without both (eg, small Airship, hot air balloon). The aircraft can be self-propelled, such as self-propelled through air. A self-propelled vehicle can utilize a propulsion system, such as a propulsion system that includes one or more engines, motors, wheels, axles, magnets, rotor blades, propellers, vanes, nozzles, or any suitable combination thereof. The propulsion system can also be used to allow the movable object to take off from the surface, land on the surface, maintain at least one of its current position or orientation (eg, hover), or change at least one of the orientation or position.

可動物体は、ユーザーによって遠隔で制御可能、あるいは可動物体中のまたは可動物体上の乗員によって局所的に制御可能である。ある実施形態において、可動物体はUAV等の無人可動物体である。UAV等の無人可動物体には可動物体に搭乗する乗員がいないことがある。可動物体は、人間によってまたは自律制御システム(例えば、コンピュータ制御システム)、またはその任意の適切な組合せによって制御できる。可動物体は、人工知能で構成されたロボット等の自律ロボットまたは半自律ロボットであることがある。   The movable object can be remotely controlled by the user, or locally controlled by an occupant in or on the movable object. In some embodiments, the movable object is an unmanned movable object such as a UAV. An unmanned movable object such as a UAV may not have a passenger on the movable object. The movable object can be controlled by a human or by an autonomous control system (eg, a computer control system), or any suitable combination thereof. The movable object may be an autonomous robot or a semi-autonomous robot such as a robot configured with artificial intelligence.

可動物体は任意の適切なサイズまたは寸法の少なくとも一方を有し得る。ある実施形態において、可動物体は、乗り物内部にまたは乗り物上に人間の乗員を備えるためのサイズまたは寸法の少なくとも一方を有し得る。また、可動物体は、可動物体内部にまたは可動物体上に人間の乗員を備えることができるサイズまたは寸法の少なくとも一方より、小さいサイズまたは寸法の少なくとも一方であってよい。可動物体は、人間によって持ち上げられるまたは運ばれるのに適したサイズまたは寸法の少なくとも一方であり得る。また、可動物体は、人間によって持ち上げられるか運ばれるのに適したサイズまたは寸法の少なくとも一方よりも大きいことがある。ある実施例においては、可動物体は、約2cm、5cm、10cm、50cm、1m、2m、5m、または10m以下の最大寸法(例えば、長さ、幅、高さ、直径、対角線)を有し得る。可動物体の最大寸法は、約2cm、5cm、10cm、50cm、1m、2m、5m、または10m以上であり得る。例えば、可動物体の対向する回転翼の軸間距離は、約2cm、5cm、10cm、50cm、1m、2m、5m、または10m以下であってよい。あるいは、対向する回転翼の軸間の距離は、約2cm、5cm、10cm、50cm、1m、2m、5m、または10m以上であってよい。   The movable object may have any suitable size or dimension. In certain embodiments, the movable object may have a size or dimension for providing a human occupant within or on the vehicle. Also, the movable object may be at least one of a size or dimension that is smaller than at least one of the sizes or dimensions that can comprise a human occupant within or on the movable object. The movable object can be at least one of a size or dimension suitable for being lifted or carried by a human. The movable object may also be larger than at least one of a size or dimension suitable for being lifted or carried by a human. In certain embodiments, the movable object may have a maximum dimension (eg, length, width, height, diameter, diagonal) of about 2 cm, 5 cm, 10 cm, 50 cm, 1 m, 2 m, 5 m, or 10 m or less. . The maximum dimension of the movable object may be about 2 cm, 5 cm, 10 cm, 50 cm, 1 m, 2 m, 5 m, or 10 m or more. For example, the distance between the axes of the rotor blades facing the movable object may be about 2 cm, 5 cm, 10 cm, 50 cm, 1 m, 2 m, 5 m, or 10 m or less. Alternatively, the distance between the axes of the opposing rotor blades may be about 2 cm, 5 cm, 10 cm, 50 cm, 1 m, 2 m, 5 m, or 10 m or more.

ある実施形態において、可動物体は、100cm×100cm×100cm未満、50cm×50cm×30cm未満、または、5cm×5cm×3cm未満の体積を有し得る。可動物体の全体積は、約1cm、2cm、5cm、10cm、20cm、30cm、40cm、50cm、60cm、70cm、80cm、90cm、100cm、150cm、200cm、300cm、500cm、750cm、1000cm、5000cm、10,000cm、100,000cm、1m、または、10m以下であり得る。逆に、可動物体の全体積は、約1cm、2cm、5cm、10cm、20cm、30cm、40cm、50cm、60cm、70cm、80cm、90cm、100cm、150cm、200cm、300cm、500cm、750cm、1000cm、5000cm、10,000cm、100,000cm、1m、または、10m以上でもあり得る。 In certain embodiments, the movable object may have a volume of less than 100 cm × 100 cm × 100 cm, 50 cm × 50 cm × 30 cm, or 5 cm × 5 cm × 3 cm. The total volume of the movable object is about 1 cm 3 , 2 cm 3 , 5 cm 3 , 10 cm 3 , 20 cm 3 , 30 cm 3 , 40 cm 3 , 50 cm 3 , 60 cm 3 , 70 cm 3 , 80 cm 3 , 90 cm 3 , 100 cm 3 , 150 cm 3 , 200cm 3, 300cm 3, 500cm 3 , 750cm 3, 1000cm 3, 5000cm 3, 10,000cm 3, 100,000cm 3, 1m 3, or may be 10 m 3 or less. Conversely, the total volume of the movable object is about 1 cm 3 , 2 cm 3 , 5 cm 3 , 10 cm 3 , 20 cm 3 , 30 cm 3 , 40 cm 3 , 50 cm 3 , 60 cm 3 , 70 cm 3 , 80 cm 3 , 90 cm 3 , 100 cm 3 , 150cm 3, 200cm 3, 300cm 3 , 500cm 3, 750cm 3, 1000cm 3, 5000cm 3, 10,000cm 3, 100,000cm 3, 1m 3, or can also be a 10 m 3 or more.

ある実施形態において、可動物体は、32,000cm、20,000cm、10,000cm、1,000cm、500cm、100cm、50cm、10cm、または5cm以下の専有面積(あるいは可動物体によって包囲される側面方向断面積)を有し得る。逆に、専有面積は約32,000cm、20,000cm、10,000cm、1,000cm、500cm、100cm、50cm、10cm、または5cmの以上であり得る。 In certain embodiments, the movable object, 32,000cm 2, 20,000cm 2, 10,000cm 2, 1,000cm 2, 500cm 2, 100cm 2, 50cm 2, 10cm 2 , or 5 cm 2 or less of footprint, (or May have a lateral cross-sectional area surrounded by a movable object. Conversely, footprint is approximately 32,000cm 2, 20,000cm 2, 10,000cm 2 , may be 1,000cm 2, 500cm 2, 100cm 2 , 50cm 2, 10cm 2, or more of 5 cm 2.

ある実施形態において、可動物体の重量は1000kg以下の重量であり得る。可動物体の重量は、約1000kg、750kg、500kg、200kg、150kg、100kg、80kg、70kg、60kg、50kg、45kg、40kg、35kg、30kg、25kg、20kg、12kg、10kg、9kg、8kg、7kg、6kg、5kg、4kg、3kg、2kg、1kg、0.5kg、0.1kg、0.05kg、または0.01kg以下であり得る。逆に、重量は約1000kg、750kg、500kg、200kg、150kg、100kg、80kg、70kg、60kg、50kg、45kg、40kg、35kg、30kg、25kg、20kg、12kg、10kg、9kg、8kg、7kg、6kg、5kg、4kg、3kg、2kg、1kg、0.5kg、0.1kg、0.05kg、または0.01kg以上であり得る。   In certain embodiments, the weight of the movable object may be 1000 kg or less. The weight of the movable object is about 1000 kg, 750 kg, 500 kg, 200 kg, 150 kg, 100 kg, 80 kg, 70 kg, 60 kg, 50 kg, 45 kg, 40 kg, 35 kg, 30 kg, 25 kg, 20 kg, 12 kg, 10 kg, 9 kg, 8 kg, 7 kg, 6 kg. It can be 5 kg, 4 kg, 3 kg, 2 kg, 1 kg, 0.5 kg, 0.1 kg, 0.05 kg, or 0.01 kg or less. On the contrary, the weight is about 1000 kg, 750 kg, 500 kg, 200 kg, 150 kg, 100 kg, 80 kg, 70 kg, 60 kg, 50 kg, 45 kg, 40 kg, 35 kg, 30 kg, 25 kg, 20 kg, 12 kg, 10 kg, 9 kg, 8 kg, 7 kg, 6 kg, It can be 5 kg, 4 kg, 3 kg, 2 kg, 1 kg, 0.5 kg, 0.1 kg, 0.05 kg, or 0.01 kg or more.

ある実施形態において、可動物体は可動物体によって運ばれる積載物に比して小さいことがある。積載物は、以下にさらに詳細に説明するように、搭載物または支持機構の少なくとも一方を含んでよい。可動物体重量と積載物重量の割合は、約1:1を超えてよい、未満であってよい、または等しくてよい。また、支持機構重量と積載物重量の割合は、約1:1を超えてよい、未満であってよい、または等しくてよい。所望される場合には、可動物体重量と積載物重量の割合は、1:2、1:3、1:4、1:5、1:10以下またはさらに少ないことがある。逆に、可動物体重量と積載物重量の割合は、2:1、3:1、4:1、5:1、10:1以上またはさらに大きいことがある。 In certain embodiments, the movable object may be smaller than the load carried by the movable object. The load may include at least one of a load or a support mechanism, as will be described in further detail below. The ratio of the movable object weight to the load weight may be greater than, less than, or equal to about 1: 1. Also, the ratio of the support mechanism weight to the load weight may be greater than, less than, or equal to about 1: 1. If desired, the ratio of the moving object weight to the load weight may be 1: 2, 1: 3, 1: 4, 1: 5, 1:10 or less, or even less. Conversely, the ratio of movable object weight to load weight may be 2: 1, 3: 1, 4: 1, 5: 1, 10: 1 or more, or even greater.

ある実施形態において、可動物体の消費エネルギーが低いことがある。例えば、可動物体は約5W/時、4W/時、3W/時、2W/時、1W/時未満、または以下のエネルギーを使用し得る。また、他の実施例では、可動物体の支持機構の消費エネルギーが低いことがある。例えば、支持機構は約5W/時、4W/時、3W/時、2W/時、1W/時未満、または以下のエネルギーを使用し得る。また、可動物体の搭載物の消費エネルギーは、約5W/時、4W/時、3W/時、2W/時、1W/時未満、または以下等の低いエネルギーであり得る。   In some embodiments, the energy consumption of the movable object may be low. For example, a movable object may use about 5 W / hour, 4 W / hour, 3 W / hour, 2 W / hour, less than 1 W / hour, or less energy. In other embodiments, the energy consumption of the movable object support mechanism may be low. For example, the support mechanism may use about 5 W / hr, 4 W / hr, 3 W / hr, 2 W / hr, less than 1 W / hr, or less energy. Also, the energy consumption of the movable object load can be as low as about 5 W / hour, 4 W / hour, 3 W / hour, 2 W / hour, less than 1 W / hour, or less.

図9には、無人航空機(UAV)900が、本発明の実施形態に従って示されている。無人航空機は、本明細書に説明されるように、可動物体の例であり得る。UAV900は4つの回転翼902、904、906、および908を有する推進システムを含み得る。任意の数の回転翼が提供されてよい(例えば、1つ、2つ、3つ、4つ、5つ、6つ以上)。無人機の回転翼、回転翼アッセンブリ、及び他の推進システムは、無人機がホバリングするあるいは位置を維持する、向きを変更する、または場所を変更することの少なくとも一つのことができるようにし得る。対向する回転翼の軸間の距離は任意の適切な長さ910であり得る。例えば、長さ910は、2m以下、または5m以下であり得る。ある実施形態において、長さ910は40cmから1m、10cmから2m、または5cmから5mの範囲内にあり得る。本明細書におけるいかなる無人航空機の説明も、異なるタイプの可動物体等の可動物体に適用してよく、逆の場合も同じである。無人航空機は、本明細書に説明される補助装置付き離陸システムまたは方法を使用してよい。   In FIG. 9, an unmanned aerial vehicle (UAV) 900 is shown in accordance with an embodiment of the present invention. An unmanned aerial vehicle may be an example of a movable object, as described herein. UAV 900 may include a propulsion system having four rotor blades 902, 904, 906, and 908. Any number of rotor blades may be provided (eg, 1, 2, 3, 4, 5, 6 or more). The drone's rotor, rotor assembly, and other propulsion systems may allow the drone to at least one of hover or maintain position, change orientation, or change location. The distance between the axes of opposing rotor blades can be any suitable length 910. For example, the length 910 can be 2 m or less, or 5 m or less. In certain embodiments, the length 910 can be in the range of 40 cm to 1 m, 10 cm to 2 m, or 5 cm to 5 m. Any unmanned aerial vehicle description herein may be applied to movable objects, such as different types of movable objects, and vice versa. An unmanned aerial vehicle may use the ancillary takeoff system or method described herein.

ある実施形態において、可動物体は積載物を運ぶように構成できる。積載物は、乗客、貨物、設備、計器等の内の1つ以上を含み得る。積載物は筐体内部に備え付けられることがある。筐体は可動物体の筐体とは別個であることもあれば、可動物体の筐体の一部分であることもある。逆に、積載物は筐体と共に備えつけられることがあり、その場合可動物体は筐体を有さない。また、積載物の一部分または積載物全体は筐体なしで提供できる。積載物は、可動物体に対してしっかりと固定できる。また、積載物は、可動物体に対して可動(例えば、可動物体に対して並進可能または回転可能)であり得る。積載物は、本明細書の他の箇所で説明するように、搭載物または支持機構の少なくとも一方を含み得る。   In some embodiments, the movable object can be configured to carry a load. A load may include one or more of passengers, cargo, equipment, instruments, and the like. The load may be provided inside the housing. The housing may be separate from the housing of the movable object or may be a part of the housing of the movable object. Conversely, a load may be provided with a housing, in which case the movable object does not have a housing. Also, a part of the load or the entire load can be provided without a housing. The load can be firmly fixed to the movable object. Also, the load can be movable relative to the movable object (eg, translatable or rotatable relative to the movable object). The load can include at least one of a load or a support mechanism, as described elsewhere herein.

ある実施形態において、端末は、可動物体、支持機構、及び、搭載物の固定基準フレーム(例えば、周囲環境)に対する移動と、互いに対する移動のいずれか、または両方を制御できる。端末は、可動物体、支持機構、搭載物の少なくとも1つから離れた場所にあるリモートコントロール装置であり得る。端末は、支持プラットフォームに置いてもよく、取り付けてもよい。あるいは、端末は、ハンドヘルドまたはウェアラブルな装置でよい。例えば、端末は、スマートフォン、タブレット、ラップトップ、コンピュータ、眼鏡、手袋、ヘルメット、マイクロホン、または、それらの適切な組み合わせであり得る。端末は、キーボード、マウス、ジョイスティック、タッチスクリーン、または、ディスプレー等のユーザーインターフェースを備え得る。手動入力命令、音声制御、ジェスチャー制御、または、(例えば、端末の移動、場所、または、傾きを介した)位置制御等、任意の適切なユーザー入力を用いて、端末と相互作用できる。   In certain embodiments, the terminal can control the movement of the movable object, the support mechanism, and the load relative to a fixed reference frame (eg, the surrounding environment) and / or both relative to each other. The terminal may be a remote control device at a location remote from at least one of the movable object, the support mechanism, and the load. The terminal may be placed on or attached to a support platform. Alternatively, the terminal may be a handheld or wearable device. For example, the terminal can be a smartphone, tablet, laptop, computer, glasses, gloves, helmet, microphone, or a suitable combination thereof. The terminal may include a user interface such as a keyboard, mouse, joystick, touch screen, or display. Any suitable user input can be used to interact with the terminal, such as manual input commands, voice control, gesture control, or position control (eg, via terminal movement, location, or tilt).

端末を用いて、可動物体、支持機構、搭載物の1つ以上の任意の適切な状態を制御できる。例えば、端末を用いて、固定基準と互い、の少なくとも1つに対して、可動物体、支持機構、搭載物の1つ以上の、位置と向きのいずれかまたは両方を制御し得る。ある実施形態において、端末を用いて、支持機構の作動アッセンブリ、搭載物のセンサ、または、搭載物のエミッタ等、可動物体、支持機構、搭載物の1つ以上の個々の要素を制御できる。端末は、可動物体、支持機構、または、搭載物の少なくとも1つと通信するように適合された無線通信装置を含み得る。   The terminal can be used to control any suitable state of one or more of the movable object, the support mechanism, and the load. For example, the terminal may be used to control either or both the position and orientation of one or more of the movable object, the support mechanism, and the load with respect to at least one of the fixed reference and each other. In some embodiments, the terminal can be used to control one or more individual elements of the movable object, the support mechanism, the load, such as a support mechanism actuation assembly, a load sensor, or a load emitter. The terminal may include a wireless communication device adapted to communicate with at least one of a movable object, a support mechanism, or a load.

端末は、可動物体、支持機構、搭載物、の1つ以上の情報を見るための適切な表示ユニットを備え得る。例えば、端末は、位置、並進速度、並進加速度、向き、角速度、角加速度、または、それらの任意の適切な組み合わせに関して、可動物体、支持機構、搭載物、の1つ以上の情報を表示できる。ある実施形態において、端末は、機能的な搭載物によって提供されたデータ等(例えば、カメラまたは他の撮像装置によって記録された画像)、搭載物によって提供された情報を表示できる。   The terminal may comprise a suitable display unit for viewing one or more information of a movable object, a support mechanism, a load. For example, the terminal can display one or more information of a movable object, a support mechanism, a load regarding position, translation speed, translation acceleration, orientation, angular velocity, angular acceleration, or any suitable combination thereof. In some embodiments, the terminal can display information provided by the load, such as data provided by the functional load (eg, an image recorded by a camera or other imaging device).

また、同じ端末で、可動物体、支持機構、搭載物、の少なくとも1つ、または、可動物体、支持機構、搭載物、の1つ以上の状態の制御と、可動物体、支持機構、搭載物、の少なくとも1つからの情報の受信と表示の少なくとも1つと、の両方を行ってもよい。例えば、端末は、搭載物によって捕捉された画像データ、または、搭載物の位置に関する情報を表示しながら、環境に対する搭載物の位置決めを制御してよい。あるいは、異なる端末を異なる機能に対して用いてよい。例えば、第1の端末が、可動物体、支持機構、搭載物、の1つ以上の移動または状態を制御する一方、第2の端末が、可動物体、支持機構、搭載物、の少なくとも1つ情報を受信、表示のいずれか、または両方を行う。例えば、第1の端末を用いて、環境に対する搭載物の位置決めを制御してよく、一方、第2の端末は、搭載物によって捕捉された画像データを表示する。可動物体と、可動物体の制御とデータの受信の両方を行う統合端末との間、または、可動物体と、可動物体の制御とデータの受信の両方を行う複数の端末との間で、様々な通信モードを利用し得る。例えば、少なくとも2つの異なる通信モードを、可動物体の制御と可動物体からのデータ受信の両方を行う端末と、可動物体との間に形成してよい。   In addition, at the same terminal, at least one of a movable object, a support mechanism, and a load, or control of one or more states of the movable object, the support mechanism, and the load, and the movable object, the support mechanism, the load, Both at least one of receiving and displaying information from at least one of them may be performed. For example, the terminal may control the positioning of the load with respect to the environment while displaying image data captured by the load or information regarding the position of the load. Alternatively, different terminals may be used for different functions. For example, the first terminal controls one or more movements or states of the movable object, the support mechanism, and the mounted object, while the second terminal has information on at least one of the movable object, the support mechanism, and the mounted object. Receive, display, or both. For example, a first terminal may be used to control the positioning of the load with respect to the environment, while the second terminal displays image data captured by the load. Various between a movable object and an integrated terminal that controls both the movable object and receives data, or between a movable object and multiple terminals that both control the movable object and receive data A communication mode can be used. For example, at least two different communication modes may be formed between a movable object and a terminal that performs both control of the movable object and data reception from the movable object.

図10には、支持機構1002および搭載物1004を備える可動物体1000が、本発明の実施形態に従って示されている。可動物体1000は、航空機として示されているが、この図は、制限を意図するものではなく、本明細書に記載した任意の適切なタイプの可動物体を用いてよい。航空機システムの文脈で本明細書に記載した実施形態はいずれも、任意の適切な可動物体(例えば、UAV)に適用可能なことを当業者は理解されよう。また、支持機構1002を使用せず、可動物体1000上に搭載物1004を設けてもよい。可動物体1000は、推進機構1006、検出システム1008、及び、通信システム1010を備え得る。   In FIG. 10, a movable object 1000 comprising a support mechanism 1002 and a load 1004 is shown according to an embodiment of the present invention. Although the movable object 1000 is shown as an aircraft, this figure is not intended to be limiting and any suitable type of movable object described herein may be used. Those skilled in the art will appreciate that any of the embodiments described herein in the context of an aircraft system can be applied to any suitable movable object (eg, UAV). Further, the mounted object 1004 may be provided on the movable object 1000 without using the support mechanism 1002. The movable object 1000 may include a propulsion mechanism 1006, a detection system 1008, and a communication system 1010.

推進機構1006は、上述したように、回転翼、プロペラ、ブレード、エンジン、モーター、車輪、車軸、磁石、または、ノズルの少なくとも1つを備え得る。例えば、推進機構1006は、上述したように、回転翼アッセンブリまた他の回転推進ユニットでよい。可動物体は、少なくとも1つ、2つ以上、3つ以上、または、4つ以上の推進機構を有し得る。1つ以上の推進機構は、全て、同じタイプでもよいが、それぞれ異なるタイプの推進機構でもよい。推進機構1006は、上述したように、支持要素(例えば、駆動軸)等の任意の適切な手段を用いて可動物体1000に取り付け可能である。推進機構1006は、可動物体1000の、上部、底部、前部、後部、側部、または、それらの適切な組み合わせ等、任意の適切な部分に取り付け可能である。   As described above, the propulsion mechanism 1006 may include at least one of a rotor blade, a propeller, a blade, an engine, a motor, a wheel, an axle, a magnet, or a nozzle. For example, the propulsion mechanism 1006 may be a rotary blade assembly or other rotary propulsion unit as described above. The movable object may have at least one, two or more, three or more, or four or more propulsion mechanisms. The one or more propulsion mechanisms may all be the same type, but may be different types of propulsion mechanisms. The propulsion mechanism 1006 can be attached to the movable object 1000 using any suitable means such as a support element (eg, drive shaft) as described above. The propulsion mechanism 1006 can be attached to any suitable part of the movable object 1000, such as the top, bottom, front, back, side, or any suitable combination thereof.

ある実施形態において、推進機構1006は、可動物体1000が、その水平方向に動作せずに(例えば、滑走路を進むことなく)、表面から垂直に離陸、または、表面に垂直に着陸することを可能にする。また、推進機構1006は、可動物体1000が空中の特定の位置と向きの少なくとも1つでホバリングし得る。推進機構100の少なくとも1つを、他の推進機構と独立して制御し得るが、それぞれ同時に制御することも可能である。例えば、可動物体1000は、揚力と推力の少なくとも1つを可動物体に与える複数の水平方向に向いた回転翼を有し得る。複数の水平方向に向いた回転翼を作動させて、垂直方向の離着陸能力、及び、ホバリング能力を可動物体1000に与え得る。また、水平方向に向いた回転翼の少なくとも1つは、時計回りに、あるいは、反時計回りに回転し得る。例えば、時計回りの回転翼の数を、反時計回りの回転翼の数と等しくてよい。水平方向に向いた各回転翼の回転速度はそれぞれ独立して変更すると、各回転翼が提供する揚力と推力の少なくとも1つを制御できる。それによって、(例えば、3以下の並進度と3以下の回転度に関して)可動物体1000の空間的配置、速度、加速度、の少なくとも1つを調整する。 In some embodiments, the propulsion mechanism 1006 allows the movable object 1000 to take off from or land vertically on the surface without moving in its horizontal direction (e.g., not traveling on the runway). enable. Further, the propulsion mechanism 1006 can hover the movable object 1000 at at least one of a specific position and orientation in the air. At least one propulsion mechanism 100 6, but may be controlled independently of the other propulsion mechanism, it is possible to simultaneously control, respectively. For example, the movable object 1000 may have a plurality of horizontally oriented rotor blades that impart at least one of lift and thrust to the movable object. A plurality of horizontally oriented rotors may be activated to provide the movable object 1000 with vertical takeoff and landing capability and hovering capability. Also, at least one of the horizontally oriented rotor blades can rotate clockwise or counterclockwise. For example, the number of clockwise rotating blades may be equal to the number of counterclockwise rotating blades. When the rotational speed of each rotor blade directed in the horizontal direction is changed independently, at least one of lift and thrust provided by each rotor blade can be controlled. Thereby, at least one of the spatial arrangement, speed, and acceleration of the movable object 1000 is adjusted (for example, with respect to a translation degree of 3 or less and a rotation degree of 3 or less).

検出システム1008は、(例えば、3以下の並進度と3以下の回転度に関して)可動物体1000の空間的配置、速度、加速度の少なくとも1つを検出し得る1つ以上のセンサを備え得る。1つ以上のセンサは、全地球測位システム(GPS)センサ、モーションセンサ、慣性センサ、近接センサ、または、画像センサを含み得る。検出システム1008が提供する検出データを用いて、(例えば、以下に記載のように、適切な処理ユニットと制御モジュールの少なくとも1つを用いて)可動物体1000の空間的配置、速度、向き、の少なくとも1つを制御できる。あるいは、検出システム1008を用いて、天候条件、潜在的障害物への近接性、地理的特徴のある場所、人工的構造物の場所等、可動物体の周囲環境に関するデータを提供できる。   The detection system 1008 can comprise one or more sensors that can detect at least one of the spatial arrangement, velocity, and acceleration of the movable object 1000 (eg, with respect to a translation degree of 3 or less and a degree of rotation of 3 or less). The one or more sensors may include a global positioning system (GPS) sensor, a motion sensor, an inertial sensor, a proximity sensor, or an image sensor. Using the detection data provided by the detection system 1008, the spatial arrangement, speed, and orientation of the movable object 1000 (eg, using at least one of a suitable processing unit and control module, as described below) At least one can be controlled. Alternatively, the detection system 1008 can be used to provide data regarding the surrounding environment of the movable object, such as weather conditions, proximity to potential obstacles, geographical features, locations of artificial structures, and the like.

通信システム1010は、無線信号1016を介して通信システム1014を有する端末1012と通信を可能にする。通信システム1010、1014は、無線通信に適した任意の数の送信機、受信機、送受信機の少なくとも1つを備え得る。通信は、データを一方向にのみ送信可能な片方向通信でよい。例えば、片方向通信は、可動物体1000がデータを端末1012に送信することのみを実行してよく、逆もまた同様である。また、通信システム1010の1つ以上の送信機から通信システム101の1つ以上の受信機にデータを送信してよく、逆もまた同様である。あるいは、通信は、データが可動物体1000と端末1012との間で両方向に送信できる双方向通信でもよい。双方向通信は、通信システム1010の1つ以上の送信機から通信システム1014の1つ以上の受信機にデータを送信してよく、逆もまた同様である。 The communication system 1010 enables communication with a terminal 1012 having a communication system 1014 via a radio signal 1016. The communication systems 1010, 1014 may comprise any number of transmitters, receivers, transceivers suitable for wireless communication. The communication may be one-way communication capable of transmitting data only in one direction. For example, one-way communication may only be performed by the movable object 1000 transmitting data to the terminal 1012 and vice versa. Also, it may send data to one or more receivers from one or more transmitters of the communication system 101 4 of the communication system 1010, and vice versa. Alternatively, the communication may be bidirectional communication in which data can be transmitted in both directions between the movable object 1000 and the terminal 1012. Bidirectional communication may transmit data from one or more transmitters of the communication system 1010 to one or more receivers of the communication system 1014, and vice versa.

ある実施形態では、端末1012は、可動物体1000、支持機構1002、及び、搭載物1004の少なくとも1つに制御データを提供する。そして、端末1012は、可動物体1000、支持機構1002、及び、搭載物1004の少なくとも1つから情報(例えば、可動物体、支持機構、または、搭載物の位置と動作の情報の少なくとも1つ、搭載物カメラによって撮影された画像データ等、搭載物によって検出されたデータ)を受信できる。また、端末からの制御データは、可動物体、支持機構、搭載物、の1つ以上の相対的な位置、移動、作動、または、制御に関する命令を含んでよい。例えば、制御データによって、(例えば、推進機構1006の制御を介して)可動物体の場所と向きの1つ以上
の修正を行い得る。また、(例えば、支持機構1002の制御を介して)可動物体に対し
て搭載物を移動させてもよい。また、端末からの制御データによって、カメラまたは他の撮像装置の操作の制御等、搭載物を制御し得る(例えば、静止画または動画を撮る、ズームインまたはズームアウトする、電源のオンまたはオフ、画像モードを切り替える、画像の解像度を変更する、フォーカスを変更する、被写界深度を変更する、露光時間を変更する、視野角または視野を変更する)。また、可動物体、支持機構、搭載物、の少なくとも1つからの通信は、(例えば、検出システム108または搭載物1004の)1つ以上のセンサからの情報を含んでよい。通信は、1つ以上の異なるタイプのセンサ(例えば、GPSセンサ、モーションセンサ、慣性センサ、近接センサ、または、画像センサ)からの検出した情報を含み得る。このような情報は、可動物体、支持機構、搭載物、の1つ以上の位置(例えば、場所または向き)、移動、または、加速度に関連し得る。搭載物からのこのような情報は、搭載物によって取得されたデータ、または搭載物の検出された状態を含み得る。端末1012から送信された制御データによって、可動物体1000、支持機構1002、または、搭載物1004の1つ以上の状態を制御できる。また、支持機構1002及び搭載物1004は、それぞれ、端末1012と通信する通信モジュールも備え得る。端末は、可動物体1000、支持機構1002、及び、搭載物1004のそれぞれと独立して通信し、それらを制御できる。
In some embodiments, the terminal 1012 provides control data to at least one of the movable object 1000, the support mechanism 1002, and the load 1004. The terminal 1012 receives information from at least one of the movable object 1000, the support mechanism 1002, and the mounted object 1004 (for example, at least one of information on the position and operation of the movable object, the support mechanism, or the mounted object). Data detected by the mounted object such as image data photographed by the object camera). Also, the control data from the terminal may include one or more relative positions, movements, actuations, or control instructions for the movable object, the support mechanism, and the load. For example, one or more corrections of the location and orientation of the movable object may be made by control data (eg, via control of the propulsion mechanism 1006). Further, the mounted object may be moved with respect to the movable object (for example, through the control of the support mechanism 1002). In addition, the mounted data can be controlled by the control data from the terminal, such as control of the operation of the camera or other imaging device (for example, taking a still image or a movie, zooming in or out, turning the power on or off, image Switch modes, change image resolution, change focus, change depth of field, change exposure time, change viewing angle or field of view). Also, communication from at least one of the movable object, the support mechanism, and the load may include information from one or more sensors (eg, detection system 1 0 08 or load 1004). The communication may include detected information from one or more different types of sensors (eg, GPS sensors, motion sensors, inertial sensors, proximity sensors, or image sensors). Such information may relate to one or more positions (eg, location or orientation), movement, or acceleration of the movable object, support mechanism, load. Such information from the load may include data acquired by the load or detected state of the load. One or more states of the movable object 1000, the support mechanism 1002, or the mounted object 1004 can be controlled by the control data transmitted from the terminal 1012. In addition, the support mechanism 1002 and the mounted object 1004 may each include a communication module that communicates with the terminal 1012. The terminal can independently communicate with and control the movable object 1000, the support mechanism 1002, and the mounted object 1004.

ある実施形態では、可動物体1000は、端末1012に加えて、または、端末1012の代わりに、別のリモート装置と通信することもできる。端末1012も、また、別のリモート装置、及び、可動物体1000と通信できる。例えば、可動物体1000と端末1012にいずれか、または両方は、別の可動物体、別の可動物体の支持機構または搭載物と通信可能である。必要に応じて、リモート装置は、第2の端末または他のコンピュータ装置(例えば、コンピュータ、ラップトップ、タブレット、スマートフォン、または、他のモバイル装置)であり得る。リモート装置は、可動物体1000にデータを送信、可動物体1000からデータを受信、端末1012にデータを送信、及び、端末1012からデータを受信、の少なくとも1つを行い得る。また、リモート装置は、インターネットまたは他の電気通信ネットワークに接続できる。よって、可動物体1000と端末1012の少なくとも1つから受信したデータをウェブサイトまたはサーバーにアップロードできる。   In some embodiments, the movable object 1000 can communicate with another remote device in addition to or in place of the terminal 1012. Terminal 1012 can also communicate with another remote device and movable object 1000. For example, either or both of the movable object 1000 and the terminal 1012 can communicate with another movable object, another movable object support mechanism or a load. If desired, the remote device can be a second terminal or other computing device (eg, a computer, laptop, tablet, smartphone, or other mobile device). The remote device may perform at least one of transmitting data to the movable object 1000, receiving data from the movable object 1000, transmitting data to the terminal 1012, and receiving data from the terminal 1012. The remote device can also be connected to the Internet or other telecommunications network. Therefore, data received from at least one of the movable object 1000 and the terminal 1012 can be uploaded to a website or a server.

図11には、本発明を適用した、可動物体を制御するシステム1100の概略ブロック図が示されている。システム1100は、本明細書に開示のシステム、装置、及び、方法の任意の適切な実施形態と組み合わせて用い得る。システム1100は、検出モジュール1102、処理ユニット1104、非一時的コンピュータ可読媒体110、制御モジュール1108、及び、通信モジュール1110を備え得る。 FIG. 11 is a schematic block diagram of a system 1100 for controlling a movable object to which the present invention is applied. System 1100 may be used in combination with any suitable embodiment of the systems, devices, and methods disclosed herein. System 1100 can include a detection module 1102, a processing unit 1104, a non-transitory computer readable medium 110 6 , a control module 1108, and a communication module 1110.

検出モジュール1102は、異なる方法で可動物体に関する情報を収集する異なるタイプのセンサを利用できる。異なるタイプのセンサは、異なるタイプの信号、または、異なるソースからの信号を検出し得る。例えば、センサは、慣性センサ、GPSセンサ、近接センサ(例えば、ライダー)、または、視覚及び画像センサ(例えば、カメラ)を含み得る。検出モジュール1102は、複数のプロセッサを有する処理ユニット1104に動作可能に接続できる。ある実施形態において、検出モジュールは、適切な外部装置またはシステムに検出データを直接送信する送信モジュール1112(例えば、Wi―Fi画像送信モジュール)に動作可能に接続できる。例えば、送信モジュール1112を用いて、検出モジュール1102のカメラによって撮影された画像をリモート端末に送信できる。 The detection module 1102 can utilize different types of sensors that collect information about moving objects in different ways. Different types of sensors may detect different types of signals or signals from different sources. For example, the sensors may include inertial sensors, GPS sensors, proximity sensors (eg, riders), or visual and image sensors (eg, cameras). The detection module 1102 can be operatively connected to a processing unit 1104 having a plurality of processors. In certain embodiments, the detection module can be operatively connected to a transmission module 1112 (eg, a Wi-Fi image transmission module) that transmits detection data directly to a suitable external device or system. For example, an image captured by the camera of the detection module 1102 can be transmitted to the remote terminal using the transmission module 1112.

処理ユニット1104は、プログラム可能プロセッサ(例えば、中央処理ユニット(CPU))等、1つ以上のプロセッサを有し得る。処理ユニット1104は、非一時的コンピュータ可読媒体1106に動作可能に接続できる。非一時的コンピュータ可読媒体1106は、1つ以上のステップを行うために処理ユニット1104によって実行可能なロジック、コード、プログラム命令、の少なくとも1つを記憶できる。非一時的コンピュータ可読媒体は、1つ以上のメモリユニット(例えば、SDカードもしくはランダムアクセスメモリ(RAM)等の取り外し可能媒体または外部記憶装置)を含み得る。また、検出モジュール1102からのデータは、非一時的コンピュータ可読媒体1106のメモリユニットに、直接、伝達し記憶できる。非一時的コンピュータ可読媒体1106のメモリユニットは、処理ユニット1104によって実行可能なロジック、コード、プログラム命令、の少なくとも1つを記憶でき、本明細書に記載の方法の任意の適切な実施形態を実行できる。例えば、処理ユニット1104は、検出モジュールが生成した検出データを、処理ユニット1104の1つ以上のプロセッサが分析するように命令できる。メモリユニットは、処理ユニット1104が処理すべき検出モジュールからの検出データを記憶できる。また、非一時的コンピュータ可読媒体1106のメモリユニットを用いて、処理ユニット1104が生成する処理結果を記憶することもできる。   The processing unit 1104 may have one or more processors, such as a programmable processor (eg, a central processing unit (CPU)). The processing unit 1104 can be operatively connected to a non-transitory computer readable medium 1106. Non-transitory computer readable media 1106 may store at least one of logic, code, program instructions executable by processing unit 1104 to perform one or more steps. Non-transitory computer readable media may include one or more memory units (eg, removable media such as SD card or random access memory (RAM) or external storage). Also, data from the detection module 1102 can be transmitted and stored directly in a memory unit of the non-transitory computer readable medium 1106. The memory unit of the non-transitory computer readable medium 1106 can store at least one of logic, code, program instructions executable by the processing unit 1104, and performs any suitable embodiment of the methods described herein. it can. For example, the processing unit 1104 can instruct the detection data generated by the detection module to be analyzed by one or more processors of the processing unit 1104. The memory unit can store detection data from the detection module to be processed by the processing unit 1104. Further, the processing result generated by the processing unit 1104 can be stored using the memory unit of the non-transitory computer-readable medium 1106.

ある実施形態では、処理ユニット1104は、可動物体の状態を制御する制御モジュール1108に動作可能に接続できる。例えば、制御モジュール1108は、6自由度に関して、可動物体の空間的配置、速度、加速度、の少なくとも1つを調整するように可動物体の推進機構を制御し得る。また、制御モジュール1108は、支持機構、搭載物、または、検出モジュールの状態の少なくとも1つを制御することも可能である。   In some embodiments, the processing unit 1104 can be operatively connected to a control module 1108 that controls the state of the movable object. For example, the control module 1108 may control the propulsion mechanism of the movable object to adjust at least one of the spatial arrangement, speed, and acceleration of the movable object for six degrees of freedom. The control module 1108 can also control at least one of the state of the support mechanism, the load, or the detection module.

処理ユニット1104は、通信モジュール1110に動作可能に接続できる。通信モジュール1110は、1つ以上の外部装置(例えば、端末、ディスプレー装置、または、他のリモートコントローラ)にデータを送信、その外部装置からデータを受信、のいずれか、または両方を行う。有線通信または無線通信等、任意の適切な通信手段を用い得る。例えば、通信モジュール1110は、ローカルエリアネットワーク(LAN)、広域ネットワーク(WAN)、赤外線、無線、WiFi、ポイントツーポイント(P2P)ネットワーク、電気通信ネットワーク、クラウド通信等の少なくとも1つを利用できる。また、タワー、衛星、または、移動局等の中継局を用い得る。無線通信は、近接性に依存することも、無関係であることもあり得る。また、通信のために見通し線が必要な場合も、必要でない場合もある。通信モジュール1110は、処理ユニット1104が生成した処理結果、所定の制御データ、端末もしくはリモートコントローラからのユーザー命令等の少なくとも1つを送信、受信、のいずれかあるいは両方を行い得る。 The processing unit 1104 can be operatively connected to the communication module 1110. The communication module 1110 transmits data to and / or receives data from one or more external devices (eg, a terminal, a display device, or other remote controller). Any suitable communication means such as wired communication or wireless communication can be used. For example, the communication module 1110 can use at least one of a local area network (LAN), wide area network (WAN), infrared, wireless, WiFi, point-to-point (P2P) network, telecommunication network, cloud communication, and the like. A relay station such as a tower, a satellite, or a mobile station may be used. Wireless communication can depend on proximity or be irrelevant. In addition, a line of sight may or may not be necessary for communication. Communication module 1110, processing unit 1104 generates the processing result, a predetermined control data, transmitting at least one of the user instruction or the like from a terminal or a remote controller, receiving, may do one or both.

システム1100の部品は、任意の適切な構成で配置できる。例えば、システム1100の部品の少なくとも1つは、可動物体、支持機構、搭載物、端末、検出システム、または、上述した少なくとも1つと通信する追加の外部装置に置いてよい。また、図11には、1つの処理ユニット1104と1つの非一時的コンピュータ可読媒体1106が示されているが、これは本発明の実施形態の制限を意図していない。当業者は、システム1100が、複数の処理ユニットと非一時的コンピュータ可読媒体の少なくとも1つを備えてよいことを理解するであろう。ある実施形態において、複数の処理ユニットと非一時的コンピュータ可読媒体の少なくとも1つは、可動物体、支持機構、搭載物、端末、検出モジュール、上記した少なくとも1つと通信する追加の外部装置、または、それらの適切な組み合わせ等、異なる場所に配置できる。よって、システム1100によって行われる処理、またはメモリ機能の少なくとも一方の任意の適切な実施形態は、上記した場所の少なくとも1つで実行され得る。   The components of system 1100 can be arranged in any suitable configuration. For example, at least one of the components of system 1100 may be located on a movable object, a support mechanism, a load, a terminal, a detection system, or an additional external device that communicates with at least one of the above. Also shown in FIG. 11 is one processing unit 1104 and one non-transitory computer readable medium 1106, which is not intended to limit the embodiments of the present invention. One skilled in the art will appreciate that the system 1100 may comprise at least one of a plurality of processing units and a non-transitory computer readable medium. In some embodiments, at least one of the plurality of processing units and the non-transitory computer readable medium is a movable object, a support mechanism, a load, a terminal, a detection module, an additional external device in communication with at least one of the above, or They can be placed in different places, such as their appropriate combinations. Thus, any suitable embodiment of processing performed by system 1100, or at least one of memory functions, may be performed at at least one of the locations described above.

本発明の好ましい実施形態を、本明細書に図示し説明したが、このような実施形態は、例示のみを目的としていることは当業者には明らかであろう。本発明を逸脱することなく、多くの変形実施形態、変更、代替形態を当業者は着想するであろう。本発明を実施するにあたり、本明細書に記載した発明の実施形態の様々な代替形態を採用し得ることを理解されたい。請求項は発明の範囲を規定し、請求項の範囲内の方法及び構造、並びに、それらの均等物が、本発明の範囲に含まれるものとする。
While preferred embodiments of the present invention have been illustrated and described herein, it will be apparent to those skilled in the art that such embodiments are for illustrative purposes only. Many variations, modifications, and alternatives will occur to those skilled in the art without departing from the invention. It should be understood that various alternatives to the embodiments of the invention described herein may be employed in practicing the present invention. The claims define the scope of the invention, and the methods and structures within the scope of the claims and their equivalents are intended to be included within the scope of the present invention.

Claims (15)

航空機の姿勢を制御する方法であって、
(a)前記航空機の1つ以上の推進ユニットの推力と前記推進ユニットに動作可能に接続された前記航空機のアクチュエータの出力との間の非線形関係を評価するステップと、
(b)前記航空機の目標姿勢を示す信号を受信するステップと、
(c)少なくとも1つの前記アクチュエータに送達されるコマンド信号を、前記目標姿勢を示す信号および前記非線形関係に基づき、かつ角加速度フィードバックを有する角加速度ループを含むフィードバック制御方式を使用して、生成するステップと、
(d)前記1つ以上の推進ユニットの作動に起因する前記航空機の動態を測定するステップと、
(e)前記動態を利用して、前記コマンド信号を調節する前記フィードバック制御方式をもたらすステップと、を含む、方法。
A method for controlling the attitude of an aircraft,
(A) evaluating a non-linear relationship between the thrust of one or more propulsion units of the aircraft and the output of actuators of the aircraft operably connected to the propulsion units;
(B) receiving a signal indicating a target attitude of the aircraft;
(C) generating a command signal delivered to at least one of the actuators using a feedback control scheme based on the signal indicating the target attitude and the nonlinear relationship and including an angular acceleration loop having angular acceleration feedback; Steps,
(D) measuring dynamics of the aircraft due to operation of the one or more propulsion units;
(E) utilizing the dynamics to provide the feedback control scheme for adjusting the command signal.
前記航空機が無人航空機である、請求項1に記載の方法。   The method of claim 1, wherein the aircraft is an unmanned aerial vehicle. 前記航空機が、複数の推進ユニットに接続された複数のアクチュエータを含み、前記推進ユニットが、前記航空機の揚力を生成する回転翼を含む、請求項1又は2に記載の方法。   The method according to claim 1, wherein the aircraft includes a plurality of actuators connected to a plurality of propulsion units, and the propulsion unit includes a rotor wing that generates lift of the aircraft. 前記航空機の前記目標姿勢を示す信号が、無線接続により遠隔の制御器から受信される、請求項1乃至3の何れか1項に記載の方法。   4. A method according to any one of the preceding claims, wherein a signal indicative of the target attitude of the aircraft is received from a remote controller over a wireless connection. 前記非線形関係がユーザーによって入力される、請求項1乃至4の何れか1項に記載の方法。   The method according to claim 1, wherein the non-linear relationship is input by a user. 前記非線形関係が、前記航空機の1つ以上のアクチュエータの較正中に計算される、請求項1乃至4の何れか1項に記載の方法。   5. A method according to any one of the preceding claims, wherein the non-linear relationship is calculated during calibration of one or more actuators of the aircraft. 前記航空機の1つ以上の物理的特性に基づいて前記航空機の空力中心および重心を計算するステップを更に含む、請求項1乃至6の何れか1項に記載の方法。   The method of any one of claims 1 to 6, further comprising calculating an aerodynamic center and center of gravity of the aircraft based on one or more physical characteristics of the aircraft. 前記航空機の前記物理的特性に基づいて前記航空機の慣性モーメントを計算するステップを更に含む、請求項7に記載の方法。   The method of claim 7, further comprising calculating a moment of inertia of the aircraft based on the physical characteristics of the aircraft. 前記フィードバック制御方式を使用する前記計算が、前記航空機の前記慣性モーメントを使用するフィードフォワード計算を含む、請求項8に記載の方法。 The method of claim 8, wherein the calculation using the feedback control scheme comprises a feed forward calculation using the moment of inertia of the aircraft. 航空機の姿勢を制御するための方法であって、
(a)前記航空機の目標姿勢を示す信号をプロセッサで受信するステップと、
(b)前記航空機の1つ以上の推進ユニットに動作可能に接続された前記航空機の少なくとも1つのアクチュエータに送達されるコマンド信号を、前記プロセッサを用いて、前記目標姿勢を示す信号に基づき、かつ(1)角加速度フィードバックを有する角加速度ループと、(2)目標加速度に基づく直接フィードフォワード計算と、を含むフィードバック制御方式を使用して、生成するステップと、
(c)前記1つ以上の推進ユニットの作動に起因する前記航空機の動態を、前記航空機に動作可能に接続された1つ以上のセンサを用いて測定するステップと、
(d)前記動態を前記プロセッサに供給して、前記コマンド信号を調節する前記フィードバック制御方式をもたらすステップと、を含む、方法。
A method for controlling the attitude of an aircraft,
(A) receiving a signal indicating a target attitude of the aircraft by a processor;
(B) using a command signal delivered to at least one actuator of the aircraft operatively connected to one or more propulsion units of the aircraft based on the signal indicative of the target attitude; and Generating using a feedback control scheme comprising: (1) an angular acceleration loop with angular acceleration feedback; and (2) a direct feedforward calculation based on a target angular acceleration;
(C) measuring the aircraft dynamics resulting from operation of the one or more propulsion units using one or more sensors operably connected to the aircraft;
(D) providing the dynamics to the processor to provide the feedback control scheme for adjusting the command signal.
前記航空機が、無人航空機であり、かつ複数の推進ユニットに動作可能に接続された複数のアクチュエータを含み、前記推進ユニットが、前記航空機の揚力を生成する回転翼を含む、請求項10に記載の方法。   11. The aircraft of claim 10, wherein the aircraft is an unmanned aerial vehicle and includes a plurality of actuators operably connected to a plurality of propulsion units, the propulsion unit including a rotor blade that generates lift of the aircraft. Method. 前記航空機の1つ以上の物理的特性に基づいて前記航空機の空力中心および重心を計算するステップを更に含む、請求項10に記載の方法。   The method of claim 10, further comprising calculating an aerodynamic center and center of gravity of the aircraft based on one or more physical characteristics of the aircraft. 前記航空機の前記物理的特性に基づいて前記航空機の慣性モーメントを計算するステップを更に含み、前記フィードフォワード計算が前記航空機の前記慣性モーメントを使用する、請求項12に記載の方法。   The method of claim 12, further comprising calculating a moment of inertia of the aircraft based on the physical characteristics of the aircraft, wherein the feedforward calculation uses the moment of inertia of the aircraft. 前記フィードバック制御方式を使用する前記計算が、ピッチ軸、ロール軸、およびヨー軸を中心とした航空機姿勢に対して行われ、かつミキサを使用して、前記ピッチ軸、ロール軸、およびヨー軸についての前記計算の結果と、航空機構成パラメータとを組み合わせて、前記少なくとも1つのアクチュエータに送達される前記コマンド信号を計算するステップを更に含む、請求項10に記載の方法。   The calculation using the feedback control scheme is performed on an aircraft attitude centered on the pitch axis, roll axis, and yaw axis, and using a mixer, for the pitch axis, roll axis, and yaw axis The method of claim 10, further comprising: combining the result of the calculation of and an aircraft configuration parameter to calculate the command signal delivered to the at least one actuator. 前記航空機の前記動態が、少なくとも1つの軸に対する前記航空機の前記姿勢、および前記少なくとも1つの軸に対する前記角加速度を含む、請求項10に記載の方法。 The method of claim 10, wherein the dynamics of the aircraft include the attitude of the aircraft with respect to at least one axis and the angular acceleration with respect to the at least one axis.
JP2017169966A 2017-09-05 2017-09-05 Aircraft attitude control method Expired - Fee Related JP6585673B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017169966A JP6585673B2 (en) 2017-09-05 2017-09-05 Aircraft attitude control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017169966A JP6585673B2 (en) 2017-09-05 2017-09-05 Aircraft attitude control method

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2016539035A Division JP6207746B2 (en) 2014-05-30 2014-05-30 Aircraft attitude control method and apparatus

Publications (2)

Publication Number Publication Date
JP2018010671A JP2018010671A (en) 2018-01-18
JP6585673B2 true JP6585673B2 (en) 2019-10-02

Family

ID=60993827

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017169966A Expired - Fee Related JP6585673B2 (en) 2017-09-05 2017-09-05 Aircraft attitude control method

Country Status (1)

Country Link
JP (1) JP6585673B2 (en)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108469728B (en) * 2018-03-28 2022-09-30 山东理工大学 Decoupling control method for airborne LiDAR attitude angle compensation device
US10775784B2 (en) * 2018-06-14 2020-09-15 Wing Aviation Llc Unmanned aerial vehicle with decentralized control system
WO2021024591A1 (en) * 2019-08-02 2021-02-11 パナソニックIpマネジメント株式会社 Motor control device, moving body, motor control method, and program
JP6934116B1 (en) * 2019-11-05 2021-09-08 楽天グループ株式会社 Control device and control method for controlling the flight of an aircraft
CN111413994B (en) * 2020-03-13 2023-08-08 浙江树人学院(浙江树人大学) Direct self-adaptive fuzzy control method for four-rotor unmanned aerial vehicle
CN112326117B (en) * 2020-10-23 2022-07-05 北京控制工程研究所 CMG-based spacecraft inertia on-orbit identification method
WO2022141311A1 (en) * 2020-12-30 2022-07-07 深圳市大疆创新科技有限公司 Unmanned aerial vehicle control method and apparatus, unmanned aerial vehicle, terminal, system and storage medium
CN114355959B (en) * 2021-10-08 2024-04-19 湖北隆感科技有限公司 Attitude output feedback control method, device, medium and equipment for aerial robot
CN113848963B (en) * 2021-11-29 2023-11-28 中国航空工业集团公司沈阳飞机设计研究所 Control law parameter design method of flight control system
CN114578838B (en) * 2022-03-01 2022-09-16 哈尔滨逐宇航天科技有限责任公司 Reinforced learning active disturbance rejection attitude control method suitable for aircrafts of various configurations
CN115556111B (en) * 2022-10-26 2023-08-18 哈尔滨工业大学 Flight mechanical arm coupling disturbance control method based on variable inertia parameter modeling
CN117550080B (en) * 2023-03-01 2024-03-29 四川荣川通用航空有限责任公司 Navigation information display system based on Beidou short message transmission
CN117669275B (en) * 2024-02-02 2024-04-26 东方空间(江苏)航天动力有限公司 Method, device and equipment for performing simulation integration on dynamics of space vehicle

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5992383A (en) * 1996-05-28 1999-11-30 U.S. Philips Corporation Control unit having a disturbance predictor, a system controlled by such a control unit, an electrical actuator controlled by such a control unit, and throttle device provided with such an actuator
JP2009078745A (en) * 2007-09-27 2009-04-16 Japan Aerospace Exploration Agency Electric vertical takeoff/landing aircraft
FR2977333B1 (en) * 2011-06-28 2014-01-31 Parrot METHOD FOR DYNAMICALLY CONTROLLING THE ATTITUDE OF A DRONE FOR THE AUTOMATIC EXECUTION OF A FIGURE OF THE RING OR SALTO TYPE

Also Published As

Publication number Publication date
JP2018010671A (en) 2018-01-18

Similar Documents

Publication Publication Date Title
JP6207746B2 (en) Aircraft attitude control method and apparatus
JP6585673B2 (en) Aircraft attitude control method
US11204611B2 (en) Assisted takeoff
US11015956B2 (en) System and method for automatic sensor calibration
AU2017344750B2 (en) Thrust vectored multicopters
US10023323B1 (en) Estimating wind from an airborne vehicle
CN106716272B (en) System and method for flight simulation
Mulgaonkar et al. Design of small, safe and robust quadrotor swarms
JP2017504881A5 (en)
Abd Rahman et al. Design and fabrication of small vertical-take-off-landing unmanned aerial vehicle
Sánchez et al. Simple real-time stabilization of vertical takeoff and landing aircraft with bounded signals
Wang et al. Autonomous control of micro flying robot
George et al. On the design and development of a coaxial nano rotorcraft
Hashimoto et al. Avionics integration for a fully autonomous self-contained indoor miniature unmanned aerial system
Jiang et al. Control Algorithm for Planning Path of Unmanned Aircraft
CARRILLO et al. Quad-Rotor Control

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20170905

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20170905

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20171003

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20180828

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20180831

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20181116

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190422

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20190426

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190722

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20190806

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20190905

R150 Certificate of patent or registration of utility model

Ref document number: 6585673

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees