METHOD FOR CONTROLLING DRONE HAVING MULTI-DEGREE-OF-FREEDOM FLIGHT MODE
20230236610 · 2023-07-27
Inventors
Cpc classification
B64U2201/00
PERFORMING OPERATIONS; TRANSPORTING
B64U2101/30
PERFORMING OPERATIONS; TRANSPORTING
B64U20/87
PERFORMING OPERATIONS; TRANSPORTING
B64C27/52
PERFORMING OPERATIONS; TRANSPORTING
B64U20/83
PERFORMING OPERATIONS; TRANSPORTING
B64U40/10
PERFORMING OPERATIONS; TRANSPORTING
B64U50/13
PERFORMING OPERATIONS; TRANSPORTING
International classification
B64U10/14
PERFORMING OPERATIONS; TRANSPORTING
B64U50/13
PERFORMING OPERATIONS; TRANSPORTING
B64C27/52
PERFORMING OPERATIONS; TRANSPORTING
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.
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, 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 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; 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.
2. The control method of claim 1, further comprising: 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.
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; 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.
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; 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.
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; and a 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; 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.
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, 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 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; 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.
10. The control method of claim 9, further comprising: 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.
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; 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.
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; 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.
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; and a 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; 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.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0027]
[0028]
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037]
[0038]
[0039]
[0040]
[0041]
[0042]
[0043]
[0044]
BEST MODE
[0045] 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.
[0046] According to
[0047] 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.
[0048] A plurality of rotors may be arranged in pairs at a plurality of locations along the fuselage 110 (x-axis direction).
[0049] 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.
[0050] 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
[0051] As illustrated in
[0052] 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.
[0053] 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.
[0054] As illustrated in
[0055] The operation of such a configuration will be described with reference to
[0056]
[0057]
[0058] 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.
[0059] Hereinafter, the flight mode by the drone 200 with multiple DOF related to the present invention will be described below with reference to
[0060] 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.
[0061]
[0062]
[0063]
[0064]
[0065]
[0066]
[0067]
[0068]
[0069]
[0070]
[0071] 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.
[0072]
[0073] Similar to
[0074]
[0075]
[0076] 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.
[0077]
[0078]
[0079]
[0080] 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.