WO2020045397A1 - Drone, method for controlling drone, and program for controlling drone - Google Patents

Abstract

[Problem] To provide a drone that can maintain high safety even during autonomous flying. [Solution] This drone is provided with: a body 110; rotors 101 that are respectively arranged at least in the front and rear of the body in an advancing direction; and propellers 102 that are connected to the respective rotors, wherein the gravity center 100g of the drone is set before the attitude rotational angle center point 100o of the drone. The drone can be configured such that, when the drone is tilted in the advancing direction during forward flying and is flying forward at a target flying speed, the gravity center is set vertically below the attitude rotational angle center point.

Description

Drone, drone control method, and drone control program

The present invention relates to a drone, a drone control method, and a drone control program.

Applications of small helicopters (multicopters) generally called drones are in progress. One of the important application fields is application of chemicals such as pesticides and liquid fertilizers to agricultural lands (fields) (for example, Patent Document 1). In Japan, where the agricultural land is smaller than in the United States and Europe, it is often more appropriate to use drones instead of manned airplanes and helicopters.

With technologies such as the quasi-zenith satellite system and the RTK-GPS (Real Time Kinematic-Global Positioning System), the drone can now accurately know its absolute position in centimeters while flying, and In the agricultural land of typical narrow and complicated terrain, the autonomous flight can be performed with minimal manual operation, and the medicine can be sprayed efficiently and accurately.

On the other hand, there were cases in which it was hard to say that safety considerations were sufficient for autonomous flight drones for spraying agricultural chemicals. Drones loaded with drugs weigh tens of kilograms, which can have serious consequences in the event of an accident, such as falling onto a person. In addition, the operator of the drone is usually not a specialist, so a fool-proof mechanism is required, but this has not been sufficiently considered. Until now, there was a drone safety technology that was premised on maneuvering (for example, Patent Document 2), but in particular, it addressed the safety issues unique to autonomous flight drones for agricultural chemical spraying The technology to do so did not exist.

Japanese Patent Laid-Open Publication No. 2001-120151 Patent Publication No. JP-A-2017-163265

To provide a drone that can maintain high security even during autonomous flight.

In order to achieve the above object, a drone according to one aspect of the present invention includes a main body, rotating blades respectively arranged at least in front of and in the traveling direction of the main body, and a propulsion device connected to the rotating blade. , Wherein the center of gravity of the drone is located ahead of the center point of the attitude rotation angle of the drone.

The drone may be inclined forward in the traveling direction during forward flight, and when traveling forward at the target flight speed, the center of gravity may be disposed vertically below the attitude rotation angle center point.

出力 The output of the propulsion device in front of the main body during forward flight may be configured to be smaller than the output during hovering.

ホ When the drone is hovering, the output of the propulsion device on the front side of the fuselage may be configured to be larger than the output of the propulsion device on the rear side.

The vehicle may further include a movable unit that moves components included in the drone in the forward and backward directions in accordance with the target flight speed.

The movable part may be configured to automatically move the part back and forth in the traveling direction when the target flight speed of the drone is changed.

The drone may be a multi-rotor type.

It is possible to provide a drone that can maintain high security even during autonomous flight.

It is a top view showing a 1st embodiment of the drone concerning the present invention. It is a front view of the said drone. It is a right view of the said drone. It is a rear view of the drone. It is a perspective view of the said drone. It is a whole conceptual diagram of the medicine spraying system which the above-mentioned drone has. It is a schematic diagram showing the control function of the drone. It is a typical longitudinal section showing only the fuselage, the rotor, and the motor, showing the position of the center of gravity of the drone, (a) a longitudinal section during hovering, and (b) a longitudinal section during forward flight. is there. Fig. 3 is a schematic longitudinal sectional view showing only a fuselage, a rotor and a motor, showing a position of a center of gravity of a drone of the related art, (a) a longitudinal sectional view during hovering, and (b) a longitudinal sectional view during forward flight. FIG. It is a graph which shows the electric current value of the said drone and the drone of related art during hovering and forward flight. It is a typical longitudinal section showing only the fuselage, the rotor, and the motor which show 2nd Embodiment of the drone which concerns on this invention.

<Drone 1>
Hereinafter, embodiments for implementing the present invention will be described with reference to the drawings. The figures are all examples. In the following detailed description, for purposes of explanation, certain specific details are set forth in order to provide a thorough understanding of the disclosed embodiments. However, embodiments are not limited to these specific details. In other instances, well-known structures and devices are shown schematically to simplify the drawings.

In the specification of the present application, the drone means any type of power means (electric power, prime mover, etc.) and any type of control (wireless or wired, autonomous flight type or manual control type, etc.) It refers to a general flying object having a plurality of rotors.

As shown in FIGS. 1 to 5, the rotating wings 101-1a, 101-1b, 101-2a, 101-2b, 101-3a, 101-3b, 101-4a, 101-4b (also called rotors) It is a means for flying the drone 100. Eight aircraft (four sets of two-stage rotors) are provided in consideration of the balance between flight stability, aircraft size, and battery consumption. Each rotary wing 101 is arranged on four sides of the main body 110 by an arm extending from the main body 110 of the drone 100. That is, the rotating blades 101-1a, 101-1b to the left rear in the traveling direction, the rotating blades 101-2a, 101-2b to the left front, the rotating blades 101-3a, 101-3b to the right rear, and the rotating blade 101- 4a and 101-4b are arranged respectively. The traveling direction of the drone 100 is downward in FIG. 1. The drone 100 does not move horizontally in a direction different from that of the nose 111. When traveling in another direction, the vehicle turns to advance the nose in the direction.

The motors 102-1a, 102-1b, 102-2a, 102-2b, 102-3a, 102-3b, 102-4a, 102-4b have rotating blades 101-1a, 101-1b, 101-2a, 101- 2b, means for rotating 101-3a, 101-3b, 101-4a, 101-4b (typically an electric motor but may be a motor, etc.), one for each rotor Have been. Motor 102 is an example of a propulsion device. The upper and lower rotors (eg, 101-1a and 101-1b) and their corresponding motors (eg, 102-1a and 102-1b) in one set are used for drone flight stability and the like. The axes are collinear and rotate in opposite directions. As shown in FIG. 2 and FIG. 3, the radial member for supporting the propeller guard provided so that the rotor does not interfere with the foreign matter is not horizontal but has a scalloped structure. This is to promote the member to buckle to the outside of the rotor at the time of collision and prevent the member from interfering with the rotor.

The medicine nozzles 103-1, 103-2, 103-3, and 103-4 are means for spraying the medicine downward and are provided with four units. In the specification of the present application, the term “drug” generally refers to a liquid or powder, such as a pesticide, a herbicide, a liquid fertilizer, a pesticide, a seed, and water, which is sprayed on a field.

The medicine tank 104 is a tank for storing the medicine to be sprayed, and is provided at a position close to the center of gravity of the drone 100 and lower than the center of gravity from the viewpoint of weight balance. The drug hoses 105-1, 105-2, 105-3, and 105-4 are means for connecting the drug tank 104 and each of the drug nozzles 103-1, 103-2, 103-3, and 103-4. And may also serve to support the drug nozzle. The pump 106 is a unit for discharging a medicine from a nozzle.

FIG. 4 shows an overall conceptual diagram of a system using an embodiment of the drone 100 according to the present invention for spraying medicine. This diagram is a schematic diagram, and the scale is not accurate. The pilot 401 transmits a command to the drone 100 by the operation of the user 402, and displays information received from the drone 100 (for example, a position, a medicine amount, a battery level, a camera image, and the like). Yes, and may be realized by a portable information device such as a general tablet terminal that runs a computer program. The drone 100 according to the present invention is controlled to perform an autonomous flight, but may be configured to be able to perform a manual operation at the time of basic operations such as takeoff and return, and in an emergency. In addition to the portable information device, an emergency operation device (not shown) having a function dedicated to emergency stop may be used (the emergency operation device has a large emergency stop button and the like so that an emergency operation device can quickly respond in an emergency. It may be a dedicated device provided with). The pilot 401 and the drone 100 perform wireless communication using Wi-Fi or the like.

The field 403 is a field or a field to which the drone 100 is to apply the medicine. Actually, the terrain of the field 403 is complicated, and there is a case where a topographic map cannot be obtained in advance, or a case where the topographic map differs from the situation of the site. Usually, the field 403 is adjacent to houses, hospitals, schools, other crop fields, roads, railways and the like. Further, an obstacle such as a building or an electric wire may exist in the field 403 in some cases.

The base station 404 is a device that provides a master device function or the like of Wi-Fi communication, also functions as an RTK-GPS base station, and may provide an accurate position of the drone 100 (Wi-Fi communication). The base station function of Fi communication and the RTK-GPS base station may be independent devices.) The farming cloud 405 is typically a group of computers and related software operated on a cloud service, and may be wirelessly connected to the controller 401 via a mobile phone line or the like. The farming cloud 405 may analyze the image of the field 403 captured by the drone 100, grasp the growing condition of the crop, and perform a process for determining a flight route. Further, the stored topographical information of the field 403 may be provided to the drone 100. In addition, the history of the flying and photographed images of the drone 100 may be accumulated, and various analysis processes may be performed.

Normally, the drone 100 takes off from the landing point 406 outside the field 403 and returns to the landing point 406 after spraying the medicine on the field 403 or when it becomes necessary to replenish or charge the medicine. The flight route (intrusion route) from the departure / arrival point 406 to the target field 403 may be stored in advance in the farming cloud 405 or the like, or may be input by the user 402 before the start of takeoff.

FIG. 6 is a block diagram showing the control function of the embodiment of the medicine spraying drone according to the present invention. The flight controller 501 is a component that controls the entire drone, and may specifically be an embedded computer including a CPU, a memory, related software, and the like. The flight controller 501 controls the motors 102-1a and 102-1b via control means such as ESC (Electronic Speed Control) based on input information received from the pilot 401 and input information obtained from various sensors described below. , 102-2a, 102-2b, 102-3a, 102-3b, 104-a, and 104-b to control the rotation speed of the drone 100. The actual rotation speeds of the motors 102-1a, 102-1b, 102-2a, 102-2b, 102-3a, 102-3b, 104-a, 104-b are fed back to the flight controller 501, and normal rotation is performed. It is configured to monitor whether it is running. Alternatively, the rotation wing 101 may be provided with an optical sensor or the like, and the rotation of the rotation wing 101 may be fed back to the flight controller 501.

The software used by the flight controller 501 can be rewritten through a storage medium or the like for function expansion / change, problem correction, or the like, or through communication means such as Wi-Fi communication or USB. In this case, protection by encryption, checksum, digital signature, virus check software, etc. is performed to prevent rewriting by unauthorized software. Further, part of the calculation processing used by the flight controller 501 for control may be executed by the control device 401, the farming cloud 405, or another computer existing in another place. Since the flight controller 501 is highly important, some or all of its components may be duplicated.

The battery 502 is a means for supplying power to the flight controller 501 and other components of the drone, and may be rechargeable. The battery 502 is connected to the flight controller 501 via a power supply unit including a fuse or a circuit breaker. The battery 502 may be a smart battery having a function of transmitting its internal state (power storage amount, accumulated use time, and the like) to the flight controller 501 in addition to a power supply function.

The flight controller 501 communicates with the pilot 401 via the Wi-Fi slave unit function 503 and further via the base station 404, receives necessary commands from the pilot 401, and transmits necessary information to the pilot Can be sent to 401. In this case, the communication may be encrypted so as to prevent eavesdropping, impersonation, hijacking of the device and the like. The base station 404 has a function of an RTK-GPS base station in addition to a communication function using Wi-Fi. By combining the signal from the RTK base station and the signal from the GPS positioning satellite, the GPS module 504 can measure the absolute position of the drone 100 with an accuracy of about several centimeters. The GPS modules 504 are of high importance and may be duplicated or multiplexed.Also, in order to cope with the failure of a specific GPS satellite, each redundant GPS module 504 uses a different satellite. It may be controlled.

The 6-axis gyro sensor 505 is a means for measuring accelerations of the drone body in three directions orthogonal to each other (further, a means for calculating a speed by integrating the accelerations). The six-axis gyro sensor 505 is means for measuring a change in the attitude angle of the drone body in the above three directions, that is, an angular velocity. The geomagnetic sensor 506 is means for measuring the direction of the drone body by measuring geomagnetism. The air pressure sensor 507 is a means for measuring the air pressure, and can also indirectly measure the altitude of the drone. The laser sensor 508 is a unit that measures the distance between the drone body and the ground surface using reflection of laser light, and may be an IR (infrared) laser. The sonar 509 is a unit that measures the distance between the drone body and the surface of the earth using reflection of sound waves such as ultrasonic waves. These sensors may be selected based on the cost objectives and performance requirements of the drone. In addition, a gyro sensor (angular velocity sensor) for measuring the inclination of the airframe, a wind sensor for measuring wind power, and the like may be added. Further, these sensors may be duplicated or multiplexed. When there are a plurality of sensors for the same purpose, the flight controller 501 may use only one of them, and when that causes a failure, it may be switched to an alternative sensor for use. Alternatively, a plurality of sensors may be used at the same time, and a failure may be considered to have occurred if the respective measurement results do not match.

The flow rate sensors 510 are means for measuring the flow rate of the medicine, and are provided at a plurality of locations on the path from the medicine tank 104 to the medicine nozzle 103. The liquid shortage sensor 511 is a sensor that detects that the amount of the medicine has become equal to or less than a predetermined amount. The multispectral camera 512 is a means for photographing the field 403 and acquiring data for image analysis. The obstacle detection camera 513 is a camera for detecting a drone obstacle, and is a device different from the multispectral camera 512 because the image characteristics and the lens direction are different from those of the multispectral camera 512. The switch 514 is a means for the user 402 of the drone 100 to perform various settings. The obstacle contact sensor 515 is a sensor for detecting that the drone 100, particularly its rotor or propeller guard, has contacted an obstacle such as an electric wire, a building, a human body, a tree, a bird, or another drone. . The cover sensor 516 is a sensor that detects that an operation panel of the drone 100 and a cover for internal maintenance are open. The drug inlet sensor 517 is a sensor that detects that the inlet of the drug tank 104 is open. These sensors may be selected or duplicated or multiplexed depending on the cost objectives and performance requirements of the drone. Further, a sensor may be provided in the base station 404, the pilot 401, or another place outside the drone 100, and the read information may be transmitted to the drone. For example, a wind sensor may be provided in the base station 404, and information on the wind and wind direction may be transmitted to the drone 100 via Wi-Fi communication.

The flight controller 501 transmits a control signal to the pump 106, and adjusts the medicine ejection amount and stops the medicine ejection. The current state of the pump 106 (for example, the number of revolutions) is fed back to the flight controller 501.

The LED 107 is display means for notifying the drone operator of the status of the drone. A display means such as a liquid crystal display may be used instead of or in addition to the LED. The buzzer 518 is an output unit for notifying a drone state (particularly an error state) by an audio signal. The Wi-Fi slave unit function 519 is an optional component for communicating with an external computer or the like for transferring software, for example, separately from the controller 401. Other wireless communication means such as infrared communication, Bluetooth (registered trademark), ZigBee (registered trademark), NFC, or wired communication means such as USB connection may be used instead of or in addition to the Wi-Fi slave unit function. May be used. The speaker 520 is an output unit that notifies a drone state (especially an error state) by a recorded human voice, a synthesized voice, or the like. Depending on the weather condition, the visual display of the drone 100 during flight may be difficult to see, and in such a case, voice communication is effective. The warning light 521 is a display means such as a strobe light for notifying a drone state (especially an error state). These input / output means may be selected according to the cost target and performance requirements of the drone, and may be duplicated / multiplexed.

The drone 100 flies forward while leaning forward in the direction of travel. Therefore, during forward flight, the rear side of the drone 100 needs to be held at a higher position than the front side.

As shown in FIG. 9A, the drone 200 of the related art is in a landing state or a hovering state (hereinafter, also referred to as a “horizontal state”) in which the heights of the respective rotors 202 of the drone 200 are equal. The center of gravity 200g of the drone 200 is disposed vertically below the attitude rotation angle center point 200o. The center of gravity 200 g is mainly determined by the position of the heavier battery or the drug tank among the components included in the main body 210. As shown in FIG. 9B, when the drone 200 flies forward, the center of gravity 200g moves rearward in the traveling direction from the attitude rotation angle center point 200o. The forward flight refers to a linear motion at a constant speed in the direction of the nose 211.

（As shown in FIG. 8A, in the drone 100 according to the present invention, in a horizontal state, the center of gravity 100g of the drone 100 is arranged ahead of the attitude rotation angle center point 100o in the traveling direction. As shown in FIG. 8B, when the drone 100 flies forward, the center of gravity 100g is disposed vertically below the attitude rotation angle center point 100o.

中 During forward flight, the center of gravity 100g may be located between ± 7% of the total length in the traveling direction from a vertical line passing through the attitude rotation angle center point 100o. Since the total length of the drone 100 in the traveling direction in this embodiment is about 180 cm and the total width is about 140 cm, the center of gravity 100 g is from -5 cm to the traveling direction from a vertical line passing the attitude rotation angle center point 100o. It will be located between +5 cm. When the center of gravity 100g is arranged in this range, for example, if the mass of the pesticide spraying drone sufficiently loaded with pesticides is 25 kg, the moment generated by the center of gravity 100 g in a horizontal state is 25 x 0.05 kg / m . According to the above-described configuration, even when the aircraft is temporarily tilted under the influence of the wind or the weight of the chemical tank 104 changes in the pesticide spraying drone and the position of the center of gravity changes, the moment generated by the center of gravity 100g also occurs. Is sufficiently small, which is preferable.

In the horizontal state, the angle θ formed between the center of gravity 100g of the drone 100 and the vertical direction about the attitude rotation angle center point 100o is the angle at which the drone 100 tilts forward with respect to the horizontal direction during forward flight at the target flight speed. It is almost equal to the angle to do. The target flight speed is a constant flight speed preset in the drone 100. The center of gravity 100g of the drone during forward flight at the target flight speed is arranged on a vertical line passing through the attitude rotation angle center point 100o.

前 The forward lean angle of the drone 100 during forward flight varies depending on the target flight speed. The higher the target flight speed, the larger the forward inclination angle. That is, the position of the center of gravity 100g in the horizontal state is located on the front side with respect to the traveling direction as the target flight speed is higher.

As shown in FIG. 10, the current flowing through the motor during flight As shown in FIG. , 202-4a, 202-4b, and the current flowing through the motors 202-1a, 202-1b, 202-3a, 202-3b on the rear side of the main body (hereinafter also referred to as "rear wing"). Are approximately equal. During forward flight, the current flowing through the rear wing motors 202-1a, 202-1b, 202-3a, and 202-3b is caused by the forward wing motors 202-2a, 202-2b, It is larger than the current flowing through 202-4a and 202-4b.

On the other hand, in the drone 100 according to the present embodiment, during hovering, as shown in FIG. 8A, the moment of gravity is generated in the forward leaning direction because the center of gravity 100g is in front of the attitude rotation angle center point 100o. Therefore, the front wing motors 102-2a, 102-2b, 102-4a, 102-4b require larger output than the rear wing motors 102-1a, 102-1b, 102-3a, 102-3b. . Therefore, as shown in FIG. 10, the current flowing to the front wing motors 102-2a, 102-2b, 102-4a, 102-4b during hovering is changed to the rear wing motors 102-1a, 102-1b, 102-b. It becomes larger than the current flowing through 3a and 102-3b.

As shown in FIG. 8B, during forward flight, the center of gravity 100g moves to the attitude rotation angle center point 100o in the forward leaning attitude, and the moment due to the deviation between the attitude rotation angle center point 100o and the gravity center 100g decreases. Therefore, the output of the front wing motors 102-2a, 102-2b, 102-4a, 102-4b is smaller than the output during hovering. As shown in FIG. 10, the currents flowing through the front wing motors 102-2a, 102-2b, 102-4a, 102-4b and the rear wing motors 102-1a, 102-1b, 102-3a, 102-3b. Is smaller than during hovering. In the present embodiment, the center of gravity 100g of the drone during forward flight at the target flight speed is arranged on a vertical line passing through the attitude rotation angle center point 100o, so that the two currents are equal.

As shown in FIG. 10, the sum of the currents flowing through the respective motors 102 of the drone 100 during hovering is larger than the sum of the currents of the drones 200 of the related art. On the other hand, during forward flight, the sum of the currents flowing through the respective motors 102 of the drone 100 is smaller than the sum of the currents of the drones 200 of the related art. Usually, the drone 100 for the purpose of spraying pesticides and monitoring the field, the time during forward flight is longer than the time during hovering, according to this configuration, from the takeoff of the drone 100 The total amount of power consumed before landing can be reduced as compared with the drone 200 of the related technology. The optimal flight speed of the drone 100 is predetermined to some extent. Therefore, especially in the case of industrial drones for which the purpose of flight is limited, the drone is designed so that the center of gravity of the drone is located at a position suitable for the target flight speed in advance, saving power consumption during flight with a simple configuration can do.

<Drone 2>
A second embodiment of the drone according to the present invention will be described focusing on parts different from the first embodiment described above. The drone according to the second embodiment is different from the first embodiment in that the drone further includes a movable unit that moves components included in the drone in the traveling direction in the front-rear direction according to the target flight speed. Note that the same components as those of the drone of the first embodiment will be described using the same reference numerals.

In FIG. 11, the movable parts 312a and 312b are members that move components included in the drone 300, in particular, at least one of the relatively important batteries 502 and the medicine tank 104 back and forth in the traveling direction. The member moved by the movable unit 312 may be a weight arranged for moving the center of gravity, but according to the configuration for moving the battery 502 and the medicine tank 104 arranged for other purposes, The center of gravity of the drone 300 can be moved without unnecessarily increasing the weight of the entire drone 300.

The movable section 312 may be manual or electric.
The manual movable portion 312 may be, for example, rails provided on the component side and the main body 310 side and fitted to each other, and can adjust the position of the component steplessly. The rail is provided with an appropriate lock mechanism for fixing the positional relationship between the component and the main body 310. Further, an appropriate click mechanism may be provided on the rail, and the rail may be configured to stay stepwise at any of predetermined positions. In particular, the position of the component may be configured to be switchable stepwise to a position corresponding to a target flight speed set in advance according to the purpose of flight. For example, in an industrial drone used for agriculture, a predetermined type of flight purpose such as pesticide spraying and monitoring is assumed. Therefore, before taking off of the drone 300, the operator changes the position of the part according to the purpose of flight. According to this configuration, the position of the center of gravity can be adjusted to a target flight speed with a simple configuration, and power consumption during forward flight can be saved.

The electric movable section 312 is, for example, an actuator. In this case, the flight controller of the drone 300 calculates the optimal center of gravity position according to the target flight speed included in the flight plan. The flight controller may store the relationship between the flight purpose and the target flight speed in advance, extract the flight purpose included in the flight plan, and derive the target flight speed based on the relationship. The flight plan is information including a route from takeoff to landing, a flight purpose, a flight speed, and operations of auxiliary devices such as the pump 106, sensors, and cameras during flight. The actuator moves the component based on the information on the position of the center of gravity. In the case of the electric movable part 312, even when the target flight speed is changed during the flight, the parts can be moved while continuing the flight. In the case of a medicine spray drone, the weight of the medicine tank 104 changes as the spraying of the medicine progresses, and the position of the center of gravity may change. Therefore, the components may be moved with the progress of the spraying of the medicine, so that the position of the center of gravity may be maintained at a fixed position.

In this description, the agricultural chemical spraying drone is described as an example, but the technical idea of the present invention is not limited to this, and can be applied to all flying vehicles having rotary wings. Particularly, a multi-rotor type flying body exhibits a high power saving effect.

(Technically remarkable effects of the present invention)
In the drone according to the present invention, high security can be maintained even during autonomous flight.

Claims (7)

Body and
Rotor blades respectively arranged at least forward and rearward in the traveling direction of the main body,
A propulsion device connected to each of the rotors,
A drone with
The center of gravity of the drone is disposed forward of the center point of the attitude rotation angle of the drone,
Drone.
The drone leans forward in the traveling direction during forward flight, and when traveling forward at the target flight speed, the center of gravity is disposed vertically below the attitude rotation angle center point.
The drone according to claim 1.
The output of the propulsion device on the front side of the main body during forward flight is smaller than the output during hovering,
The drone according to claim 1.
When hovering the drone, the output of the propulsion device on the front side of the fuselage of the drone is greater than the output of the propulsion device on the rear side.
The drone according to claim 1.
According to a target flight speed, further comprising a movable unit that moves the components included in the drone back and forth in the traveling direction,
The drone according to claim 1.
The movable unit, when the target flight speed of the drone is changed, automatically moves the part back and forth in the traveling direction,
The drone according to claim 5.
The drone according to claim 1, wherein the drone is a multi-rotor type.

Images