Wall rolling UAV with ring cage
12263969 ยท 2025-04-01
Assignee
Inventors
Cpc classification
B64U2101/00
PERFORMING OPERATIONS; TRANSPORTING
B64U10/16
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
Systems and methods are provided for a wall rolling unmanned aerial vehicle (UAV). A method is provided for rolling the UAV along a path on the surface of the wall. The method includes determining a trajectory for the UAV, determining motor inputs for the UAV, and operating the motors to roll and translate the UAV according to the trajectory along the path. A cage can be provided around the UAV to support contact between the UAV and the wall.
Claims
1. A method for a wall rolling operation of an unmanned aerial vehicle (UAV) having at least one motor along a predetermined path comprising: determining a trajectory for the UAV for the wall rolling operation based on a current position and a current orientation of the UAV and a target position and a target orientation of the UAV and the predetermined path; developing kinematic parameters relating the determined trajectory to UAV movement; determining motor inputs for the at least one motor of the UAV specific to the developed kinematic parameters, the motor inputs including a thrust motor input and a drag motor input wherein the motor inputs provide for six degree of freedom movement of the UAV; and operating the UAV based on the determined motor inputs to move the UAV along the determined trajectory during the wall rolling operation along the predetermined path.
2. The method in accordance with claim 1 further comprising operating the UAV in free flight when not in wall rolling operation.
3. A method for a wall rolling operation of an unmanned aerial vehicle (UAV) having at least one motor along a predetermined path comprising: determining a trajectory for the UAV for the wall rolling operation based on a current position and a current orientation of the UAV and a target position and a target orientation of the UAV and the predetermined path; developing kinematic parameters relating the determined trajectory to UAV movement; determining motor inputs for the at least one motor of the UAV specific to the developed kinematic parameters, the motor inputs including a thrust motor input and a drag motor input; and operating the UAV based on the determined motor inputs to move the UAV along the determined trajectory during the wall rolling operation along the predetermined path; wherein developing kinematic parameters includes defining a plurality of frames that includes a base coordinate frame and a UAV body frame, the base coordinate frame having an origin at a point of contact between a cage surrounding the UAV and the wall wherein one axis of the base coordinate frame is perpendicular to the wall, and the UAV body frame having an origin of the UAV body frame and defining position and orientation of the UAV with respect to the base coordinate frame.
4. The method in accordance with claim 3, wherein the predetermined path is positioned along an x-y plane of a wall and the x-y plane of the wall is vertical.
5. The method in accordance with claim 3, wherein defining the plurality of frames includes defining a plurality of angles including a first angle of the determined trajectory with respect to the base coordinate frame, a second angle between origin of the base coordinate frame and the origin of the UAV body frame, and a third angle of angular displacement with respect to a z axis of the UAV body frame parallel to a perpendicular to the determined trajectory.
6. The method in accordance with claim 5 wherein the UAV has a spherical cage having a center at the origin of the UAV body frame.
7. The method in accordance with claim 6, wherein a time derivative of the third angle provides an angular velocity for the UAV that is proportional to a linear velocity of the point of contact as the UAV traverses the determined trajectory.
8. The method in accordance with claim 7, wherein determining motor inputs includes determining an angular acceleration for the UAV and a linear acceleration for the UAV traveling on the determined trajectory.
9. The method in accordance with claim 8 wherein operating the UAV results in the UAV revolving about the z axis of the UAV body frame, shifting the point of contact between the UAV and the wall, and translating the UAV with a linear velocity along the determined trajectory.
10. An unmanned aerial vehicle (UAV) for maneuvering along a wall comprising: a body including a plurality of motors joined to propellers; a rounded cage positioned around said body and configured to support contact between said rounded cage and the wall when said rounded cage exerts a normal force on the wall; and a controller operatively joined said body and the plurality of motors configured to produce motor inputs for a wall rolling operation along an externally specified path along the wall and to provide motor inputs to the motors to maneuver the UAV along the externally specified path; wherein: the externally specified path is based on a current position and a current orientation of the UAV and a target position and a target orientation of the UAV; said controller develops kinematic parameters relating the externally specified path to UAV movement; said controller determines motor inputs specific to the developed kinematic parameters, the motor inputs including a thrust motor input and a drag motor input; and said controller is capable of operating the UAV based on the determined motor inputs to move the UAV along the path during a wall rolling operation.
11. The UAV in accordance with claim 10, wherein said controller develops kinematic parameters by defining a plurality of frames that includes a base coordinate frame and a UAV body frame, the base coordinate frame having an origin at a point of contact between said rounded cage and the wall wherein one axis of the base coordinate frame is perpendicular to the wall, and the UAV body frame has an origin and defines position and orientation of said body with respect to the base coordinate frame.
12. The UAV in accordance with claim 11, wherein said controller determines the plurality of frames by defining a plurality of angles including a first angle of the externally specified path with respect to the base coordinate frame, a second angle between the origin of the base coordinate frame and the origin of the UAV body frame, and a third angle of angular displacement with respect to a z axis of the UAV body frame parallel to a perpendicular to the externally specified path.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) Features of illustrative embodiments may be understood from the accompanying drawings in conjunction with the description. The elements in the drawings may not be drawn to scale. Some elements and/or dimensions may be enlarged or minimized for the purpose of illustration and understanding of the disclosed embodiments.
(2)
(3)
(4)
(5)
DETAILED DESCRIPTION
(6) The following description relates to systems and methods for an unmanned aerial vehicle (UAV). The UAV includes a body and, optionally, a ring or a cage. A ring allows the UAV to utilize normal forces for wall rolling stabilization in two dimensions and a cage would provide the same for three dimensions in addition to allowing free flight operation. A pictorial view of an example of the UAV is shown in
(7) Referring now to
(8) UAV system 10 comprises a body 12 and a cage 14. The body 12 comprises a plurality of arms 16 and a central structure 18. The body 12 further includes at least one motor 20. The at least one motor is configured to propel the UAV system 10 via a plurality of propellers 22. In some examples, each of the plurality of propellers 22 is rotated by an individual motor. In other examples, one or more of the plurality of propellers 22 may be rotated by an individual motor. The plurality of arms 16 couple the plurality of propellers 22 and the at least one motor 20 to the central structure 18. In turn, rotation of each of the plurality of propellers 22 translates rotational movement into thrust that propels the UAV system 10.
(9)
(10) With the plurality of motors 20 and the plurality of rotating propellers, like propeller 22, the UAV system 10 is capable of movement with six degrees of freedom. This is opposed to other types of UAVs that are capable of movement in less than six degrees of freedom, for example in three or four degrees of freedom. Three of the six degrees of freedom are translational and provide position changes, and the other three of the six degrees of freedom are rotational and provide orientation changes. Translational movements include lateral translation (e.g., left-right), longitudinal translation (e.g., forward-backward), and vertical translation (e.g., up-down). Rotational movements include pitch (e.g., rotation about a lateral axis), roll (e.g., rotation about a longitudinal axis), and yaw (e.g., rotation about a vertical axis). During free flight operation and/or the wall rolling operation, speed of each of the propellers 22 is controlled and adjusted to generate thrust and torque in order to move the UAV system 10 in defined directions and at defined speeds. A fully actuated UAV, such as UAV system 10 in some examples, is capable of rotating (e.g., changing orientation) independent of translating (e.g., hovering in a stable position while changing orientation). Such movement is demanded by the wall rolling operation herein described, which relies on rotating the UAV system 10 without translating the UAV system 10 off the wall 100 against which the UAV system 10 is rolling. Underactuated UAVs, in contrast, are not capable producing such a rolling operation under nonholonomic constraints. As such, the UAV system 10 herein described is a fully actuated system in order to perform the wall rolling operation.
(11) The cage 14 is a rounded cage that includes a wall rolling surface so as to allow and facilitate wall rolling of the UAV system 10, wherein the rounded cage may be a ring, a cylinder, or a sphere. The wall rolling surface is curved as depicted in
(12) In some examples, the wall 100 may be a perfectly vertical or substantially vertical wall. In other examples, the wall 100 may have other configurations that are not perfectly or substantially vertical. As an example, the wall 100 may be a rounded wall, such as a smoke stack or a wall that is not perfectly vertical.
(13) In the embodiment shown in
(14) In embodiments in which the cage 14 is a ring shape, as shown in
(15) In the depiction shown in
(16) When the UAV system 10 is positioned in direct face sharing contact with the wall 100 as shown in
(17) In some examples, the UAV system 10 is an omnicopter that comprises six propellers, like 22, with some of the propellers rotating in alternating directions. For example, a first rotating propeller 22 rotates clockwise and a second rotating propeller 24 that is directly adjacent to the first rotating propeller 22 rotates counterclockwise. A third rotating propeller 26 that is directly adjacent to the second rotating propeller 24 but not directly adjacent to the first rotating propeller 22 (e.g., separated from the first rotating propeller 22 by the second rotating propeller 24) rotates clockwise, opposite the direction of rotation of the second rotating propeller 24 and in the same direction as the first rotating propeller 22. Because of the alternating opposing rotational directions, conservation of angular momentum is achieved when an equal number of opposing rotational directions are applied. Further, the rotating propellers are tilted at predefined angles (e.g., 15 to 30 degrees) in alternating directions (e.g., alternating opposing angles). Thrust and torque generated by the plurality of propellers and motors moves the UAV system 10, including turning and rolling.
(18) During the rolling operation, the UAV system 10 turns, rolls, and/or tilts. Turning comprises changing an orientation of an axis of the UAV system 10, as will be further described with reference to
(19) The wall rolling operation as herein described is possible because the UAV system 10 is a fully actuated UAV and/or capable of movement with six degrees of freedom, including rotations in pitch, roll, and yaw, as described. An under-actuated UAV system may not be capable of performing the required turning, rolling, and tilting while also moving at the required translational velocity such as is demanded to perform the wall rolling operation herein described. In this way, the UAV system 10 that includes six degrees of freedom provides for increased mobility both during free flight operation and during rolling operation.
(20)
(21) The UAV system 10 further comprises a controller 32. In some examples, the controller 32 includes a processor and non-transitory memory in which instructions for executing the wall rolling operation as well as free flight operations is stored. In some examples, the controller 32 is a nonlinear model predictive controller (NMPC) configured with a framework of path generators to generate one or more paths that the UAV system 10 may take to reach a target position and target orientation. The controller 32 is further configured to generate motor inputs for each of the one or more paths. A path can also be specified from an external source such as by a user.
(22) The controller 32, in such examples, further comprises a framework to determine which of the one or more paths is to be taken by the UAV system 10. In some examples, determining which of the one or more paths to take is based on a variety of task needs whereby a path chosen for the UAV to traverse meets the task needs more than other of the one or more paths.
(23) In some examples, the UAV system 10 further includes a navigational system (not shown) and a power source (not shown). The navigational system includes a plurality of sensors, such as gyroscopes and/or accelerometers, which detect position and orientation of the UAV system 10 that may be used by the controller in order to generate the one or more paths and motor inputs for the one or more paths.
(24)
(25) Establishment of these frames allows accounting for orientation and position changes of the body 12 of the UAV system 10 in relation to the frame 0 coordinate system 104. A DH frame table created from these definitions is as follows:
(26) TABLE-US-00001 Rotation Rotation Frame Displacement about z Length about x 1 0 0 0 2 0 0 90 3 0 r.sub.drone 90
The z.sub.3 axis of the frame 3 coordinate system 106 is the same as z axis 102 of
(27) The desired trajectory of UAV 10 along wall 100 is provided by path 108. Angle is the angle between x.sub.0 and x.sub.1. The path 108 offset 90 or /2 radians from this; therefore, =x.sub.1x.sub.0/2. For calculation, x.sub.1 of frame 1 is set at angle from axis x.sub.0 rotated around z.sub.0.
(28) In some examples in which the second angle is 90 degrees, the segment 112 is in the same axis as the z.sub.0 axis of the frame 0 coordinate system 104 (e.g., a second z-axis). In examples in which the cage 14 is a spherical shape, the second angle may be locked perpendicular to the x-y plane of the frame 0 coordinate system 104. In other examples in which the cage 14 is ring shaped, the second angle may have variable angles with respect to the x-y plane of the first coordinate system 104.
(29) While frame 1 and frame 2 define orientation (turn and tilt) of the UAV system 10 without a change in position with respect to the base frame, the frame 3 defines a position and orientation of the origin of the frame 3 coordinate system 106 (and consequently the position of the center point 114). The orientation of the frame 3 system 106 is defined by angle . Angle provides angular displacement for rotation of the UAV system 10 during the wall rolling operation.
(30) As noted previously, the wall 100 occupies an x-y plane of the frame 0 coordinate system 104 and the UAV system 10 rolls about the x-y plane of the frame 0 coordinate system 104 during the rolling operation. The position of the point of contact 110 as a point of the exterior wall rolling surface of the cage 14 shifts as the UAV system 10 revolves about the center point 114 during the wall rolling operation. The wall rolling operation is a rolling without slipping operation that includes a combination of translation and rotation where the point of contact 110 is instantaneously at rest. In the case of the wall rolling operation herein described, a normal force between the cage 14 and the wall 100 maintains the contact between the cage 14 and the wall 100 so that the point of contact 110 is instantaneously at rest at any particular moment. Static friction acts to maintain a position of the point of contact 110 at any particular moment by counteracting forces such as wind forces.
(31) Referring now to
(32) At 402, the method determines a path for the UAV for the rolling operation based on a current position and orientation and a target position and orientation. In order to determine the path for the UAV for the rolling operation, all frames are defined for the system, as described with reference to
(33) Based on the frames and angle and position changes between each adjacent frame, as described by DH parameters, a kinematic model describes a velocity accompanying the rolling motion. The kinematic model according to the DH frames as described herein is given by equation (1):
v.sub.0=y.sub.1*r.sub.drone*d()(1)
where v.sub.0 is linear velocity of the base frame as a vector, y.sub.1 is a y unit vector of frame 1, r.sub.drone is the radius of the UAV system, and d() is a derivative of angle , which defines angular velocity. The linear velocity, as described by equation (1) is proportional to the angular velocity. The path determined based on the frames, DH parameters, and equation (1) may include turns as well as rolling motions in order to traverse from a current (e.g., starting) position and orientation to a target position and target orientation. The user specified path includes multiple instantaneous trajectories for maneuvering the UAV. Multiple trajectories are defined by the path determined because of turns needed to reach the target position and target orientation.
(34) At 404, the method includes determining motor inputs for the UAV based on the determined path. The determined motor inputs may be such that the UAV when operating the motor inputs as determined at 404, traverses along the path determined at 402. A modified dynamic model that describes angular velocity and acceleration of the system accounts for a normal force between the cage and the wall. Angular acceleration and linear acceleration are initially defined based on equation (1), whereby the linear velocity and the angular velocity are derived to respectively provide linear acceleration and angular acceleration. The position rotation and all derivatives are calculated utilizing the DH frame system. The modified dynamic model as herein described includes three equations. Linear acceleration is given by equation (2):
(35)
where is linear acceleration (p being a position of the UAV), g is acceleration from gravity, m is a mass of the UAV system, R.sub.B.sup.W is a rotation matrix from a body frame (e.g., the frame 3) in a world frame, wherein the world frame is an arbitrarily defined frame used to define relative positions and orientations of other frames, F is a thrust coefficient matrix, u is a motor input vector, R.sub.0.sup.W is a rotation matrix from a zero frame (e.g., the base frame) to the world frame, and N is a magnitude of the normal force. Equation (2) describes a first relationship between the linear acceleration and the thrust motor input. Having known the linear acceleration value based on the kinematic model (e.g., equation (1)), the thrust motor input can be solved for based on equation (2), provided the UAV system includes six independent rotors.
(36) Angular acceleration is given by equation (3):
(37)
where {dot over ()}.sub.B is instantaneous angular acceleration (wherein .sub.B is angular velocity), I.sub.B is inertia of the body of the UAV system, H is a drag coefficient matrix, u is the motor input vector, a second product Hu providing a drag motor input, P.sub.A.sup.3 is a position from the body of the UAV to a point of contact between the UAV system and the wall (e.g., point of contact 110), R.sub.0.sup.3 is a rotation matrix from the base frame to the third frame, and N is again the magnitude of the normal force that the UAV System produces as a result of static friction expressed as part of a matrix. Equation (3) describes a second relationship between the angular acceleration and the drag motor input. Having known the angular acceleration based on the kinematic model, the drag motor input can be solved for based on equation (3), provided the UAV system includes six independent rotors.
(38) An angular velocity vector is given by equation (4):
{dot over (R)}.sub.B.sup.W=R.sub.B.sup.W[.sub.B](4)
where R.sub.B.sup.W is a rotation matrix from a body of the UAV system in the world frame, the derivative of which provides the angular velocity vector, .sub.B is average angular velocity, and is a hat function (e.g., a triangle function).
(39) With equations (2), (3), and (4), motor inputs can be solved for, including drag and thrust motor inputs. These motor inputs are provided to the UAV system in order for the UAV system to traverse along the determined path.
(40) At 406, the method includes operating one or more motors of the UAV system during the wall rolling operation to move the UAV along the determined path. The motor inputs, as determined based on equations (2), (3), and (4) at 404, are applied to the one or more motors in order to rotate rotors and rotating propellers to move the UAV system. Movement of the UAV system for the determined path includes orientation and translation changes, including turning (e.g., a yaw rotation), tilting (e.g., a pitch rotation), and rolling (e.g., a roll rotation combined with translation to produce rolling motion as previously described). In some examples where there are sufficient normal forces, motor input for rolling may include rotation but not translation inputs, as translation is provided from shifting of the point of contact that results from revolution about the y.sub.3-axis of the UAV system and normal force between the wall and a cage of the UAV system.
(41) Further, static friction acts tangentially to maintain a position of the UAV against a wall. Potential static friction, which is proportional to the normal force, may maintain a position of a point of contact between the UAV and the wall at any particular moment by counteracting forces such as wind forces that would alter the position of the point of contact.
(42) A technical effect of the method herein provided is that a fully actuated UAV system that includes a body and a substantially rounded cage is capable of rolling against a fixed surface due to a normal force between the wall and the UAV during a wall rolling operation. Further, static friction and the normal force may maintain position of the UAV against the wall. A rolling motion that includes rotation about a central axis and translation along an x-y plane of the wall is provided by a method wherein a path is determined and motor inputs for the UAV to traverse the path via the rolling motion are determined. Rolling against the wall, which for a free flight operation may be an obstacle, provides increased stability, decreased drift away from a path due to wind forces, and increased certainty of trajectory due to decreased drift and increased stability. Increased stability is provided as more energy is demanded to both roll and move the UAV than just to move it. Static contact during the rolling operation further reduces momentum gained during movement, therefore further decreasing drift from the path.
(43) It will be appreciated that the configurations and routines disclosed herein are exemplary in nature, and that these specific embodiments are not to be considered in a limiting sense, because numerous variations are possible. Moreover, unless explicitly stated to the contrary, the terms first, second, third, and the like are not intended to denote any order, position, quantity, or importance, but rather are used merely as labels to distinguish one element from another. The subject matter of the present disclosure includes all novel and non-obvious combinations and sub-combinations of the various systems and configurations, and other features, functions, and/or properties disclosed herein.
(44) The following claims particularly point out certain combinations and sub-combinations regarded as novel and non-obvious. These claims may refer to an element or a first element or the equivalent thereof. Such claims should be understood to include incorporation of one or more such elements, neither requiring nor excluding two or more such elements. Other combinations and sub-combinations of the disclosed features, functions, elements, and/or properties may be claimed through amendment of the present claims or through presentation of new claims in this or a related application. Such claims, whether broader, narrower, equal, or different in scope to the original claims, also are regarded as included within the subject matter of the present disclosure.