JP2020032903A - Flight body - Google Patents

Flight body Download PDF

Info

Publication number
JP2020032903A
JP2020032903A JP2018161982A JP2018161982A JP2020032903A JP 2020032903 A JP2020032903 A JP 2020032903A JP 2018161982 A JP2018161982 A JP 2018161982A JP 2018161982 A JP2018161982 A JP 2018161982A JP 2020032903 A JP2020032903 A JP 2020032903A
Authority
JP
Japan
Prior art keywords
external force
flying object
aircraft
airframe
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.)
Granted
Application number
JP2018161982A
Other languages
Japanese (ja)
Other versions
JP7119782B2 (en
Inventor
拓 清水
Taku Shimizu
清水  拓
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.)
IHI Corp
Original Assignee
IHI Corp
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 IHI Corp filed Critical IHI Corp
Priority to JP2018161982A priority Critical patent/JP7119782B2/en
Publication of JP2020032903A publication Critical patent/JP2020032903A/en
Application granted granted Critical
Publication of JP7119782B2 publication Critical patent/JP7119782B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

To provide a flight body capable of performing flight control by acquiring an external force applied to an airframe, without use of a sensor for detecting the external force applied to the airframe.SOLUTION: A flight body 1 flying by rotating a plurality of rotors 11 is constituted to calculate a force acting on an airframe at least by rotation of the rotors 11 (S10), calculate a force applied to the airframe at least by a motion state of the airframe (S12), calculate an external force applied to the airframe, on the basis of a difference between by the force acting on the airframe by the rotation of the rotors 11 and the force applied to the airframe by the motion state of the airframe (S14), and perform flight control by using the external force applied to the airframe.SELECTED DRAWING: Figure 4

Description

本発明は、複数のロータを備えた飛行体に関する。   The present invention relates to a flying object provided with a plurality of rotors.

従来、複数のロータを備えた飛行体として、例えば、特許第6207003号公報に記載されるように、複数のロータを備えたマルチロータ機であって、機体にケーブルが取り付けられ、ケーブルの張力を考慮して飛行制御を行うものが知られている。   2. Description of the Related Art Conventionally, as a flying body having a plurality of rotors, for example, as described in Japanese Patent No. 6207003, a multi-rotor aircraft having a plurality of rotors, a cable is attached to the fuselage, and tension of the cable is reduced. A device that performs flight control in consideration of the above is known.

特許第6207003号公報Japanese Patent No. 6207003

このような飛行体においては、ケーブルなどから受ける外力を正確に算出するために、外力検出のためのセンサを取り付けることが考えられる。この場合、飛行体の通常の飛行を制御するためのセンサのほかに特別なセンサが必要となる。このため、飛行体のコストアップや重量増加などの要因となってしまう。   In such an aircraft, it is conceivable to attach a sensor for detecting an external force in order to accurately calculate an external force received from a cable or the like. In this case, a special sensor is required in addition to the sensor for controlling the normal flight of the flying object. For this reason, the cost and weight of the flying object are increased.

そこで、機体に加わる外力を検出するセンサを用いずに飛行制御が行える飛行体の開発が望まれている。   Therefore, development of a flying object capable of performing flight control without using a sensor for detecting an external force applied to the aircraft is desired.

そこで、本開示の一態様に係る飛行体は、複数のロータを回転させて飛行する飛行体において、少なくともロータの回転により機体に作用する力を演算する第一演算部と、少なくとも機体の運動状態により機体に加わっている力を演算する第二演算部と、第一演算部により演算される力と第二演算部により演算される力の差に基づいて機体に加わる外力を演算する外力演算部と、機体に加わる外力を用いて飛行制御を行う飛行制御部とを備えて構成されている。この飛行体によれば、第一演算部により少なくともロータの回転により機体に作用する力を演算し、第二演算部により少なくとも機体の運動状態により機体に加わっている力を演算し、第一演算部により演算される力と第二演算部により演算される力の差に基づいて機体に加わる外力を演算する。このため、機体に加わる外力をセンサによって検出しなくても、機体に加わる外力を算出することができる。従って、機体に加わる外力を直接検出するセンサを用いることなく機体に加わる外力を取得し、機体に加わる外力を用いて飛行制御が行える。   Therefore, a flying object according to an aspect of the present disclosure is a flying object that rotates by rotating a plurality of rotors, a first calculation unit that calculates a force acting on the aircraft by at least rotation of the rotor, and at least a motion state of the aircraft. A second calculating unit for calculating the force applied to the body by the first unit, and an external force calculating unit for calculating the external force applied to the body based on a difference between the force calculated by the first calculating unit and the force calculated by the second calculating unit. And a flight control unit that performs flight control using an external force applied to the airframe. According to this flying object, the first arithmetic unit calculates at least the force acting on the airframe by the rotation of the rotor, and the second arithmetic unit calculates at least the force applied to the airframe based on the motion state of the airframe. The external force applied to the body is calculated based on the difference between the force calculated by the unit and the force calculated by the second calculation unit. Therefore, the external force applied to the body can be calculated without detecting the external force applied to the body by the sensor. Therefore, the external force applied to the airframe can be obtained without using a sensor that directly detects the external force applied to the airframe, and flight control can be performed using the external force applied to the airframe.

また、本開示の一態様に係る飛行体において、第二演算部は、機体の運動状態により機体に加わっている力及び重力により機体に加わっている力を演算してもよい。この場合、第二演算部により重力により機体に加わっている力を演算することにより、重力を加味して機体に加わる外力を演算することができる。   In the flying object according to an aspect of the present disclosure, the second calculation unit may calculate a force applied to the aircraft by the motion state of the aircraft and a force applied to the aircraft by gravity. In this case, by calculating the force applied to the body by gravity by the second calculation unit, it is possible to calculate the external force applied to the body by taking gravity into account.

また、本開示の一態様に係る飛行体において、飛行制御部は、外力が予め設定された外力値以上である場合に外力に抗する飛行指令を受け付けずに複数のロータの回転数を制御してもよい。この場合、外力に抗して飛行することが抑制される。従って、飛行体が構造物に向かって飛行するなどの無理な飛行を抑制することができる。   In the flying object according to an aspect of the present disclosure, the flight control unit controls the rotation speeds of the plurality of rotors without receiving a flight command against the external force when the external force is equal to or greater than a preset external force value. You may. In this case, flying against external force is suppressed. Therefore, it is possible to suppress an unreasonable flight such as the flying object flying toward the structure.

また、本開示の一態様に係る飛行体において、飛行制御部は、外力の目標値となる目標外力が入力された場合、機体を外部物体に押し付けて機体に目標外力が加わるように複数のロータの回転数を制御してもよい。この場合、飛行体を外部物体に積極的に押し付けるような飛行が可能となる。   Further, in the flying body according to an aspect of the present disclosure, when a target external force that is a target value of the external force is input, the flight control unit includes a plurality of rotors that press the body against an external object to apply the target external force to the body. May be controlled. In this case, it is possible to perform a flight in which the flying object is positively pressed against the external object.

本発明によれば、機体に加わる外力を検出するセンサを用いずに機体に加わる外力を演算し、機体に加わる外力を用いて飛行制御を行うことができる。   According to the present invention, it is possible to calculate the external force applied to the airframe without using a sensor for detecting the external force applied to the airframe, and perform flight control using the external force applied to the airframe.

本発明の第一実施形態に係る飛行体の概略構成を示す斜視図である。It is a perspective view showing the schematic structure of the flying object concerning a first embodiment of the present invention. 図1の飛行体の電気的構成を示す図である。FIG. 2 is a diagram illustrating an electrical configuration of the flying object of FIG. 1. 図1の飛行体における飛行制御の一例を示すブロック線図である。FIG. 2 is a block diagram illustrating an example of flight control in the flying object of FIG. 1. 図1の飛行体における外力演算処理を示すフローチャートである。3 is a flowchart illustrating an external force calculation process in the flying object of FIG. 1. 図1の飛行体における飛行動作を示す図である。FIG. 2 is a diagram illustrating a flight operation of the flying object in FIG. 1. 第二実施形態に係る飛行体における飛行制御の一例を示すブロック線図である。It is a block diagram showing an example of flight control in the flying object concerning a second embodiment. 図7の飛行体における飛行動作を示す図である。It is a figure which shows the flying operation in the flying object of FIG. 図7の飛行体の変形例を示す図である。It is a figure which shows the modification of the flying object of FIG.

以下、本発明の実施形態について、図面を参照しながら説明する。なお、図面の説明において同一要素には同一符号を付し、重複する説明は省略する。以下の説明では、本発明が、無人航空機(以下、UAV(Unmanned Aerial Vehicle)という)に適用される場合について説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings. In the description of the drawings, the same elements will be denoted by the same reference symbols, without redundant description. In the following description, a case where the present invention is applied to an unmanned aerial vehicle (hereinafter, referred to as UAV (Unmanned Aerial Vehicle)) will be described.

(第一実施形態)
図1に示されるように、本実施形態の飛行体1は、複数のロータ11を回転させて飛行する飛行体である。飛行体1は、中央に配置されたペイロード部(本体)2と、ペイロード部2に対して固定されて外方に延びる六本のフレーム3と、フレーム3の先端部に取り付けられた六枚のロータ11とを備えている。飛行体1の機体には、ペイロード部2、フレーム3及びロータ11が含まれる。また、機体には、ペイロード部2、フレーム3、ロータ11のほか、これらに取り付けられ一体となって飛行する部分も含む。例えば、飛行体1にロータガイドや作業機器が取り付けられた場合、このロータガイド及び作業機器も機体の一部に含まれる。この飛行体1は、複数のロータ11を備えるマルチロータ機(回転翼機)であり、飛行指令に従って無人で飛行する。UAVである飛行体1は、回転および並進方向の運動を合わせた六自由度での運動成分を独立に発生可能になっている。従って、飛行体1は、狭所での飛行や接触作業を伴う飛行に適している。
(First embodiment)
As shown in FIG. 1, the flying object 1 of the present embodiment is a flying object that rotates by rotating a plurality of rotors 11. The flying object 1 includes a payload portion (main body) 2 disposed at the center, six frames 3 fixed to the payload portion 2 and extending outward, and six And a rotor 11. The fuselage of the flying object 1 includes a payload unit 2, a frame 3, and a rotor 11. The airframe also includes the payload 2, the frame 3, and the rotor 11, as well as a portion attached thereto and flying as a unit. For example, when a rotor guide or work equipment is attached to the flying object 1, the rotor guide and work equipment are also included in a part of the airframe. The flying object 1 is a multi-rotor aircraft (rotor wing aircraft) having a plurality of rotors 11 and flies unmanned according to a flight command. The flying object 1 that is a UAV can independently generate a motion component having six degrees of freedom that combines the rotation and the translational motion. Therefore, the flying object 1 is suitable for a flight in a narrow place or a flight involving a contact operation.

飛行体1のロータ11はペイロード部2を通る鉛直線Nの周囲に六つ配置されており、飛行体1は、ヘキサコプタ型の飛行体となっている。鉛直線Nの周囲に配置された六枚のロータ11は、例えば水平面に沿って延びる六角形の頂点上に配置されている。つまり、六枚のロータ11の回転中心は、同一平面上に配置されており、正六角形の頂点上に配置されている。なお、六枚のロータ11は、正六角形の頂点上に配置される必要性はなく、対向する一対の辺(平行な2辺)のみが長い六角形の頂点上に配置されてもよい。六枚のロータ11は、必ずしも同一平面上に配置されなくてもよく、Z軸方向にオフセットされていてもよい。六枚のロータ11あるいは回転中心11aが所定の水平方向線に関して対称性を有するように配置されると、制御系がシンプルになり、設計および実装が容易となる。   The six rotors 11 of the flying object 1 are arranged around a vertical line N passing through the payload portion 2, and the flying object 1 is a hexacopter type flying object. The six rotors 11 arranged around the vertical line N are arranged, for example, on a vertex of a hexagon extending along a horizontal plane. That is, the rotation centers of the six rotors 11 are arranged on the same plane, and are arranged on the vertices of a regular hexagon. The six rotors 11 do not need to be arranged on the vertices of a regular hexagon, and may be arranged on the vertices of a hexagon in which only a pair of opposing sides (two parallel sides) are long. The six rotors 11 do not necessarily have to be arranged on the same plane, and may be offset in the Z-axis direction. When the six rotors 11 or the rotation centers 11a are arranged so as to be symmetrical with respect to a predetermined horizontal line, the control system is simplified, and the design and mounting are facilitated.

ロータ11の回転中心11aは、例えば鉛直方向に向けられている。なお、回転中心11aの方向は、ほぼ鉛直方向であってもよく、鉛直方向に対し斜めの方向とする場合もある。この場合、飛行体1の飛行の安定性が向上する。   The rotation center 11a of the rotor 11 is directed, for example, in the vertical direction. Note that the direction of the rotation center 11a may be substantially vertical, and may be a direction oblique to the vertical direction. In this case, the flying stability of the flying object 1 is improved.

なお、図1では、ロータ11において外部との接触を防止するガイド部材が図示されていないが、そのようなガイド部材を設置してもよい。また、図1では、六つのロータ11を備えた飛行体1を示しているが、ロータ11の設置数は六つ未満であってもよく、六つ以上であってもよい。   Although a guide member for preventing the rotor 11 from contacting the outside is not shown in FIG. 1, such a guide member may be provided. Although FIG. 1 shows the flying object 1 provided with six rotors 11, the number of rotors 11 may be less than six, or may be six or more.

図2に、飛行体1の電気的構成の概要図を示す。図2において、実線は電源系統を示し、破線は通信系統(制御系統)を示している。図2に示されるように、ペイロード部2には、飛行体1の各部を制御するための制御部20と、飛行体1の各部を駆動するための電源であるバッテリ21と、各部に電源を供給するための電源基板22とが搭載されている。また、ペイロード部2には、センサ類23及び通信部28が搭載されている。センサ類23は、飛行体1の位置および姿勢などを推定するための機器である。例えば、センサ類23として、ジャイロセンサ24、GPS(Global Positioning System)センサ25および気圧センサ26、加速度センサ27が設けられている。ジャイロセンサ24は、機体の角速度を検出するセンサである。加速度センサ27は、機体の上下方向、左右方向及び前後方向の加速度を検出するセンサである。なお、ジャイロセンサ24と加速度センサ27は、それぞれの機能を備えて一体化されたセンサであってもよい。これらのセンサ類23は、測定結果を示すデータを制御部20に出力する。制御部20は、センサ類23から出力されたセンサデータに基づき、例えば推定アルゴリズム等を用いて、飛行体1の現在の位置および姿勢を推定する。なお、センサ類23には、飛行体1の機体に加わる外力を直接検出するセンサは搭載されていない。つまり、センサ類23には、力覚センサや圧力センサなど機体に加わる外力を直接検出するセンサは備えていない。   FIG. 2 shows a schematic diagram of an electrical configuration of the flying object 1. In FIG. 2, a solid line indicates a power supply system, and a broken line indicates a communication system (control system). As shown in FIG. 2, the payload unit 2 includes a control unit 20 for controlling each unit of the flying vehicle 1, a battery 21 which is a power supply for driving each unit of the flying vehicle 1, and a power supply for each unit. A power supply board 22 for supplying power is mounted. The payload section 2 has sensors 23 and a communication section 28 mounted thereon. The sensors 23 are devices for estimating the position and attitude of the flying object 1 and the like. For example, as the sensors 23, a gyro sensor 24, a GPS (Global Positioning System) sensor 25, an air pressure sensor 26, and an acceleration sensor 27 are provided. The gyro sensor 24 is a sensor that detects the angular velocity of the body. The acceleration sensor 27 is a sensor that detects acceleration in the vertical direction, the horizontal direction, and the longitudinal direction of the body. Note that the gyro sensor 24 and the acceleration sensor 27 may be integrated sensors having respective functions. These sensors 23 output data indicating the measurement result to the control unit 20. The control unit 20 estimates the current position and orientation of the flying object 1 based on the sensor data output from the sensors 23 using, for example, an estimation algorithm. It should be noted that the sensors 23 are not provided with a sensor for directly detecting an external force applied to the airframe of the flying object 1. That is, the sensors 23 do not include a sensor for directly detecting an external force applied to the body such as a force sensor or a pressure sensor.

通信部28は、送信機(図示せず)との通信を行う部位である。通信部28は、例えば地上で操作される送信機と無線通信可能に構成され、少なくとも飛行指令を受信する受信機能を備えている。具体的には、通信部28は、飛行指令の信号を受信し、その飛行指令の信号を制御部20に入力する。   The communication unit 28 is a part that performs communication with a transmitter (not shown). The communication unit 28 is configured to be capable of wireless communication with a transmitter operated on the ground, for example, and has at least a reception function of receiving a flight command. Specifically, the communication unit 28 receives the signal of the flight command, and inputs the signal of the flight command to the control unit 20.

上記した機器の他にも、ペイロード部2には、たとえばカメラやロボットアーム等の作業機器が搭載され得る。ペイロード部2に搭載される機器は、飛行体1に求められる飛行や作業に応じて、適宜変更され得る。ペイロード部2に搭載される機器の位置および重量によって、ペイロード部2の重量および重心の位置は変化し得る。飛行体1では、ペイロード部2の重量および重心の位置を考慮して、ロータ11が回転制御される。   In addition to the above-described devices, the payload unit 2 may be equipped with working devices such as a camera and a robot arm. The equipment mounted on the payload unit 2 can be appropriately changed according to the flight and work required for the flying object 1. The weight and the position of the center of gravity of the payload unit 2 can change depending on the position and the weight of the device mounted on the payload unit 2. In the flying object 1, the rotation of the rotor 11 is controlled in consideration of the weight of the payload 2 and the position of the center of gravity.

各フレーム3の先端部には、ロータ11のそれぞれを回転させるモータ31が取り付けられている。ペイロード部2には、これらのモータ31の回転数を制御するための、六つのモータアンプ30が搭載されている。各モータアンプ30には、電源基板22を介してバッテリ21から電源が供給される。各モータアンプ30は、制御部20によって制御されて、モータ31が所定の回転数および回転方向で回転するように、モータ31に電流を供給する。   A motor 31 for rotating each of the rotors 11 is attached to the tip of each frame 3. The payload unit 2 is equipped with six motor amplifiers 30 for controlling the number of rotations of these motors 31. Power is supplied to each motor amplifier 30 from a battery 21 via a power supply board 22. Each motor amplifier 30 is controlled by the control unit 20 and supplies a current to the motor 31 so that the motor 31 rotates at a predetermined rotation speed and rotation direction.

制御部20は、例えばCPU(Central Processing Unit)、ROM(Read Only Memory)、およびRAM(Random Access Memory)等のハードウェアと、ROMに記憶されたプログラム等のソフトウェアとから構成されたコンピュータである。制御部20は、飛行体1の飛行制御を行う飛行制御部として機能する。すなわち、制御部20は、送信機から受けた飛行指令に基づいて、モータアンプ30を介してモータ31を駆動させ、ロータ11の回転を制御する。このとき、制御部20は、機体に加わる外力を演算し、機体に加わる外力を用いて飛行制御を行う。すなわち、制御部20は、飛行体1の機体に加わる外力を演算する外力演算部として機能する。また、制御部20は、機体に加わる外力を演算するにあたり、ロータ11の回転により機体に作用する力及び機体の運動状態により機体に加わっている力を演算する。すなわち、制御部20は、少なくともロータ11の回転により機体に作用する力を演算する第一演算部として機能する。また、制御部20は、少なくとも機体の運動状態により機体に加わっている力を演算する第二演算部として機能する。このとき、制御部20は、第二演算部として、機体の運動状態により機体に加わっている力と共に機体に加わる重力を演算してもよい。   The control unit 20 is a computer including hardware such as a CPU (Central Processing Unit), a ROM (Read Only Memory), and a RAM (Random Access Memory), and software such as a program stored in the ROM. . The control unit 20 functions as a flight control unit that controls the flight of the flying object 1. That is, the control unit 20 controls the rotation of the rotor 11 by driving the motor 31 via the motor amplifier 30 based on the flight command received from the transmitter. At this time, the control unit 20 calculates an external force applied to the airframe, and performs flight control using the external force applied to the airframe. That is, the control unit 20 functions as an external force calculation unit that calculates the external force applied to the airframe of the flying object 1. Further, when calculating the external force applied to the airframe, the control unit 20 calculates the force applied to the airframe by the rotation of the rotor 11 and the force applied to the airframe based on the motion state of the airframe. That is, the control unit 20 functions as a first calculation unit that calculates at least a force acting on the body by the rotation of the rotor 11. Further, the control unit 20 functions as a second calculation unit that calculates a force applied to the body at least based on a motion state of the body. At this time, the control unit 20 may calculate the gravity applied to the body together with the force applied to the body according to the motion state of the body as the second calculation unit.

制御部20は、第一演算部として演算した力と第二演算部として演算した力の差に基づいて機体に加わる外力を演算する。例えば、制御部20は、機体の運動状態に基づいて機体に加わっている力及び機体に加わる重力と、ロータ11の回転により機体に作用する力との差に基づいて機体に加わる外力を演算する。ここで、機体に加わる外力には、機体に加わる重力を含まない。機体に加わる外力としては、飛行体1の機体が障害物に接触し障害物から受ける反力、機体に繋がれるケーブルから受ける張力、機体に衝突する物体から受ける力、風などにより機体が受ける力などが該当する。   The control unit 20 calculates an external force applied to the aircraft based on a difference between the force calculated as the first calculation unit and the force calculated as the second calculation unit. For example, the control unit 20 calculates an external force applied to the aircraft based on a difference between a force applied to the aircraft based on the motion state of the aircraft and gravity applied to the aircraft and a force applied to the aircraft due to the rotation of the rotor 11. . Here, the external force applied to the airframe does not include the gravity applied to the airframe. The external force applied to the airframe includes the reaction force received by the airframe of the flying vehicle 1 upon contact with the obstacle, the tension received from a cable connected to the airframe, the force received from an object colliding with the airframe, the force received by the wind, and the like. And so on.

制御部20は、飛行制御を行う際、機体に加わる外力を用いて飛行制御を実行する。例えば、制御部20は、機体に加わる外力が予め設定された外力値以上である場合に外力に抗する飛行指令を受け付けずにロータ11の回転数を制御する。具体的には、飛行体1の進行方向に構造物があり、飛行体1がその構造物に接触し、構造物からの反力として外力を受けており、その外力が設定された外力値以上である場合には、飛行体1は、構造物へ向かう飛行指令を受け付けず飛行する。このとき、機体に加わる外力としては、外力の大きさと外力の時間変化量(外力の微分値)を演算し、これらがそれぞれ予め設定された閾値以上である場合に外力に抗する飛行指令を受け付けないように飛行制御してもよい。この場合、飛行体1が風などにより外力を受ける場合と構造物などに衝突して外力を受ける場合を識別して飛行制御することが可能となる。つまり、飛行体1が風などにより外力を受ける場合にはその外力に抗する飛行は行われ、構造物などに衝突して外力を受ける場合にはその外力に抗する飛行は行われなくなるように、飛行制御が行える。   When performing the flight control, the control unit 20 executes the flight control using the external force applied to the body. For example, when the external force applied to the body is equal to or greater than a preset external force value, the control unit 20 controls the rotation speed of the rotor 11 without receiving a flight command against the external force. Specifically, there is a structure in the traveling direction of the flying object 1, the flying object 1 contacts the structure, receives an external force as a reaction force from the structure, and the external force is equal to or greater than the set external force value. In this case, the flying object 1 flies without receiving a flight command for a structure. At this time, as the external force applied to the airframe, the magnitude of the external force and the time change amount of the external force (differential value of the external force) are calculated, and when each of them is equal to or more than a preset threshold, a flight command against the external force is received. Flight control may be performed so as not to occur. In this case, it is possible to distinguish between a case where the flying object 1 receives an external force due to wind or the like and a case where the flying object 1 collides with a structure or the like and receives the external force, and control the flight. In other words, when the flying object 1 receives an external force due to wind or the like, the flight against the external force is performed, and when the flying object 1 collides with a structure or the like and receives the external force, the flight against the external force is not performed. And flight control.

次に、本実施形態に係る飛行体1の飛行制御について説明する。   Next, flight control of the flying object 1 according to the present embodiment will be described.

図3は飛行体1における飛行制御系の一例を示したブロック線図である。図3に示す位置姿勢修正器、飛行制御器及び外力演算器は、制御部20内に設けられる制御器である。図3に示すように、地上の送信機から送られた飛行指令は、位置姿勢修正器に入力される。また、機体のセンサから出力される現在の機体の位置信号及び姿勢信号が位置姿勢修正器に入力される。さらに、外力演算器により演算される機体に加わる外力の信号が位置姿勢修正器に入力される。   FIG. 3 is a block diagram showing an example of a flight control system in the flying object 1. The position and orientation corrector, flight controller, and external force calculator shown in FIG. 3 are controllers provided in the controller 20. As shown in FIG. 3, the flight command sent from the transmitter on the ground is input to the position and orientation corrector. Further, the current position signal and attitude signal of the aircraft output from the sensors of the aircraft are input to the position and orientation corrector. Further, a signal of the external force applied to the body calculated by the external force calculator is input to the position and orientation corrector.

ここで、制御部20の外力演算器による外力演算処理について説明する。図4は、外力演算処理を示すフローチャートである。まず、図4のステップS10(以下、単に「S10」という。以降のステップも同様とする。)において、第一演算処理が行われる。第一演算処理は、ロータ11の回転により機体に作用する力を演算する処理である。ここで、機体に作用する力には、機体に作用する推力及び機体に作用するトルクを含む。例えば、制御部20は、各ロータ11の回転速度指令に基づく各ロータ11の回転により機体に作用する推力及び機体に作用するトルクを演算する。機体に作用する推力は、飛行体1が前後、左右及び上下に移動する際に機体に作用する推進力である。機体に作用するトルクは、飛行体1の機体に作用する回転方向のトルクである。   Here, the external force calculation processing by the external force calculator of the control unit 20 will be described. FIG. 4 is a flowchart showing the external force calculation process. First, in step S10 of FIG. 4 (hereinafter, simply referred to as “S10”. The same applies to subsequent steps), a first calculation process is performed. The first calculation process is a process of calculating a force acting on the body by the rotation of the rotor 11. Here, the force acting on the aircraft includes the thrust acting on the aircraft and the torque acting on the aircraft. For example, the control unit 20 calculates a thrust acting on the body and a torque acting on the body by the rotation of each rotor 11 based on the rotation speed command of each rotor 11. The thrust acting on the aircraft is the propulsive force acting on the aircraft when the flying body 1 moves back and forth, left and right, and up and down. The torque acting on the fuselage is a rotational torque acting on the fuselage of the flying body 1.

具体的には、各ロータ11の回転により機体に作用する推力fは、次の式(1)により、算出される。 Specifically, the thrust f g acting on the fuselage by rotation of the rotor 11, by the following equation (1), is calculated.

Figure 2020032903
Figure 2020032903

式(1)において、Tは各ロータ11が発生させている推力、nはロータ11の推力方向の単位ベクトルである。推力T及び単位ベクトルnは、例えばロータ11の回転速度、回転方向などの回転状態に基づいて算出すればよい。六つのロータ11を備える飛行体1である場合、nの値は6となる。 In Expression (1), T i is a thrust generated by each rotor 11, and n i is a unit vector of the rotor 11 in the thrust direction. Thrust T i and the unit vectors n i, for example the rotational speed of the rotor 11 may be calculated based on the rotation state, such as the direction of rotation. In the case of the flying object 1 having six rotors 11, the value of n is 6.

各ロータ11の回転により機体に作用するトルクτは、次の式(2)により、算出される。なお、トルクτは、各ロータ11の回転により生ずる反トルクである。 The torque τ g acting on the body by the rotation of each rotor 11 is calculated by the following equation (2). Note that the torque τ g is a counter torque generated by the rotation of each rotor 11.

Figure 2020032903
Figure 2020032903

式(2)において、rは機体の重心からみた各ロータの位置、τは各ロータ11が発生させているトルクである。位置rは、飛行体1の機械的構造により決定される。トルクτは、例えばロータ11の回転速度、回転方向などの回転状態に基づいて算出すればよい。sはトルクの方向を示す符号であり、1又は−1の値をとる。つまり、sは、ロータ11のトルクの発生方向とnの方向の関係に従って、1又は−1の値となる。 In equation (2), r i is the position of each rotor as viewed from the center of gravity of the airframe, and τ i is the torque generated by each rotor 11. Position r i is determined by the mechanical structure of the aircraft 1. The torque τ i may be calculated based on the rotation state of the rotor 11 such as the rotation speed and the rotation direction. s i is the sign indicating the direction of torque takes a value of 1 or -1. That, s i, in accordance with the direction of the relationship between the occurrence direction and n i of the torque of the rotor 11, a value of 1 or -1.

このように、制御部20は、ロータ11の回転により機体に作用する力として、各ロータ11の回転により機体に作用する推力f及び機体に作用するトルクτを演算する。なお、ロータ11の回転により機体に作用する力の演算は、上述した算出方式以外の他の算出方式によって行ってもよい。 As described above, the control unit 20 calculates the thrust f g acting on the body by the rotation of each rotor 11 and the torque τ g acting on the body as the force acting on the body by the rotation of the rotor 11. The calculation of the force acting on the body by the rotation of the rotor 11 may be performed by a calculation method other than the above-described calculation method.

そして、図4のS12に処理が移行し、第二演算処理が行われる。第二演算処理は、飛行体1の機体に加わっている力を演算する処理である。例えば、第二演算処理では、機体に加わっている力として、機体の運動状態により機体に加わっている力及びトルク、並びに重力により機体に加わっている力を演算する。機体の運動状態により機体に加わっている力は、例えば機体の運動状態により推定される機体に加わる力である。つまり、機体の運動状態により機体に加わっている力は、M・aとして算出される。Mは、機体の質量、aは機体の加速度である。aは、大きさと方向をもつベクトルとして表される。機体の運動状態により機体に加わっているトルクは、例えば機体の運動状態により推定される機体に加わるトルクである。つまり、機体の運動状態により機体に加わっているトルクは、I・β+ω×I・ωとして算出される。Iは、機体の慣性モーメント(慣性テンソル)、βは機体の角加速度、ωは機体の角速度である。角加速度β及び角速度ωは、大きさと方向をもつベクトルとして表される。機体に加わる重力は、M・gとして算出される。gは、重力加速度であり、大きさと方向をもつベクトルとして表される。   Then, the process proceeds to S12 in FIG. 4, and the second calculation process is performed. The second calculation process is a process of calculating a force applied to the aircraft of the flying object 1. For example, in the second arithmetic processing, as the force applied to the body, the force and torque applied to the body according to the motion state of the body and the force applied to the body due to gravity are calculated. The force applied to the airframe by the motion state of the airframe is, for example, a force applied to the airframe estimated by the motion state of the airframe. That is, the force applied to the aircraft according to the motion state of the aircraft is calculated as Ma. M is the mass of the fuselage, and a is the acceleration of the fuselage. a is represented as a vector having a magnitude and a direction. The torque applied to the airframe by the motion state of the airframe is, for example, the torque applied to the airframe estimated by the motion state of the airframe. That is, the torque applied to the body according to the motion state of the body is calculated as I · β + ω × I · ω. I is the moment of inertia (inertia tensor) of the aircraft, β is the angular acceleration of the aircraft, and ω is the angular velocity of the aircraft. The angular acceleration β and the angular velocity ω are represented as vectors having magnitude and direction. The gravity applied to the airframe is calculated as M · g. g is a gravitational acceleration and is represented as a vector having a magnitude and a direction.

このように、第二演算処理において、機体に加わっている力f及び機体に加わっているトルクτは、次の式(3)及び式(4)によって算出される。 Thus, in the second calculation process, torque tau a are applied to the force f a and aircraft being applied to the body is calculated by the following equation (3) and (4).

=M・a+M・g …(3) f a = M · a + M · g (3)

τ=I・β+ω×I・ω …(4) τ a = I · β + ω × I · ω (4)

式(3)の機体に加わっている力fは、飛行体1の直線運動に基づいて演算される力である。式(4)の機体に加わっているトルクτは、飛行体1の回転運動に基づいて演算されるトルクである。なお、第二演算処理では重力により機体に加わっている力を演算せず、重力により機体に加わっている力を第一演算処理で演算してもよい。 Force f a are applied to the fuselage of the formula (3) is the force which is calculated on the basis of the linear movement of the aircraft 1. The torque τ a applied to the airframe of the equation (4) is a torque calculated based on the rotational motion of the flying vehicle 1. Note that the force applied to the body by gravity may not be calculated in the second calculation process, but the force applied to the body by gravity may be calculated in the first calculation process.

そして、図4のS14に処理が移行し、外力演算処理が行われる。外力演算処理は、飛行体1の機体に加わっている外力を演算する処理である。例えば、外力演算処理では、S10の第一演算処理により演算される力とS12の第二演算処理により演算される力の差に基づいて機体に加わる外力が演算される。   Then, the process proceeds to S14 of FIG. 4, and the external force calculation process is performed. The external force calculation process is a process of calculating an external force applied to the aircraft of the flying object 1. For example, in the external force calculation process, the external force applied to the body is calculated based on the difference between the force calculated by the first calculation process of S10 and the force calculated by the second calculation process of S12.

例えば、機体に加わる外力は、次の式(5)及び式(6)により演算される。   For example, the external force applied to the airframe is calculated by the following equations (5) and (6).

f=f−f …(5) f = f a -f g ... ( 5)

τ=τ−τ …(6) τ = τ a −τ g (6)

式(5)の外力fは、機体の直線運動における機体に加わる外力である。式(6)の外力τは、機体の回転運動における機体に加わる外力(トルク)である。   The external force f in the equation (5) is an external force applied to the airframe in the linear motion of the airframe. The external force τ in Expression (6) is an external force (torque) applied to the airframe during the rotational motion of the airframe.

このように、機体に加わる外力f及びτを演算により取得することができる。すなわち、機体に加わる外力f及びτを直接検出するセンサを用いることなく、機体に加わる外力f及びτを演算により取得することができる。   As described above, the external forces f and τ applied to the airframe can be obtained by the calculation. That is, the external forces f and τ applied to the body can be obtained by calculation without using a sensor that directly detects the external forces f and τ applied to the body.

図3に戻り、位置姿勢修正器は、飛行体1の機体が外部から受ける外力と現在の機体の位置信号及び姿勢信号とに基づいて、飛行指令を修正し修正指令を出力する。例えば、位置姿勢修正器は、飛行体1の機体が受ける外力が予め設定された外力値以上でない場合には、飛行指令を修正せずに修正指令として出力する。一方、位置姿勢修正器は、飛行体1の機体が受ける外力が予め設定された外力値以上である場合には、外力に抗する飛行指令を受け付けないように飛行指令を修正して修正指令を出力する。具体的には、飛行体1が進行方向にある構造物に接触して外力を受けた場合、飛行体1がその進行方向へ向かう飛行指令を受け付けず、その進行方向へ飛行して行かないように飛行制御が行われる。   Referring back to FIG. 3, the position and orientation corrector corrects the flight command based on the external force applied to the aircraft of the flying body 1 from the outside and the current position and orientation signals of the aircraft, and outputs the correction command. For example, when the external force received by the aircraft of the flying object 1 is not greater than or equal to a preset external force value, the position and orientation corrector outputs the flight command as a correction command without correcting the flight command. On the other hand, when the external force received by the aircraft of the flying body 1 is equal to or greater than a preset external force value, the position and orientation corrector corrects the flight command so as not to receive a flight command against the external force and outputs the correction command. Output. Specifically, when the flying object 1 comes into contact with a structure in the traveling direction and receives an external force, the flying object 1 does not receive a flight command toward the traveling direction and does not fly in the traveling direction. Flight control is performed.

位置姿勢修正器から出力された修正指令は、飛行制御器に入力される。飛行制御器は、修正指令に応じて回転速度指令を出力する。回転速度指令は、各ロータ11の回転制御信号である。飛行制御器は、飛行体1の目標位置及び目標姿勢を示す修正指令と現在の機体の位置及び姿勢の信号とに基づいて、目標位置及び目標姿勢を実現するための目標推力及び目標トルクを算出する。そして、飛行制御器は、目標推力及び目標トルクを生じさせるように各ロータ11の回転速度指令を生成して、機体のモータアンプ30に回転速度信号を出力する。   The correction command output from the position and orientation corrector is input to the flight controller. The flight controller outputs a rotation speed command according to the correction command. The rotation speed command is a rotation control signal of each rotor 11. The flight controller calculates a target thrust and a target torque for realizing the target position and the target attitude based on the correction command indicating the target position and the target attitude of the flying object 1 and the current position and attitude signals of the aircraft. I do. Then, the flight controller generates a rotation speed command for each rotor 11 so as to generate a target thrust and a target torque, and outputs a rotation speed signal to the motor amplifier 30 of the aircraft.

このような飛行体1の飛行制御によれば、狭所において飛行体1の不適切な飛行を抑制することができる。例えば、図5の(a)に示すように、上方及び側方に構造物が存在する狭所で飛行体1を飛行させる場合、飛行体1が構造物に接触又は衝突するおそれがある。そして、図5の(b)に示すように、飛行体1が側方の壁に接触し、所定値以上の外力を受けた場合、飛行体1は壁の方向へ進む飛行指令を受け付けなくなる。このため、図5の(c)に示すように、飛行体1は、壁の方向へ進む飛行指令を受け付けても壁の方へ進むことなく飛行位置を維持する。従って、飛行体1の機体を安定して飛行させることができる。   According to such flight control of the flying object 1, inappropriate flight of the flying object 1 in a narrow place can be suppressed. For example, as shown in FIG. 5A, when the flying object 1 is caused to fly in a narrow place where a structure exists above and to the side, the flying object 1 may contact or collide with the structure. Then, as shown in FIG. 5B, when the flying object 1 comes into contact with the side wall and receives an external force equal to or more than a predetermined value, the flying object 1 does not receive a flight command to proceed toward the wall. Therefore, as shown in (c) of FIG. 5, the flying object 1 maintains the flight position without traveling toward the wall even when receiving a flight command for traveling toward the wall. Therefore, the aircraft of the flying object 1 can be stably flown.

これに対し、外部からの外力を考慮せずに飛行制御すると、飛行体1が壁に接触した場合であっても、さらに壁の方向へ飛行体1を進行させる飛行指令に従って飛行体1が壁に向かって飛行することとなる。この場合、飛行体1のロータ11が出力限界となるまで駆動するおそれがあり、飛行安定性が損なわれる。本実施形態に係る飛行体1は、このような不安定な飛行制御を抑制できるのである。   On the other hand, if the flight control is performed without considering the external force from the outside, even when the flying object 1 comes into contact with the wall, the flying object 1 is further moved in accordance with the flight instruction for moving the flying object 1 toward the wall. Will fly towards. In this case, the rotor 11 of the flying body 1 may be driven until the output reaches the output limit, and flight stability is impaired. The flying object 1 according to the present embodiment can suppress such unstable flight control.

以上のように、本実施形態に係る飛行体1によれば、第一演算処理として少なくともロータの回転により機体に作用する力を演算し、第二演算処理として少なくとも機体の運動状態により機体に加わっている力を演算し、第一演算処理により演算される力と第二演算処理により演算される力の差に基づいて機体に加わる外力を演算する。このため、機体に加わる外力をセンサによって検出しなくても、機体に加わる外力を算出することができる。従って、機体に加わる外力を直接検出するセンサを用いることなく機体に加わる外力を取得し、機体に加わる外力を用いて飛行制御が行える。   As described above, according to the flying vehicle 1 according to the present embodiment, at least the force acting on the airframe due to the rotation of the rotor is calculated as the first arithmetic processing, and is applied to the airframe at least according to the motion state of the airframe as the second arithmetic processing. And calculating the external force applied to the body based on the difference between the force calculated by the first calculation process and the force calculated by the second calculation process. Therefore, the external force applied to the body can be calculated without detecting the external force applied to the body by the sensor. Therefore, the external force applied to the airframe can be obtained without using a sensor that directly detects the external force applied to the airframe, and flight control can be performed using the external force applied to the airframe.

また、本実施形態に係る飛行体1によれば、第二演算処理として、機体の運動状態により機体に加わっている力及び重力により機体に加わっている力を演算する。このため、機体に作用する重力を加味して、機体に加わる外力を演算することができる。   Further, according to the flying object 1 according to the present embodiment, as the second arithmetic processing, the force applied to the aircraft by the motion state of the aircraft and the force applied to the aircraft by gravity are calculated. For this reason, the external force applied to the aircraft can be calculated in consideration of the gravity acting on the aircraft.

また、本実施形態に係る飛行体1によれば、機体が受ける外力に応じて飛行指令を修正して飛行制御が行われる。このため、機体に加わる外力を加味した飛行制御が可能となり、飛行体1が構造物などに接触又は衝突した場合であっても安定した飛行制御が行える。   Moreover, according to the flying object 1 according to the present embodiment, the flight control is performed by correcting the flight command according to the external force received by the aircraft. For this reason, flight control in consideration of the external force applied to the airframe becomes possible, and stable flight control can be performed even when the flying object 1 contacts or collides with a structure or the like.

また、本実施形態に係る飛行体1によれば、外力が予め設定された外力値以上である場合にその外力に抗する飛行指令を受け付けずに複数のロータの回転数を制御する。このため、飛行体1が外力に抗して飛行することが抑制される。従って、飛行体が構造物に向かって飛行するなどの無理な飛行を抑制することができる。   Further, according to the flying object 1 according to the present embodiment, when the external force is equal to or greater than a preset external force value, the rotation speeds of the plurality of rotors are controlled without receiving a flight command against the external force. Therefore, the flying object 1 is prevented from flying against external force. Therefore, it is possible to suppress an unreasonable flight such as the flying object flying toward the structure.

このような本実施形態に係る飛行体1は、カメラ撮影による構造物の点検などに用いる場合に適している。例えば、飛行体1にカメラを取り付け、飛行体1を構造物に近づけて飛行させ、構造物を撮像して点検を行う場合、飛行体1が構造物に接触してしまったとしても、飛行体1が構造物に接触した状態で飛行することが抑制される。従って、飛行体1の飛行が安定して行え、構造物の点検作業が円滑に行える。   The flying object 1 according to the present embodiment is suitable for use in inspecting a structure by photographing with a camera. For example, when a camera is attached to the flying object 1, the flying object 1 is caused to fly close to the structure, and the structure is imaged and inspected, even if the flying object 1 comes into contact with the structure, 1 is suppressed from flying in contact with the structure. Therefore, the flight of the flying object 1 can be performed stably, and the inspection work of the structure can be performed smoothly.

(第二実施形態)
次に、本発明の第二実施形態に係る飛行体1aついて説明する。
(Second embodiment)
Next, a flying object 1a according to a second embodiment of the present invention will be described.

本実施形態に係る飛行体1aは、図1に示す第一実施形態に係る飛行体1とほぼ同様な外観を呈している。本実施形態に係る飛行体1aにおけるロータ11の配置位置は、第一実施形態に係る飛行体1と同様に構成されている。   The flying object 1a according to the present embodiment has substantially the same appearance as the flying object 1 according to the first embodiment shown in FIG. The arrangement position of the rotor 11 in the flying object 1a according to the present embodiment is configured similarly to the flying object 1 according to the first embodiment.

図6は、飛行体1aの飛行制御を示すブロック線図である。図7は、飛行体1aの飛行動作の説明図である。図8は、飛行体1aの変形例を示す図である。   FIG. 6 is a block diagram showing flight control of the flying object 1a. FIG. 7 is an explanatory diagram of the flight operation of the flying object 1a. FIG. 8 is a diagram illustrating a modified example of the flying object 1a.

図7の(a)、(b)に示すように、飛行体1aには、作業機器40が取り付けられている。作業機器40は、飛行体1aの作業の実行に用いられる機器である。作業機器40は、構造物などの外部物体に接触して作業を行う機器であって、例えば、超音波センサ、X線検査器、ネジ締め用ドライバ、清掃機器などが該当する。超音波センサは、構造物などに検出器を接触させることにより構造物などの内部状態を検出する。X線検査器は、構造物などに検査器を接触させて移動させることにより構造物などの内部状態を非破壊で検査する。ネジ締め用ドライバは、構造物などのネジを締める作業を行う。清掃機器は、構造物などの表面を拭くなどして清掃を行う。作業機器40は、制御部20と電気的に接続され、制御部20により作動制御される。   As shown in FIGS. 7A and 7B, a working device 40 is attached to the flying object 1a. The work equipment 40 is equipment used to execute the work of the flying object 1a. The work device 40 is a device that performs work by contacting an external object such as a structure, and corresponds to, for example, an ultrasonic sensor, an X-ray inspection device, a screwdriver, a cleaning device, and the like. An ultrasonic sensor detects an internal state of a structure or the like by bringing a detector into contact with the structure or the like. The X-ray inspection device non-destructively inspects an internal state of a structure or the like by moving the inspection device in contact with the structure or the like. The screw tightening driver performs a work of tightening a screw such as a structure. The cleaning device performs cleaning by wiping the surface of a structure or the like. The work equipment 40 is electrically connected to the control unit 20, and its operation is controlled by the control unit 20.

作業機器40は、例えば、アーム部材41を介してペイロード部2に取り付けられる。具体的には、ペイロード部2の下部にアーム部材41が取り付けられ、側方に延びるアーム部材41の先端に作業機器40が取り付けられる。作業機器40が構造物などに当接、接触する場合、飛行体1aの機体には外力が加わることとなる。   The work equipment 40 is attached to the payload unit 2 via the arm member 41, for example. Specifically, an arm member 41 is attached to a lower portion of the payload section 2, and a working device 40 is attached to a tip of the arm member 41 extending laterally. When the work equipment 40 comes into contact with or comes into contact with a structure or the like, an external force is applied to the body of the flying object 1a.

次に、本実施形態に係る飛行体1aの飛行制御について説明する。   Next, flight control of the flying object 1a according to the present embodiment will be described.

図6に示すように、まず、飛行制御器に対し機体の目標位置及び目標姿勢の信号が入力されると共に、現在の機体の位置及び姿勢の信号が入力される。機体の目標位置及び目標姿勢の信号は、送信機から受ける飛行指令である。現在の機体の位置及び姿勢の信号は、飛行体1に搭載されるジャイロセンサ24、GPSセンサ25、気圧センサ26及び加速度センサ27の少なくとも一つの出力信号である。飛行制御器は、機体の目標位置及び目標姿勢の信号と現在の機体の位置及び姿勢の信号に基づいて機体の目標推力及び目標トルクを演算する。   As shown in FIG. 6, first, signals of the target position and the attitude of the aircraft are input to the flight controller, and signals of the current position and attitude of the aircraft are input. The signal of the target position and the target attitude of the aircraft is a flight command received from the transmitter. The current signal of the position and attitude of the aircraft is at least one output signal of the gyro sensor 24, the GPS sensor 25, the barometric pressure sensor 26, and the acceleration sensor 27 mounted on the flying vehicle 1. The flight controller calculates a target thrust and a target torque of the aircraft based on signals of the target position and the attitude of the aircraft and signals of the current position and attitude of the aircraft.

また、飛行制御器に対し機体の現在の外力の信号が入力されると共に、目標外力が入力される。現在の外力の信号は、外力演算器により出力される外力の信号である。この外力演算器による外力の演算は、上述した第一実施形態と同様に行われる。目標外力は、予め制御部20に設定される外力の目標値である。例えば、作業機器40に応じた目標外力が制御部20に設定される。すなわち、構造物などに作業機器40を押し付けたい押圧力に応じて目標外力が設定される。目標外力を設定して作業機器40を構造物などに押し付けたとき、構造物などから受ける外力の大きさは、構造物などに対する作業機器40の押圧力と同じとなる。   In addition, a signal of the current external force of the aircraft is input to the flight controller, and a target external force is input. The current external force signal is an external force signal output by the external force calculator. The calculation of the external force by the external force calculator is performed in the same manner as in the first embodiment described above. The target external force is a target value of the external force set in the control unit 20 in advance. For example, the target external force according to the work equipment 40 is set in the control unit 20. That is, the target external force is set according to the pressing force for pressing the working device 40 against a structure or the like. When the target external force is set and the work equipment 40 is pressed against a structure or the like, the magnitude of the external force received from the structure or the like is the same as the pressing force of the work equipment 40 against the structure or the like.

飛行制御器は、機体の現在の外力の信号と目標外力に基づいて外力制御信号を出力する。外力制御信号は、飛行体1aが構造物などから受ける外力、すなわち作業機器40を構造物などへ押圧する力を調整するための信号である。この外力制御信号は、目標推力及び目標トルクの信号に加算される。そして、その加算された信号に基づいて回転速度演算が行われる。この回転速度演算により、各ロータの回転速度指令が算出される。回転速度指令は、各ロータ11の回転制御信号である。飛行制御器は、作業機器40の押圧力が目標外力と同じ力となるように作業機器40を構造物などに押圧させて飛行体1aを飛行させる。   The flight controller outputs an external force control signal based on the current external force signal and the target external force of the aircraft. The external force control signal is a signal for adjusting an external force that the flying object 1a receives from a structure or the like, that is, a force that presses the work equipment 40 against the structure or the like. This external force control signal is added to the target thrust and target torque signals. Then, a rotation speed calculation is performed based on the added signal. By this rotation speed calculation, a rotation speed command for each rotor is calculated. The rotation speed command is a rotation control signal of each rotor 11. The flight controller presses the work equipment 40 against a structure or the like so that the pressing force of the work equipment 40 becomes the same force as the target external force, and causes the flying object 1a to fly.

このような飛行体1aの飛行制御によれば、飛行体1aを構造物などに積極的に押し付けて飛行させることができる。例えば、図7の(a)に示すように、作業機器40を取り付けた飛行体1aを飛行させ、作業対象となる構造物の前に位置させる。そして、図7の(b)に示すように、飛行体1aを構造物に向けて移動させて作業機器40を構造物に押圧させる。このとき、外力演算器により構造物から受ける外力を演算し、その外力が目標外力となるように飛行体1aを飛行させる。これにより、飛行体1aに取り付けた作業機器40を構造物に対して所望の押圧力で押圧させて飛行体1aを飛行させることができる。なお、このときの飛行体1の操縦は、地上の操縦者による手動操縦で全て行われてもよいが、手動操縦により構造物の前の位置に飛行体1aを飛行させ、そこから自動操縦により飛行体1aを構造物に押圧させて飛行させてもよい。   According to the flight control of the flying object 1a, the flying object 1a can be positively pressed against a structure or the like and caused to fly. For example, as shown in FIG. 7A, the flying object 1a to which the work equipment 40 is attached is caused to fly, and is positioned in front of a structure to be worked. Then, as shown in FIG. 7B, the flying object 1a is moved toward the structure to press the work equipment 40 against the structure. At this time, the external force received from the structure is calculated by the external force calculator, and the flying object 1a is caused to fly such that the external force becomes the target external force. Thus, the work equipment 40 attached to the flying object 1a can be pressed against the structure with a desired pressing force to cause the flying object 1a to fly. It should be noted that the operation of the flying object 1 at this time may be entirely performed manually by a pilot on the ground. The flying object 1a may be pressed against the structure to fly.

以上のように、本実施形態に係る飛行体1aによれば、機体に目標外力が加わるように機体を外部物体に積極的に押し付けるような飛行が可能となる。   As described above, according to the flying object 1a according to the present embodiment, it is possible to perform a flight in which the aircraft is positively pressed against an external object so that the target external force is applied to the aircraft.

また、本実施形態に係る飛行体1aにおいても、第一実施形態に係る飛行体1と同様に、第一演算処理としてロータの回転により機体に作用する力を演算し、第二演算処理として機体の運動状態により機体に加わっている力を演算し、第一演算処理により演算される力と第二演算処理により演算される力の差に基づいて機体に加わる外力を演算することができる。このため、機体に加わる外力を直接検出するセンサを用いることなく機体に加わる外力を取得し、機体に加わる外力を用いて飛行制御が行える。   Also, in the flying vehicle 1a according to the present embodiment, similarly to the flying vehicle 1 according to the first embodiment, the force acting on the airframe by the rotation of the rotor is calculated as the first arithmetic processing, and the airframe 1 is calculated as the second arithmetic processing. And the external force applied to the body can be calculated based on the difference between the force calculated by the first calculation process and the force calculated by the second calculation process. Therefore, the external force applied to the airframe can be obtained without using a sensor that directly detects the external force applied to the airframe, and flight control can be performed using the external force applied to the airframe.

なお、本発明に係る飛行体は、上述した各実施形態に係る飛行体1、1aに限られるものでなく、特許請求の範囲の記載される要旨を変更しないように、当業者の知識に基づいて種々の変更、改良を施した様々な形態で実施することができる。また、上述した実施形態に記載されている技術的事項を利用して、実施例の変形例を構成することも可能である。各実施形態の構成を適宜組み合わせて使用してもよい。   The flying object according to the present invention is not limited to the flying objects 1 and 1a according to each of the above-described embodiments, and is based on the knowledge of a person skilled in the art so as not to change the gist described in the claims. Various modifications and improvements can be implemented in various forms. Further, it is also possible to configure a modification of the embodiment using the technical matters described in the above-described embodiment. The configurations of the embodiments may be appropriately combined and used.

例えば、各実施形態に係る飛行体1、1aは、ケーブルを接続して飛行するものであってもよい。具体的には、図8に示すように、飛行体1aのペイロード部2にケーブル5を接続し、ケーブル5の張力を機体が受ける外力して演算し、その外力を考慮して飛行制御を行ってもよい。ケーブル5は、例えば飛行体1aへの電力供給、飛行指令の入力などに用いられる。   For example, the flying objects 1 and 1a according to each embodiment may fly by connecting a cable. Specifically, as shown in FIG. 8, the cable 5 is connected to the payload portion 2 of the flying object 1a, the tension of the cable 5 is calculated by an external force received by the aircraft, and flight control is performed in consideration of the external force. You may. The cable 5 is used, for example, for supplying power to the flying object 1a, inputting a flight command, and the like.

また、上述した実施形態に係る飛行体1、1aでは、6枚のロータ11を備えたものについて説明したが、6枚以上のロータ11を備えるものであってもよい。また、6枚のロータ11の他に、1枚または複数枚の補助的なロータまたは予備のロータが更に設けられてもよい。本発明は、UAVに適用される場合に限られず、有人航空機に適用されてもよい。   In addition, although the flying object 1, 1a according to the above-described embodiment has been described as having the six rotors 11, it may have six or more rotors 11. Further, in addition to the six rotors 11, one or more auxiliary rotors or spare rotors may be further provided. The present invention is not limited to being applied to UAVs, but may be applied to manned aircraft.

1、1a 飛行体
2 ペイロード部(本体)
11 ロータ
11a 回転中心
20 制御部(第一演算部、第二演算部、外力演算部、飛行制御部)
40 作業機器
N 鉛直線
1, 1a Aircraft 2 Payload part (main body)
11 Rotor 11a Rotation center 20 Control unit (first operation unit, second operation unit, external force operation unit, flight control unit)
40 work equipment N plumb line

Claims (4)

複数のロータを回転させて飛行する飛行体において、
少なくとも前記ロータの回転により機体に作用する力を演算する第一演算部と、
少なくとも前記機体の運動状態により前記機体に加わっている力を演算する第二演算部と、
前記第一演算部により演算される力と前記第二演算部により演算される力の差に基づいて前記機体に加わる外力を演算する外力演算部と、
前記機体に加わる外力を用いて飛行制御を行う飛行制御部と、
を備える飛行体。
In a flying object that rotates by rotating a plurality of rotors,
A first calculation unit that calculates a force acting on the body by at least the rotation of the rotor,
A second calculation unit that calculates a force applied to the aircraft based on at least the motion state of the aircraft,
An external force calculation unit that calculates an external force applied to the aircraft based on a difference between the force calculated by the first calculation unit and the force calculated by the second calculation unit;
A flight control unit that performs flight control using external force applied to the aircraft,
A flying object equipped with.
前記第二演算部は、前記機体の運動状態により前記機体に加わっている力及び重力により前記機体に加わっている力を演算する、
請求項1に記載の飛行体。
The second calculation unit calculates a force applied to the aircraft by the motion state of the aircraft and a force applied to the aircraft by gravity,
The flying object according to claim 1.
前記飛行制御部は、前記外力が予め設定された外力値以上である場合に前記外力に抗する飛行指令を受け付けずに前記複数のロータの回転数を制御する、
請求項1又は2に記載の飛行体。
The flight control unit controls the rotation speed of the plurality of rotors without receiving a flight command against the external force when the external force is equal to or greater than a preset external force value,
The flying object according to claim 1.
前記飛行制御部は、前記外力の目標値となる目標外力が入力された場合、前記機体を外部物体に押し付けて前記機体に前記目標外力が加わるように前記複数のロータの回転数を制御する、
請求項1又は2に記載の飛行体。
When a target external force that is a target value of the external force is input, the flight control unit controls the rotation speeds of the plurality of rotors so as to press the body against an external object and apply the target external force to the body.
The flying object according to claim 1.
JP2018161982A 2018-08-30 2018-08-30 flying object Active JP7119782B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018161982A JP7119782B2 (en) 2018-08-30 2018-08-30 flying object

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018161982A JP7119782B2 (en) 2018-08-30 2018-08-30 flying object

Publications (2)

Publication Number Publication Date
JP2020032903A true JP2020032903A (en) 2020-03-05
JP7119782B2 JP7119782B2 (en) 2022-08-17

Family

ID=69666791

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018161982A Active JP7119782B2 (en) 2018-08-30 2018-08-30 flying object

Country Status (1)

Country Link
JP (1) JP7119782B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7123457B1 (en) * 2022-03-30 2022-08-23 株式会社石川エナジーリサーチ flight device

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001039397A (en) * 1999-08-02 2001-02-13 Komatsu Ltd Flying body having horizontal rotary wing
JP2011246105A (en) * 2010-05-27 2011-12-08 Honeywell Internatl Inc Wind estimation for unmanned aerial vehicle
JP2015531718A (en) * 2012-08-17 2015-11-05 パースペクティヴ・ロボティクス・ゲゼルシャフト・ミト・ベシュレンクテル・ハフツング Flying camera with a string assembly for positioning and interaction
KR20160081839A (en) * 2014-12-30 2016-07-08 계명대학교 산학협력단 Control apparatus of unmanned aerial vehicle and method using the same
JP2017052389A (en) * 2015-09-09 2017-03-16 公立大学法人会津大学 Drone and drone group
JP2017065467A (en) * 2015-09-30 2017-04-06 キヤノン株式会社 Drone and control method thereof
CN106707790A (en) * 2015-11-13 2017-05-24 成都飞机工业(集团)有限责任公司 Unmanned aerial vehicle nonlinear mathematical model building method
JP2018018398A (en) * 2016-07-29 2018-02-01 株式会社自律制御システム研究所 Adaptive control method, adaptive controller, and apparatus having the adaptive controller
WO2018020671A1 (en) * 2016-07-29 2018-02-01 株式会社ソニー・インタラクティブエンタテインメント Unmanned flying body and flight control method for unmanned flying body

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001039397A (en) * 1999-08-02 2001-02-13 Komatsu Ltd Flying body having horizontal rotary wing
JP2011246105A (en) * 2010-05-27 2011-12-08 Honeywell Internatl Inc Wind estimation for unmanned aerial vehicle
JP2015531718A (en) * 2012-08-17 2015-11-05 パースペクティヴ・ロボティクス・ゲゼルシャフト・ミト・ベシュレンクテル・ハフツング Flying camera with a string assembly for positioning and interaction
KR20160081839A (en) * 2014-12-30 2016-07-08 계명대학교 산학협력단 Control apparatus of unmanned aerial vehicle and method using the same
JP2017052389A (en) * 2015-09-09 2017-03-16 公立大学法人会津大学 Drone and drone group
JP2017065467A (en) * 2015-09-30 2017-04-06 キヤノン株式会社 Drone and control method thereof
CN106707790A (en) * 2015-11-13 2017-05-24 成都飞机工业(集团)有限责任公司 Unmanned aerial vehicle nonlinear mathematical model building method
JP2018018398A (en) * 2016-07-29 2018-02-01 株式会社自律制御システム研究所 Adaptive control method, adaptive controller, and apparatus having the adaptive controller
WO2018020671A1 (en) * 2016-07-29 2018-02-01 株式会社ソニー・インタラクティブエンタテインメント Unmanned flying body and flight control method for unmanned flying body

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7123457B1 (en) * 2022-03-30 2022-08-23 株式会社石川エナジーリサーチ flight device

Also Published As

Publication number Publication date
JP7119782B2 (en) 2022-08-17

Similar Documents

Publication Publication Date Title
EP3755624B1 (en) Thrust allocation for aerial vehicle
JP5061264B1 (en) Small attitude sensor
Hamel et al. Attitude estimation on SO [3] based on direct inertial measurements
Abeywardena et al. Improved state estimation in quadrotor mavs: A novel drift-free velocity estimator
CN104335128B (en) Method for controlling the rotor wing unmanned aerial vehicle of more rotors with crosswind and accelerometer estimation of deviation and compensation
WO2016074182A1 (en) Method and system for recycling motor power of movable object
JP6207003B2 (en) Aircraft system and aircraft control method
US20220155800A1 (en) Method and apparatus for yaw fusion and aircraft
Papachristos et al. Towards a high-end unmanned tri-tiltrotor: Design, modeling and hover control
JP2015024705A (en) Automatic landing/taking-off control method of small electric helicopter
JP2019113992A (en) Flight device, and method and program for controlling flight device
Magnussen et al. Experimental validation of a quaternion-based attitude estimation with direct input to a quadcopter control system
JP4617990B2 (en) Automatic flight control device, automatic flight control method, and automatic flight control program
Heng et al. A trajectory tracking LQR controller for a quadrotor: Design and experimental evaluation
JP6536042B2 (en) Flying body
Six et al. Identification of the propeller coefficients and dynamic parameters of a hovering quadrotor from flight data
Pebrianti et al. Autonomous hovering and landing of a quad-rotor micro aerial vehicle by means of on ground stereo vision system
Stingu et al. Design and implementation of a structured flight controller for a 6DoF quadrotor using quaternions
JP7119782B2 (en) flying object
US20190302804A1 (en) Inertial navigation system using all-accelerometer
TWI578124B (en) Multiple rotors aircraft and control method
Hetényi et al. Sensor fusion with enhanced Kalman Filter for altitude control of quadrotors
Rigter et al. An autonomous quadrotor system for robust high-speed flight through cluttered environments without GPS
Kis et al. Design and hardware-in-the-loop test of the embedded control system of an indoor quadrotor helicopter
CN108475066B (en) Unmanned aerial vehicle attitude calculation method, flight controller and unmanned aerial vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210402

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220317

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220405

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: 20220705

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220718

R151 Written notification of patent or utility model registration

Ref document number: 7119782

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151