METHOD FOR CONTROLLING DRONE HAVING MULTI-DEGREE-OF-FREEDOM FLIGHT MODE

Abstract

Provided is a control method of a drone with a multiple DOF flight mode according to the present invention. The drone may include a fuselage in which a battery is mounted and a forward direction is set in an x-axis, a plurality of rotors disposed about the fuselage in four or more, each rotational axis of which is aligned in a z-axis direction, an x-axis tilting mechanism unit formed to tilt the plurality of rotors about an axis parallel to the x-axis, a y-axis tilting mechanism unit formed to tilt the plurality of rotors about an axis parallel to the y-axis, a first drive motor unit driving the y-axis tilting mechanism unit, a second drive motor unit guiding the x-axis tilting mechanism unit, and a control unit configured to implement a plurality of flight modes by controlling the first rotor, the second rotor, the third rotor, the fourth rotor, the first drive motor unit, and the second drive motor unit.

Description

TECHNICAL FIELD

The present invention relates to a control method of a drone with a multiple degree of freedom (DOF) flight mode.

BACKGROUND ART

A multi-rotor or multi-fan flight vehicle called a drone is a type of helicopter that typically has three or more rotors. The multi-rotor flight vehicle may fly while changing a torque and a speed of the rotors and may be easily maintained and manipulated, as compared with a traditional single-rotor helicopter. Due to these advantages and the rapid development of an electronic technology, the multi-rotor flight vehicle has been rapidly applied in various fields. In the past, military unmanned flight vehicles having a large size have been mainly used. However, recently, civil small unmanned flight vehicles have been mainly manufactured. The utilization of the small unmanned flight vehicles has variously increased from image photographing to transport of articles.

Among various types of small unmanned flight vehicles, multi-rotor flight vehicles, which are particularly referred to as a quad rotor, have many advantages over other flight vehicles. The biggest advantage is that a mechanical mechanism is very simple. In the case of the quad-rotor, a trim does not need to be adjusted before flight, a mechanical vibration is not large, and the possibility that a component will be damaged due to fatigue is low. In addition, since it is easy to mathematically model the quad-rotor due to a simple form, the quad-rotor is appropriate for automatic flight, and beginners may easily pilot the quad-rotor unlike other small flight vehicles requiring training for a long period of time in order to pilot the flight vehicles. Further, since the quad-rotor uses several small propellers, it is relatively safe for people unskilled in piloting or management. That is, everybody may easily pilot, maintain, repair, and manage the quad-rotor even though he/she does not have professional knowledge of a flight vehicle or is not more trained in advance. Due to these advantages of the quad-rotor, an influence of the quad-rotor among the civil small unmanned flight vehicles has gradually increased.

Research into control and induction fields of the quad-rotor has been conducted in advance by many researchers. First, in the control field, there was an attempt to directly control a non-linear system using a back-stepping method or a sliding model method or linearize a quad-rotor model using feedback linearization and then control the quad-rotor model, in order to effectively treat characteristics of a non-linear model of the quad-rotor. In addition, in the induction field, a flip operation for rotating a moving body of the quad-rotor by 360° or more in one side direction was performed or a rapid maneuver following a specific trajectory and attitude and an elaborate maneuver of exchanging a ball were enabled.

The multi-rotor flight vehicle such as the quad-rotor may be currently controlled and induced precisely due to a contribution of many researches, but still needs to be functionally improved. Considering the fact that an accurate position and attitude of a flight vehicle present on a three-dimensional space are represented by six variables, a multi-rotor flight vehicle system ultimately becomes an under-actuated system in which a dimension of an input is smaller than a dimension of an output. This factor acts as a limitation in the control and the induction of the multi-rotor flight vehicle. For example, a body of the multi-rotor flight vehicle should be necessarily inclined forward in order to accelerate the multi-rotor flight vehicle forward, and acceleration in a forward direction is not absolutely generated in a state in which the multi-rotor flight vehicle is inclined rearward. That is, it means that an attitude and an acceleration of the multi-rotor flight vehicle may not be completely independent from each other.

Therefore, in the case in which a camera is attached to the body of the multi-rotor flight vehicle to photograph a target, when the multi-rotor flight vehicle changes a direction, the body of the multi-rotor flight vehicle is also inclined, such that a photographing direction of the camera is out of the target to be photographed. In addition, since inclination of the entire multi-rotor flight vehicle is required at the time of changing the direction, responsibility is relatively low, such that a rapid maneuver is not easy. For this reason, a separate device capable of maintaining the camera according to the angle change of the fuselage is used, resulting in increasing the number of parts and costs, increasing the weight, and shortening the use time of the battery. In addition, since such a camera connection device is vulnerable to vibration, a separate dust absorption means is sometimes installed, which has a disadvantage in that the device becomes complicated as much.

RELATED PRIOR ART

Korean Patent Laid-Open Publication No. 10-2017-0061941 (published on Jun. 7, 2017)

Korean Patent Publication No. 10-1692315 (registered on Dec. 28, 2016)

DISCLOSURE

Technical Problem

An object of the present invention is to realize various flight modes by enabling a drone to stably have multiple DOF and maintain a shake-free state without the need to install a separate device for installing a camera.

Another object of the present invention is to minimize air resistance of a drone by reducing a difference between a heading angle of a fuselage part and a traveling speed of a drone.

Still another object of the present invention is to provide a maneuver for fixing a heading angle of a fuselage to a specific target point by adjusting a tilting angle of a rotor.

Still yet another object of the present invention is to provide a method of controlling a drone capable of performing various missions at an operator's discretion by allowing an angle of a fuselage to be freely manipulated regardless of a traveling direction of the drone.

Technical Solution

In one general aspect, a control method of a drone with a multiple DOF flight mode, in which the drone includes a fuselage in which a battery is mounted and a forward direction is set in an x-axis, a first rotor and a second rotor each having its rotational axis aligned in a z-axis direction, and disposed to face each other about the fuselage at a first position when viewed in an x-axis direction, a third rotor and a fourth rotor each having its rotational axis aligned in the z-axis direction and disposed to face each other in a y-axis direction at a second position of the fuselage when viewed in the x-axis direction, a first frame shaft rotatably supported with respect to the fuselage about a y1-axis parallel to the y-axis at the first position and supporting the first rotor and the second rotor by respective support shafts parallel to the x-axis at both end portions, a second frame shaft rotatably supported with respect to the fuselage about a y2-axis parallel to the y-axis at the second position and supporting the first rotor and the second rotor by respective support shafts parallel to the x-axis at both end portions, a third frame shaft disposed to be spaced apart from the first frame shaft in the z-axis direction by a plurality of first rod parts and formed to tilt the first rotor and the second rotor about each axis parallel to the x-axis while being moved by a force acting in parallel to the y-axis, a fourth frame shaft disposed to be spaced apart from the second frame shaft in the z-axis direction by a plurality of second rod parts and formed to tilt the third rotor and the fourth rotor about each axis parallel to the x-axis while being moved by a force acting in parallel to the y-axis, a first drive motor unit connected through a first conversion mechanism unit and providing a force to the third frame shaft and the fourth frame shaft in a direction parallel to the y-axis, a second drive motor unit connected through a second conversion mechanism unit and providing a force to rotate the first frame shaft and the second frame shaft about the y1-axis and the y2-axis, respectively, and a control unit configured to implement a plurality of flight modes by controlling the first rotor, the second rotor, the third rotor, the fourth rotor, the first drive motor unit, and the second drive motor unit, the control method including: setting speeds of the first to fourth rotors and tilting angles of the first to fourth rotors so that the drone flies according to an input value; obtaining a difference between a heading angle of the fuselage and a traveling speed of the drone in a trajectory; and reducing a difference between the heading angle and the traveling speed of the drone by changing the tilting angles of the first to fourth rotors when the difference between the heading angle of the fuselage and the traveling speed of the drone is greater than or equal to a reference value.

The control method may further include: receiving an input of a target orientation point; and changing the tilting angles of the first to fourth rotors so that the fuselage continues to face the target directing point by changing the heading angle of the fuselage while the drone moves along the trajectory.

The control method may further include: receiving an input to an arbitrary angle mode for the heading angle of the fuselage; receiving the tilting angles of the first to fourth rotors; and changing the heading angle of the fuselage by changing the tilting angles of the first to fourth rotors according to the input tilting angle.

The plurality of flight modes may include: a first flight mode in which both the first drive motor unit and the second drive motor unit are stopped and the speeds of the first to fourth rotors are individually controlled; and a second flight mode in which the first drive motor unit and the second drive motor unit are individually controlled and operated, and the speeds of the first to fourth rotors are individually controlled.

The first flight mode may include: a 1-1th flight mode in which the fuselage is tilted in the x-axis direction or the fuselage moves in the y-axis direction; a 1-2th flight mode in which the fuselage is tilted in the y-axis direction or the fuselage moves in the x-axis direction; a 1-3th flight mode in which the fuselage rotates about the z-axis; and a 1-4th flight mode in which the fuselage moves in the z-axis direction.

The second flight mode may include: a 2-1th flight mode in which the fuselage moves in the y-axis direction by maintaining the fuselage horizontally and tilting the first to fourth rotors about each axis parallel to the x-axis; a 2-2th flight mode in which the fuselage moves in the y-axis direction by maintaining the fuselage horizontally and tilting the first to fourth rotors about each axis parallel to the y-axis; a 2-3th flight mode in which the fuselage rotates about the z-axis by maintaining the fuselage horizontally and individually controlling the speeds of the first to fourth rotors; a 2-4th flight mode in which the fuselage rotates in the z-axis direction by maintaining the fuselage horizontally and individually controlling the speeds of the first to fourth rotors; a 2-5th flight mode in which the fuselage rotates about the x-axis by rotating the first to fourth rotors about each axis parallel to the x-axis; and a 2-6th flight mode in which the fuselage rotates about the y-axis by rotating the first to fourth rotors about each axis parallel to the y-axis.

The 2-5th flight mode may make each rotational axis of the first to fourth rotors parallel to the z-axis, and include a posture in which the fuselage is maintained in a tilted state with respect to a ground by rotating the fuselage about the x-axis.

The 2-6th flight mode may make each rotational axis of the first to fourth rotors parallel to the z-axis, and include a posture in which the fuselage is maintained in a tilted state with respect to a ground by rotating the fuselage about the y-axis.

In another general aspect, a control method of a drone with a multiple DOF flight mode, in which the drone includes a fuselage in which a battery is mounted and a forward direction is set in an x-axis, a plurality of rotors disposed about the fuselage in four or more, each rotational axis of which is aligned in a z-axis direction, an x-axis tilting mechanism unit formed to tilt the plurality of rotors about an axis parallel to the x-axis, a y-axis tilting mechanism unit formed to tilt the plurality of rotors about an axis parallel to the y-axis, a first drive motor unit driving the y-axis tilting mechanism unit, a second drive motor unit driving the x-axis tilting mechanism unit, and a control unit configured to implement a plurality of flight modes by controlling the first rotor, the second rotor, the third rotor, the fourth rotor, the first drive motor unit, and the second drive motor unit, the control method including: setting speeds of the first to fourth rotors and tilting angles of the first to fourth rotors so that the drone flies according to an input value; obtaining a difference between a heading angle of the fuselage and a traveling speed of the drone in a trajectory; and reducing a difference between the heading angle and the traveling speed of the drone by changing the tilting angles of the first to fourth rotors when the difference between the heading angle of the fuselage and the traveling speed of the drone is greater than or equal to a reference value.

Advantageous Effects

According to a drone with multiple DOF flight mode related to the present invention, a plurality of rotors are configured so that they may be tilted independently about an x-axis and a y-axis, and even when a rotor rotates or an attitude or speed of the rotor changes, a main body may maintain a posture as it is or may be set to a desired specific posture, thereby realizing various flights.

According to an example related to the present invention, it is possible to realize a first flight mode having 4 DOF by individually controlling speeds of a plurality of rotors, and a second flight mode having 6 DOF by tilting the plurality of rotors in x-axis and y-axis directions.

According to an example related to the present invention, by obtaining a difference between a heading angle of a fuselage and a speed of a drone in a trajectory of the drone in a state in which speeds and tilting angles of first to fourth rotors are set according to an input, and changing the tilting angles of the first to fourth rotors when the different is greater than or equal to a reference value to reduce the difference between the heading angle of the fuselage and the traveling speed of the drone, it is possible to minimize air resistance of the drone.

According to an example related to the present invention, by changing a heading angle of a fuselage while a drone moves along a trajectory to change and control tilting angles of first to fourth rotors so that the fuselage continues to face a target directing point, it is possible to enable a variety of missions to be performed in single or group flights.

According to another example related to the present invention, by allowing a drone to freely control an angle of a fuselage regardless of a traveling direction of the drone while moving along a specific trajectory, it is possible to perform various missions at an operator's discretion.

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a perspective view of a drone 100 according to an example related to the present invention.

FIG. 2 is a perspective view illustrating a state in which a housing 111 is separated from the drone 100 of FIG. 1.

FIG. 3 is a perspective view of the drone 100 of FIG. 2 viewed from the bottom.

FIG. 4 is a perspective view illustrating a state in which a plurality of rotors are tilted about a y-axis in the state of FIG. 2.

FIG. 5 is a perspective view illustrating a state in which the plurality of rotors are tilted about an x-axis in the state of FIG. 2.

FIG. 6 is a perspective view illustrating a state in which the plurality of rotors are tilted about the x-axis and y-axis in the state of FIG. 2.

FIGS. 7 to 13 are diagrams illustrating a posture according to a first flight mode of a drone 200 related to the present invention.

FIG. 7 is a view illustrating a hovering state;

FIGS. 8 and 9 are diagrams illustrating that the drone moves forward and backward (x-axis direction) and rotates about the y-axis,

FIGS. 10 and 11 are diagrams illustrating that the drone moves left and right (y-axis direction) and rotates about the x-axis,

FIG. 12 is a diagram illustrating the concept of moving a drone in a z-axis direction.

FIG. 13 is a diagram illustrating that the drone rotates about the z-axis.

FIGS. 14 to 17 are diagrams illustrating postures that are not common with the first flight mode among postures according to a second flight mode of the drone 200 related to the present invention.

FIG. 14 is a diagram illustrating that the drone moves forward and backward.

FIG. 15 is a diagram illustrating that the drone moves left and right.

FIG. 16 is a diagram illustrating that the fuselage rotates about the x-axis.

FIG. 17 is a diagram illustrating that the fuselage rotates about the y-axis.

FIGS. 18 to 22 are diagrams for describing various flight modes and their control methods related to the present invention.

BEST MODE

Hereinafter, a control method of a drone with a multiple degree of freedom (DOF) flight mode related to the present invention will be described in detail with reference to the accompanying drawings. Throughout the present disclosure, components that are the same as or similar to each other will be denoted by reference numerals that are the same as or similar to each other and a description therefor will be replaced by the first description, in different exemplary embodiments.

According to FIG. 1, a drone 100 with multiple DOF flight mode related to the present invention includes a fuselage 110 in the middle and a plurality of rotors 121, 122, 123, and 124 disposed around the fuselage 110. To support the rotors 121, 122, 123, and 124, a first frame shaft 131, a second frame shaft 132, a third frame shaft 133, and a fourth frame shaft 134 are installed in a fuselage 110.

When a coordinate system is defined for convenience for explanation, the fuselage 110 is placed in an x-axis direction, which is a front-back direction, a left-right direction of the fuselage 110 is a y-axis direction, and an up-down direction of the fuselage 110 is a z-axis direction. The rotors 121, 122, 123, and 124 each have its rotational axes aligned in the z-axis direction.

A plurality of rotors may be arranged in pairs at a plurality of locations along the fuselage 110 (x-axis direction). FIG. 1 illustrates one such example, in which two pairs are arranged. That is, the first rotor 121 and the second rotor 122 form a pair at the rear end of the fuselage 110, and the third rotor 123 and the fourth rotor 124 forms one pair at the front end of the fuselage 110. The first rotor 121 and the second rotor 122 are supported by the first frame shaft 131 and the third frame shaft 133, and the third rotor 123 and the fourth rotor 124 are supported by the second frame shaft 132 and the fourth frame shaft 134.

The plurality of rotors 121, 122, 123, and 124 are supported by respective support shafts 136, 137, 138, and 139 parallel to the x-axis. The support shafts 136, 137, 138, and 139 are installation spaces for cables that supply power to each rotor, and also serve as primary support points for tilting the rotors 121, 122, 123, and 124 by control.

The fuselage 110 may have a form in which internal parts are covered by the housing 111. A camera 112 may be disposed in front of the fuselage 110. As illustrated in FIG. 2, the camera 112 is directly installed on a board, and does not use elements such as a separate gimbal in order to reduce shaking. As will be described later, this is due to the fact that the shaking of the camera 112 is reduced and the camera 112 can be accurately and easily directed in a desired direction by the configuration and flight mode of the drone related to the present invention.

As illustrated in FIG. 2, a battery 113 for supplying power to components is disposed in the fuselage 110. In order to reduce the power consumption of the battery 113 and increase the flight time, the present invention omitted the arrangement of the gimbal and additional parts as described above and reduced the weight as much.

The plurality of frame shafts 131, 132, 133, and 134 for supporting the plurality of rotors 121, 122, 123, and 124 are formed to be a structure in which both “fixing” and “tilting” of the rotors are possible. To this end, as an example, the plurality of frame shafts includes a first frame shaft 131 that is rotatably supported with respect to the fuselage 110 about a y1 axis parallel to the y-axis at the rear end of the fuselage 110, a second frame shaft 132 that is rotatably supported with respect to the fuselage 110 about a y2 axis parallel to the y-axis at the front end of the fuselage 110, a third frame shaft 133 that is disposed spaced apart from the first frame shaft 131 in the z-axis direction by a plurality of first rod parts 141 and 142, and a fourth frame shaft 134 that is disposed spaced apart from the second frame shaft 132 in the z-axis direction by a plurality of second rod parts 143 and 144. That is, the first frame shaft 131 and the second frame shaft 132 are rotatably supported in the y-axis direction with respect to the fuselage 110, and the third frame shaft 133 and the fourth frame shaft 134 are not fixed with respect to the fuselage 110, but move by a driving force in a state of being constrained with respect to the first frame shaft 131 and the second frame shaft 132 by the respective rod parts 141, 142, 143, and 144. In this example, the third frame shaft 133 and the fourth frame shaft 134 move in the y-axis direction and serve to rotate support shafts 136, 137, 138, and 139, which primarily support the plurality of rotors 121, 122, 123, and 124 about each axis parallel to the x-axis.

A first conversion mechanism unit is provided to drive the third frame shaft 133 and the fourth frame shaft 134, and the first conversion mechanism unit receives a driving force of the first drive motor unit 150 and converts the received driving force into a force for moving the third frame shaft 133 and the fourth frame shaft 134 in a direction parallel to the y-axis. However, since the third frame shaft 133 and the fourth frame shaft 134 are constrained by the first rod parts 141 and 142, they move in a direction of turning around an x1 axis and an x2 axis, which are relatively parallel to the x-axis, respectively, with respect to the first frame shaft 131 and the second frame shaft 132. The first conversion mechanism unit includes a first transmission rod 151 so as to transmit the driving force of the first drive motor unit 150 to the third frame shaft 133 and the fourth frame shaft 134 at the same time. The first transmission rod 151 extends in the x-axis direction and simultaneously moves the third frame shaft 133 and the fourth frame shaft 134 in the y-axis direction by rotating the link members at opposite end portions while rotating by the rotational force transmitted from the first drive motor unit 150.

As illustrated in FIG. 3, the first frame shaft 131 and the second frame shaft 132 are connected by a second conversion mechanism unit, and the second conversion mechanism unit is connected by a second drive motor unit 160 to transmit the rotational force of the second drive motor unit 160 to rotate the first frame shaft 131 and the second frame shaft 132 about respective rotational axes y1 and y2. The second conversion mechanism unit includes a second transmission rod 161 formed to transmit the driving force of the second drive motor unit 160 to the first frame shaft 131 and the second frame shaft 132 at the same time. The second transmission rod 161 also extends in the x-axis direction, but moves in the x-axis direction by receiving the driving force of the second drive motor unit 160, so the second transmission rod 161 provides a torque to the first frame shaft 131 and the second frame shaft 132.

The operation of such a configuration will be described with reference to FIGS. 4 to 6. FIG. 4 illustrates that the second transmission rod 161 moves in the x-axis direction by the driving force of the second drive motor unit 160 to rotate the first frame shaft 131 and the second frame shaft 132, so the first rotor 121 and the second rotor 122 rotates about the y1 axis, and the third rotor 123 and the fourth rotor 124 rotates about the y2 axis, respectively. The tilting of the plurality of rotors 121, 122, 123, and 124 in the y-axis direction causes a change in angle with respect to the fuselage 110, and the thrust of the rotors 121, 122, 123, and 124 tilts the fuselage 110 in the y-axis direction as well.

FIG. 5 illustrates that the first transmission rod 151 rotates about the x-axis by the driving force of the first drive motor unit 150 to move the third frame shaft 133 and the fourth frame shaft 134 in the y-axis direction, so, the support shafts 136, 137, 138, and 139 supporting the rotors 121, 122, 123, and 124 rotate in the x1 and x2 axis directions, respectively, and the rotors 121, 122, 123, and 124 also rotate in the x1 and x2 directions. The tilting of the rotors 121, 122, 123, and 124 induces the fuselage 110 to tilt about the x-axis (tilted to the left or right) or move in the direction of the y-axis (move to the left or right).

FIG. 6 illustrates the results of tilting all the rotors 121, 122, 123, and 124 in the x-axis and the y-axis, respectively, by the action of both the first drive motor unit 150 and the second drive motor unit 160. The tilting of these rotors 121, 122, 123, and 124 move or tilt the fuselage 110 in a diagonal direction.

The drone 100 with multiple DOF related to the present invention includes a control unit that controls the rotors 121, 122, 123, and 124 and the first drive motor unit 150 and the second drive motor unit 160 to implement multiple flight modes. The control unit controls the speeds of the rotors 121, 122, 123, and 124 or controls the operation or rotation angle of the first drive motor unit 150 and the second drive motor unit 160, thereby precisely adjusting the tilting of the rotors 121, 122, 123, and 124. The fuselage 110 is installed with a wireless communication module for communicating with a remote controller on the ground, and the control unit realizes the flight mode according to the input signal.

Hereinafter, the flight mode by the drone 200 with multiple DOF related to the present invention will be described below with reference to FIG. 7 Rotors 221, 222, 223, and 224 in these drawings correspond to the rotors 121, 122, 123, and 124 described above, and elements capable of supporting or tilting these rotors 221, 222, 223, and 224 are also the same as the previous configuration. However, it has been simplified and expressed for convenience of understanding.

A plurality of flight modes by the drone 200 with multiple DOF related to the present invention may include a 4 degree of freedom (DOF) mode and a 6 DOF mode. These 4 DOF mode and 6 DOF mode may be implemented independently or, in some cases, may be implemented simultaneously.

FIGS. 7 to 13 are diagrams illustrating a posture according to a first flight mode of the drone 200 related to the present invention.

FIG. 7 conceptually illustrates a rotational state of the rotors 221, 222, 223, and 224 for forming a hovering state. That is, in order for the fuselage 210 of the drone to hover stably, the rotational directions of the diagonally facing rotors 221, 222, 223, and 224 need to match, and the rotors located side by side have opposite directions to each other. When the magnitude of the rotational speed of the rotors 221, 222, 223, and 224 is the same, the fuselage 210 may be kept level, and when the magnitude of the thrust due to the rotation of the rotor matches that of the gravity of the drone 200, the drone 200 may stably perform hovering, which is a maneuver to stop in the air. The rotors 221, 222, 223, and 224 of the drone 200 of the present example for hovering are controlled by motor speed without separate tilting.

FIGS. 8 and 9 show the relationship between the rotational speeds of the rotors 221, 222, 223, and 224 for the drone 200 to move forward and backward (x direction). That is, in order for the drone 200 to move forward and backward, the angle of the fuselage 210 needs to be tilted forward and backward to change the direction of the thrust. To this end, the fuselage 210 of the drone 200 tilts forward by slowing the rotation speeds of the third rotor 223 and the fourth rotor 224 at the front and increasing the speeds of the first rotor 221 and the second rotor 222 at the rear, so the thrust is directed to the rear of the fuselage 210, so the drone 200 moves forward.

FIGS. 10 and 11 are diagrams illustrating that the drone moves left and right (y-axis direction) and rotates about the x-axis. That is, in order for the drone 200 to move left and right, the angle of the fuselage 210 needs to be tilted left and right to change the direction of the thrust. To this end, the fuselage 210 of the drone 200 tilts to the right by slowing the rotation speeds of the second rotor 222 and the fourth rotor 224 and increasing the speeds of the first rotor 221 and the third rotor 223, so the thrust is directed to the left of the fuselage 210, so the drone 200 moves to the right.

FIG. 12 is a diagram illustrating the concept of moving the drone in the z-axis direction, and the vertical movement of the drone 200 is the same as the principle of hovering. When the rotational speeds of the rotors 221, 222, 223, and 224 equally increase in the state in which the magnitudes of the rotational speeds of the rotors 221, 222, 223, and 224 all match, the altitude rises while the fuselage remains level (FIG. 12A), and conversely, when the rotational speeds of the rotors 221, 222, 223, and 224 are equally reduced, the thrust is reduced, so the altitude drops while the fuselage remains level (FIG. 12B).

FIG. 13 is a diagram illustrating that the drone rotates about the z-axis. In order to rotate the drone 200 in the z-axis direction, the rotational speed of the rotors that rotate in the z-axis direction and diagonally face each other is lowered at a constant rate, and the rotational speeds of the remaining rotors rotating in the opposite direction to the z-axis increase by the same rate. According to Newton's law of action and reaction, if the sum of rotation vectors in the z-axis direction of the rotors 221, 222, 223, and 224 is greater than 0, the fuselage rotates in the opposite direction to the z-axis due to the reaction.

FIGS. 14 to 17 are diagrams illustrating postures that are not common with the first flight mode among postures according to a second flight mode of the drone 200 related to the present invention. Even in the 6 DOF flight mode, the hovering, the z-axis rotation, the rise and drop may be implemented similarly to the previously described 4 DOF flight mode. In this example, descriptions will be made based on the form that may not be implemented in the 4 DOF flight mode.

FIG. 14 is a diagram illustrating that the drone moves forward and backward, That is, in order to move the drone 200 forward and backward, the rotors 221, 222, 223, and 224 are tilted forward while maintaining hovering (referring to tilting by rotating about the y-axis). In this case, the mechanism for maintaining the fuselage 210 horizontally is similar to when hovering.

FIG. 15 is a diagram illustrating that the drone moves left and right. That is, in order to move the drone 200 left and right, the rotors 221, 222, 223, and 224 are tilted left and right while maintaining the hovering (referring to tilting by rotating about the x-axis). In this case, the mechanism for maintaining the fuselage 210 horizontally is similar to when hovering.

FIG. 16 is a diagram illustrating that the fuselage rotates about the x-axis, That is, in order to tilt the fuselage 210 about the x-axis while hovering, when the rotational speeds of the second rotor 222 and the fourth rotor 224 on the right increase, and the rotational speeds of the first rotor 221 and the third rotor 223 on the left decrease, the fuselage 210 of the drone 200 rotates about the x-axis.

When the fuselage 210 rotates, the direction of the thrust changes while the rotors 221, 222, 223, and 224 also rotate in the same direction, so the fuselage 210 moves. To compensate for this, the angles of the rotors 221, 222, 223, and 224 may change by the same amount in the direction opposite to the direction in which the fuselage 210 rotates.

FIG. 17 is a diagram illustrating that the fuselage rotates about the y-axis, That is, in order to tilt the fuselage 210 about the y-axis while hovering, when the rotational speeds of the third rotor 223 and the fourth rotor 224 at the front increase, and the rotational speeds of the first rotor 221 and the second rotor 222 at the rear decrease, the fuselage 210 of the drone 200 rotates about the y-axis.

Similar to FIG. 16, when the fuselage 210 rotates, the direction of the thrust changes while the rotors 221, 222, 223, and 224 also rotate in the same direction, so the fuselage 210 moves. To compensate for this, the angles of the rotors 221, 222, 223, and 224 may change by the same amount in the direction opposite to the direction in which the fuselage 210 rotates.

FIG. 18 is a diagram for describing a control method of the drone 300 in a 4 DOF flight mode. In this example, a flight mode is illustrated in which the drone is controlled using only the rotational speed of the rotor (propeller) like conventional drones without adjusting the motor angle by the drive motor units 150 and 160 described above. In order to secure the thrust, the angle of the drone fuselage 310 is tilted forward with respect to the direction in which the fuselage 310 is moving forward. Due to the tilting, not only does the fuselage receive a large amount of air resistance, but it also receives a downforce that presses it to the floor, so the flight efficiency is lowered. In this case, when a fixed camera is mounted on the fuselage 310, since the line of sight of the camera is shaken according to the angle of the fuselage 310, so shooting may be difficult.

FIG. 19 is a diagram for describing a control method in a horizontal flight mode using the drone 300 related to the present invention.

The flight mode of this example is a mode in which the fuselage 310 of the drone 300 is always maintained horizontally with the ground, thereby improving the sensing performance of the sensor and navigating the fuselage 310 stably. In order to secure the thrust, only the directions of the rotors 321, 322, 323, and 324 are tilted in the traveling direction without needing to tilt the angle of the drone fuselage 310 in the forward direction. Since there is no tilt of the fuselage 310, the air resistance is small, and the flight efficiency is greatly improved. When the camera is mounted on the fuselage 310, since the line of sight of the camera always forms a certain angle, stable shooting is possible. When a person gets on board, the fuselage 310 can always be kept level, so flight comfort may be greatly improved.

FIG. 20 is a diagram for describing a control method in an efficient flight mode using the drone 300 related to the present invention. The flight mode of this example is a flight mode that minimizes the air resistance received when the drone moves forward by setting the heading angle of the fuselage 310 of the drone 300 in the same direction as the traveling speed of the drone 300. To this end, first, the speeds and tilt angles of the rotors 321, 322, 323, and 324 are set so that the drone 300 may fly according to the input value. The difference between the heading angle of the fuselage 310 and the traveling speed (vector) of the drone 300 in a pre-specified or adjusted trajectory is obtained. In this case, when the difference between the heading angle of the fuselage 310 and the traveling speed of the drone 300 is greater than or equal to the reference value, the tilting angles of the rotors 321, 322, 323, and 324 change to reduce the difference between the heading angle of the fuselage 310 and the traveling speed of the drone 300, thereby minimizing the air resistance of the drone 300. That is, in order to secure the thrust, not only the angle of the fuselage 310 matches the forward direction, but also the directions of the rotors 321, 322, 323 and 324 are tilted in the forward direction. Since the speed of the fuselage 310 and the posture of the fuselage 310 match, the air resistance may be minimized, and thus, the flight efficiency is maximized. When the fixed camera is mounted on the fuselage 310, since the line of sight of the camera always follows the same direction as the traveling speed of the drone, the restrictions on shooting due to the shaking or change of direction are minimized, so stable shooting results may be obtained. As a result, the most efficient and fastest maneuvers are possible.

FIG. 21 is a diagram for describing a control method in a focusing flight mode using the drone 300 related to the present invention. The flight mode in this example is a flight mode that may efficiently cope with performance of various missions by moving the fuselage 310 while the heading angle of the fuselage 310 is fixed to a specific target intended by an operator. That is, since the heading of the fuselage 310 may be fixed to a certain target regardless of the traveling direction of the drone 300, it is suitable to perform various missions. When firearms are mounted, it is possible to shoot down a target and greatly increase an operating range of various sensors (camera, lidar, radar). As another application, it may be used as the most optimized mode for video shooting.

FIG. 22 is a diagram for describing a control method in an extreme flight mode using the drone 300 related to the present invention. The flight mode in this example is a flight mode in which the angle of the fuselage 310 may be freely controlled regardless of the traveling direction of the drone 300, so an operator may arbitrarily control the posture suitable for performing various missions. That is, the control method of the present example includes receiving an input to an arbitrary angle mode for the heading angle of the fuselage 310, receiving the tilt angles of the rotors 321, 322, 323, and 324, and changing the heading angle of the fuselage 310 by changing the tilting angles of the rotors 321, 322, 323, and 324 according to the input tilting angle Through this, it is possible to break away from standardized flight and perform various missions (drilling, drawing, sculpting, etc.) and maximize the use range of the drone. In addition, it may support a flip function or the like that rotates more than 360° in place, and maximizes the joy of operating by implementing the ultimate flight mode of drone operation. This mode is a mode suitable for shooting dramatic images.

The control method of a drone with a multiple DOF flight mode described above is not limited to the configuration and method of the described embodiments. All or some of the respective exemplary embodiments may be selectively combined with each other so that the above-mentioned exemplary embodiments may be variously modified.

Claims

1. A control method of a drone with a multiple DOF flight mode, the drone including a fuselage in which a battery is mounted and a forward direction is set in an x-axis,a first rotor and a second rotor each having its rotational axis aligned in a z-axis direction, and disposed to face each other about the fuselage at a first position when viewed in an x-axis direction,a third rotor and a fourth rotor each having its rotational axis aligned in the z-axis direction and disposed to face each other in a y-axis direction at a second position of the fuselage when viewed in the x-axis direction,a first frame shaft rotatably supported with respect to the fuselage about a y1-axis parallel to the y-axis at the first position and supporting the first rotor and the second rotor by respective support shafts parallel to the x-axis at both end portions,a second frame shaft rotatably supported with respect to the fuselage about a y2-axis parallel to the y-axis at the second position and supporting the first rotor and the second rotor by respective support shafts parallel to the x-axis at both end portions,a third frame shaft disposed to be spaced apart from the first frame shaft in the z-axis direction by a plurality of first rod parts and formed to tilt the first rotor and the second rotor about each axis parallel to the x-axis while being moved by a force acting in parallel to the y-axis,a fourth frame shaft disposed to be spaced apart from the second frame shaft in the z-axis direction by a plurality of second rod parts and formed to tilt the third rotor and the fourth rotor about each axis parallel to the x-axis while being moved by a force acting in parallel to the y-axis,a first drive motor unit connected through a first conversion mechanism unit and providing a force to the third frame shaft and the fourth frame shaft in a direction parallel to the y-axis,a second drive motor unit connected through a second conversion mechanism unit and providing a force to rotate the first frame shaft and the second frame shaft about the y1-axis and the y2-axis, respectively, anda control unit configured to implement a plurality of flight modes by controlling the first rotor, the second rotor, the third rotor, the fourth rotor, the first drive motor unit, and the second drive motor unit,

2. The control method of claim 1, further comprising: receiving an input of a target orientation point; andchanging the tilting angles of the first to fourth rotors so that the fuselage continues to face the target directing point by changing the heading angle of the fuselage while the drone moves along the trajectory.

3. The control method of claim 1, further comprising: receiving an input to an arbitrary angle mode for the heading angle of the fuselage;receiving the tilting angles of the first to fourth rotors; andchanging the heading angle of the fuselage by changing the tilting angles of the first to fourth rotors according to the input tilting angle.

4. The control method of claim 1, wherein the plurality of flight modes include: a first flight mode in which both the first drive motor unit and the second drive motor unit are stopped and the speeds of the first to fourth rotors are individually controlled; anda second flight mode in which the first drive motor unit and the second drive motor unit are individually controlled and operated, and the speeds of the first to fourth rotors are individually controlled.

5. The control method of claim 4, wherein the first flight mode includes: a 1-1th flight mode in which the fuselage is tilted in the x-axis direction or the fuselage moves in the y-axis direction;a 1-2th flight mode in which the fuselage is tilted in the y-axis direction or the fuselage moves in the x-axis direction;a 1-3th flight mode in which the fuselage rotates about the z-axis; anda 1-4th flight mode in which the fuselage moves in the z-axis direction.

6. The control method of claim 4, wherein the second flight mode includes: a 2-1th flight mode in which the fuselage moves in the y-axis direction by maintaining the fuselage horizontally and tilting the first to fourth rotors about each axis parallel to the x-axis;a 2-2th flight mode in which the fuselage moves in the y-axis direction by maintaining the fuselage horizontally and tilting the first to fourth rotors about each axis parallel to the y-axis;a 2-3th flight mode in which the fuselage rotates about the z-axis by maintaining the fuselage horizontally and individually controlling the speeds of the first to fourth rotors;a 2-4th flight mode in which the fuselage rotates in the z-axis direction by maintaining the fuselage horizontally and individually controlling the speeds of the first to fourth rotors;a 2-5th flight mode in which the fuselage rotates about the x-axis by rotating the first to fourth rotors about each axis parallel to the x-axis; anda 2-6th flight mode in which the fuselage rotates about the y-axis by rotating the first to fourth rotors about each axis parallel to the y-axis.

7. The control method of claim 6, wherein the 2-5th flight mode makes each rotational axis of the first to fourth rotors parallel to the z-axis, and includes a posture in which the fuselage is maintained in a tilted state with respect to a ground by rotating the fuselage about the x-axis.

8. The control method of claim 6, wherein the 2-6th flight mode makes each rotational axis of the first to fourth rotors parallel to the z-axis, and includes a posture in which the fuselage is maintained in a tilted state with respect to a ground by rotating the fuselage about the y-axis.

9. A control method of a drone with a multiple DOF flight mode, the drone including a fuselage in which a battery is mounted and a forward direction is set in an x-axis,a plurality of rotors disposed about the fuselage in four or more, each rotational axis of which is aligned in a z-axis direction,an x-axis tilting mechanism unit formed to tilt the plurality of rotors about an axis parallel to the x-axis, a y-axis tilting mechanism unit formed to tilt the plurality of rotors about an axis parallel to the y-axis, a first drive motor unit driving the y-axis tilting mechanism unit,a second drive motor unit driving the x-axis tilting mechanism unit, anda control unit configured to implement a plurality of flight modes by controlling the first rotor, the second rotor, the third rotor, the fourth rotor, the first drive motor unit, and the second drive motor unit,the control method comprising:setting speeds of the first to fourth rotors and tilting angles of the first to fourth rotors so that the drone flies according to an input value;obtaining a difference between a heading angle of the fuselage and a traveling speed of the drone in a trajectory; andreducing a difference between the heading angle and the traveling speed of the drone by changing the tilting angles of the first to fourth rotors when the difference between the heading angle of the fuselage and the traveling speed of the drone is greater than or equal to a reference value.

10. The control method of claim 9, further comprising: receiving an input of a target orientation point; andchanging the tilting angles of the first to fourth rotors so that the fuselage continues to face the target directing point by changing the heading angle of the fuselage while the drone moves along the trajectory.

11. The control method of claim 9, further comprising: receiving an input to an arbitrary angle mode for the heading angle of the fuselage;receiving the tilting angles of the first to fourth rotors; andchanging the heading angle of the fuselage by changing the tilting angles of the first to fourth rotors according to the input tilting angle.

12. The control method of claim 9, wherein the plurality of flight modes include: a first flight mode in which both the first drive motor unit and the second drive motor unit are stopped and the speeds of the first to fourth rotors are individually controlled; anda second flight mode in which the first drive motor unit and the second drive motor unit are individually controlled and operated, and the speeds of the first to fourth rotors are individually controlled.

13. The control method of claim 12, wherein the first flight mode includes: a 1-1th flight mode in which the fuselage is tilted in the x-axis direction or the fuselage moves in the y-axis direction;a 1-2th flight mode in which the fuselage is tilted in the y-axis direction or the fuselage moves in the x-axis direction;a 1-3th flight mode in which the fuselage rotates about the z-axis; anda 1-4th flight mode in which the fuselage moves in the z-axis direction.

14. The control method of claim 12, wherein the second flight mode includes: a 2-1th flight mode in which the fuselage moves in the y-axis direction by maintaining the fuselage horizontally and tilting the first to fourth rotors about each axis parallel to the x-axis;a 2-2th flight mode in which the fuselage moves in the y-axis direction by maintaining the fuselage horizontally and tilting the first to fourth rotors about each axis parallel to the y-axis;a 2-3th flight mode in which the fuselage rotates about the z-axis by maintaining the fuselage horizontally and individually controlling the speeds of the first to fourth rotors;a 2-4th flight mode in which the fuselage rotates in the z-axis direction by maintaining the fuselage horizontally and individually controlling the speeds of the first to fourth rotors;a 2-5th flight mode in which the fuselage rotates about the x-axis by rotating the first to fourth rotors about each axis parallel to the x-axis; anda 2-6th flight mode in which the fuselage rotates about the y-axis by rotating the first to fourth rotors about each axis parallel to the y-axis.