Systems and Methods for Controlling a Vehicle
20210124373 · 2021-04-29
Inventors
- Michael Z. Miller (Atlanta, GA, US)
- Eric M. Feron (Atlanta, GA, US)
- Kayla Watson (Atlanta, GA, US)
- John B. Mains (Atlanta, GA, US)
- Thanakorn Khamvilai (Atlanta, GA, US)
Cpc classification
B64U2201/00
PERFORMING OPERATIONS; TRANSPORTING
B64U50/23
PERFORMING OPERATIONS; TRANSPORTING
B64C17/02
PERFORMING OPERATIONS; TRANSPORTING
B64U40/10
PERFORMING OPERATIONS; TRANSPORTING
B64U2201/10
PERFORMING OPERATIONS; TRANSPORTING
B64C39/024
PERFORMING OPERATIONS; TRANSPORTING
B64U10/14
PERFORMING OPERATIONS; TRANSPORTING
International classification
B64C17/02
PERFORMING OPERATIONS; TRANSPORTING
Abstract
Certain examples of the present disclosure relate to systems and methods for controlling a vehicle. In particular, the present disclosure provides systems and methods for moving an aerial vehicle by decoupling the pitch- and roll-movement from thrust production. This decoupling can occur by shifting the center of gravity of the vehicle to create a moment about a desired axis. Some examples describe single-shaft rotary vehicles, while other examples describe coaxial rotary vehicles. The vehicles described herein may include a first mass moveable from a first position to a second position to create at least one of a rolling moment or a pitching moment to alter the direction of movement of the vehicle. A second mass may also be provided to alter the rolling moment or pitching moment. Methods for controlling the vehicles are also provided herein.
Claims
1. A vehicle control system for controlling a direction of movement of a vehicle comprising: a first rotary shaft connected to the vehicle; a first plurality of propellers connected to the first rotary shaft; a first power source in mechanical communication with the first rotary shaft and configured to rotate the first rotary shaft; and a first mass moveable from a first position to a second position.
2. The vehicle control system of claim 1 further comprising: a second rotary shaft connected to the vehicle; and a second plurality of propellers connected to the second rotary shaft; wherein a movement of the first mass from the first position to the second position creates at least one of a rolling moment or a pitching moment to alter the direction of movement of the vehicle; wherein the first and second rotary shafts are coaxial; wherein the first power source is in mechanical communication with the second rotary shaft; wherein the first power source is configured to rotate the first rotary shaft in a first direction; wherein the first power source is configured to rotate the second rotary shaft in a second direction; and wherein the first direction is opposite the second direction.
3. The vehicle control system of claim 2 further comprising a second power source in mechanical communication with the second rotary shaft and configured to rotate the second rotary shaft.
4. The vehicle control system of claim 3, wherein the first plurality of propellers is coplanar with the second plurality of propellers.
5. The vehicle control system of claim 3 further comprising a second mass moveable from a third position to a fourth position along a second length; wherein the first mass is moveable from the first position to the second position along a first length; and wherein a movement of the second mass from the third position to the fourth position changes at least one of the rolling moment or the pitching moment.
6. The vehicle control system of claim 3, wherein the first mass comprises a linear motor configured to move the first mass from the first position to the second position.
7. (canceled)
8. The vehicle control system of claim 1 further comprising a transceiver in electrical communication with the first power source and configured to receive a wireless signal to adjust an angular velocity of the first plurality of propellers.
9. The vehicle control system of claim 6 further comprising a transceiver in electrical communication with the first power source and the linear motor, wherein the transceiver is configured to receive a wireless signal to: adjust an angular velocity of the first plurality of propellers; and move, via the linear motor, the first mass from the first position to the second position.
10.-14. (canceled)
15. The vehicle control system of claim 2 further comprising a transceiver configured to receive a wireless signal that includes instructions to adjust the angular velocity of the first plurality of propellers independently from the second plurality of propellers.
16.-27. (canceled)
28. A method of operating a rotary-powered vehicle with the control system of claim 2 comprising: rotating, via the first power source, the first rotary shaft such that the first plurality of propellers connected to the first rotary shaft move at a first angular velocity; rotating the second rotary shaft such that the second plurality of propellers connected to the second rotary shaft move at a second angular velocity; moving the first mass from the first position to the second position, wherein the movement of the first mass from the first position to the second position creates the at least one of a rolling moment or a pitching moment; and adjusting at least one of a roll or a pitch of at least a portion of the rotary-powered vehicle to alter a direction of movement of the vehicle.
29. The method of operating a rotary-powered vehicle of claim 28 further comprising moving a second mass from a third position to a fourth position; wherein the movement of the second mass from the third position to the fourth position alters at least one of the rolling moment or the pitching moment.
30. The method of operating a rotary-powered vehicle of claim 28, wherein rotating the second rotary shaft comprises rotating, via a second power source, the second rotary shaft such that the second plurality of propellers connected to the second rotary shaft move at the second angular velocity.
31.-32. (canceled)
33. The method of operating a rotary-powered vehicle of claim 30, wherein the first plurality of propellers and the second plurality of propellers are coaxial.
34. The method of operating a rotary-powered vehicle of claim 30, wherein the first plurality of propellers are coplanar with the second plurality of propellers.
35.-40. (canceled)
41. A method of controlling a rotary-powered vehicle comprising: receiving, at a flight controller, a reference trajectory comprising a reference attitude and a reference position, wherein the reference attitude further comprises a reference angular velocity for a first rotary shaft of a vehicle and a reference angular acceleration for the first rotary shaft; receiving, at a state-estimator controller, data indicative of an attitude and a position of the vehicle; tracking, via a position controller, the reference position; calculating a first set of instructions, based at least in part on the reference position, to adjust a position of the vehicle; adjusting, based at least in part on the first set of instructions, a position of a first mass on the vehicle to alter the position of the vehicle; tracking, via an attitude controller, the reference angular velocity for the first rotary shaft and the reference angular acceleration for the first rotary shaft; calculating a second set of instructions, based at least in part on the reference angular velocity for the first rotary shaft or the reference angular acceleration for the first rotary shaft, to adjust at least one of a first-rotary-shaft angular velocity or a first-rotary-shaft angular acceleration; adjusting, via a first power source and based at least in part on the second set of instructions, at least one of the first-rotary-shaft angular velocity or the first-rotary-shaft angular acceleration; receiving, at an actuator controller, at least one of a desired position, a desired speed, or a desired attitude for the vehicle; calculating a third set of instructions, based at least in part on the desired position, the desired speed, or the desired attitude, to alter at least one of the position of the vehicle, the first-rotary-shaft angular velocity, or the first-rotary-shaft angular acceleration; adjusting, based at least in part on the third set of instructions, the position of the first mass on the vehicle to alter the position of the vehicle; and adjusting, via the first power source and based at least in part on the third set of instructions, at least one of the first-rotary-shaft angular velocity or the first-rotary-shaft angular acceleration.
42. (canceled)
43. The method of controlling a rotary-powered vehicle of claim 41 further comprising: adjusting, based at least in part on the first set of instructions, a position of a second mass to alter the vehicle position; and adjusting, based at least in part on the third set of instructions, the position of the second on the vehicle to alter the position of the vehicle.
44. The method of controlling a rotary-powered vehicle of claim 41, wherein: the reference attitude further comprises a reference angular velocity for a second rotary shaft of the vehicle and a reference angular acceleration for the second rotary shaft of the vehicle; the second set of instructions is further based at least in part on the reference angular velocity for the second rotary shaft or the reference angular acceleration for the second rotary shaft; the second set of instructions include instructions to adjust at least one of a second-rotary-shaft angular velocity or a second-rotary-shaft angular acceleration; and the method further comprises: tracking, via the attitude controller, the reference angular velocity for the second rotary shaft and the reference angular acceleration for the second rotary shaft; adjusting, via the first power source and based at least in part on the second set of instructions, at least one of the second-rotary-shaft angular velocity or the second-rotary-shaft angular acceleration; calculating a fourth set of instructions, based at least in part on the desired position, the desired speed, or the desired attitude, to alter at least one of the second-rotary-shaft angular velocity or the second-rotary-shaft angular acceleration; and adjusting, based at least in part on the fourth set of instructions, the second-rotary-shaft angular velocity or the second-rotary-shaft angular acceleration.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0050] Reference will now be made to the accompanying figures and diagrams, which are not necessarily drawn to scale, and wherein:
[0051]
[0052]
[0053]
[0054]
[0055]
[0056]
[0057]
[0058]
[0059]
DETAILED DESCRIPTION
[0060] Although certain embodiments of the disclosure are explained in detail, it is to be understood that other embodiments are contemplated. Accordingly, it is not intended that the disclosure is limited in its scope to the details of construction and arrangement of components set forth in the following description or illustrated in the drawings. Other embodiments of the disclosure are capable of being practiced or carried out in various ways. Also, in describing the embodiments, specific terminology will be resorted to for the sake of clarity. It is intended that each term contemplates its broadest meaning as understood by those skilled in the art and includes all technical equivalents which operate in a similar manner to accomplish a similar purpose.
[0061] It should also be noted that, as used in the specification and the appended claims, the singular forms “a,” “an” and “the” include plural references unless the context clearly dictates otherwise. References to a composition containing “a” constituent is intended to include other constituents in addition to the one named.
[0062] Ranges may be expressed herein as from “about” or “approximately” or “substantially” one particular value and/or to “about” or “approximately” or “substantially” another particular value. When such a range is expressed, other exemplary embodiments include from the one particular value and/or to the other particular value.
[0063] Herein, the use of terms such as “having,” “has,” “including,” or “includes” are open-ended and are intended to have the same meaning as terms such as “comprising” or “comprises” and not preclude the presence of other structure, material, or acts. Similarly, though the use of terms such as “can” or “may” are intended to be open-ended and to reflect that structure, material, or acts are not necessary, the failure to use such terms is not intended to reflect that structure, material, or acts are essential. To the extent that structure, material, or acts are presently considered to be essential, they are identified as such.
[0064] It is also to be understood that the mention of one or more method steps does not preclude the presence of additional method steps or intervening method steps between those steps expressly identified. Moreover, although the term “step” may be used herein to connote different aspects of methods employed, the term should not be interpreted as implying any particular order among or between various steps herein disclosed unless and except when the order of individual steps is explicitly required.
[0065] The components described hereinafter as making up various elements of the disclosure are intended to be illustrative and not restrictive. Many suitable components that would perform the same or similar functions as the components described herein are intended to be embraced within the scope of the disclosure. Such other components not described herein can include, but are not limited to, for example, similar components that are developed after development of the presently disclosed subject matter. Additionally, the components described herein may apply to any other component within the disclosure. Merely discussing a feature or component in relation to one embodiment does not preclude the feature or component from being used or associated with another embodiment.
[0066] To facilitate an understanding of the principles and features of the disclosure, various illustrative embodiments are explained below. In particular, the presently disclosed subject matter is described in the context of systems and methods for controlling a vehicle by shifting the center of gravity of the vehicle to create a moment, e.g., a rolling or pitching moment, to alter the direction of movement of the vehicle. The present disclosure describes moving rotary-based vehicles, including but not limited to quadcopters, helicopters, and the like. The present disclosure, however, is not so limited and can be applicable in other contexts. For example, and not limitation, the systems and method described herein may also apply to controlling vehicles in other contexts. For example and not limitation, the present systems and methods may improve control over other vehicles, such as water-based and land-based vehicles. Additionally, some embodiments are described in the context of Unmanned Aerial Vehicles, including drones. The present systems and methods are not so limited. For example, the systems and methods for controlling vehicle movement described herein are scalable and can apply to other aerial vehicles, including but not limited to manned rotary aircrafts. These embodiments are contemplated within the scope of the present disclosure. Accordingly, when the present disclosure is described in the context of systems and methods for controlling a vehicle by shifting the center of gravity of the vehicle to create a moment, e.g., rolling or pitching moment, it will be understood that other embodiments can take the place of those referred to.
[0067] As described above, two common vehicle-drive systems for operating rotary-powered aircrafts are the quadcopter design and the coaxial rotary design. The quadcopter design produces pitch and roll movement by increasing the thrust at respective sides of the vehicle. This increase in thrust is produced by independently changing the revolutions per minute (RPMs) of the rotor systems at different sides of the vehicle. The RPMs are manipulated by increasing the power provided by one or more of the four independent motors in the design. The coaxial rotary design produces pitch and roll movement by increasing the thrust from the propellers at different sides of the vehicle via swashplates; the swashplates change the pitch of the propellers at respective sides of the vehicle. Therefore, both designs couple vehicle movement with thrust production. This coupling disadvantageously decreases the vehicle's efficiency, increases the overall weight of the vehicle, and increases the power consumption of the vehicle-propulsion system.
[0068] The present disclosure provides a novel method of moving an aerial vehicle by decoupling the pitch- and roll-movement from thrust production. This decoupling can occur by shifting the center of gravity of the vehicle, or the vehicle's propulsion system, to create a moment about a desired axis. These systems and methods can be used in either single-rotor systems or coaxial-rotor systems. For example, in a coaxial-rotor system, the yaw can be controlled by varying the speed of the two coaxial rotors independently. In a single-rotor system, a tail rotor can be used to create the yaw movement.
[0069] As described above, to provide a rolling or pitching movement for a vehicle, a net torque is used to either roll or pitch the vehicle. Legacy systems created this torque by changing the direction of the force. However, torque can also be created by changing the moment-arm of the system about the rotors. For example, the torque on a system can be defined as:
{right arrow over (T)}={right arrow over (F)}×{right arrow over (r)} Equation 1
Previous systems changed the overall torque {right arrow over (T)} of the vehicle by changing the force {right arrow over (F)}. However, as seen in Equation 1, the overall torque can also be changed by manipulating the moment arm {right arrow over (r)} of the system.
[0070] The approach illustrated in
[0071] Various devices and methods are disclosed for providing systems and methods for controlling a vehicle by shifting the center of gravity of the vehicle, and exemplary embodiments of the devices and methods will now be described with reference to the accompanying figures.
[0072]
[0073] In some embodiments, the first plurality of propellers 202 and/or second plurality of propellers 204 can receive power from a first power source 208. In some embodiments, the first power source 208 may comprise an electric motor, internal combustion engine, and/or similar power-producing components that can provide rotary power. In some embodiments, the first power source 208 may be brushed direct current electric motor, a brushless direct current (BLDC) electric motor, or similar electric motors. In some embodiments, a BLDC motor may be used as a first power source 208 so as to decrease the weight of the aerial vehicle. The first power source 208 may provide power to rotate one of the first plurality of propellers 202 and/or second plurality of propellers 204. In some embodiments, a first power source 208 may include a contra-rotating motor with two separate shafts. As will be appreciated, a single contra-rotating motor may provide two coaxial rotary shafts, and the single motor can rotate a first shaft (and a first plurality of propellers 202) in one direction and rotate a second shaft (and a second plurality of propellers 204) in a second direction, wherein the first direction is opposite the second direction.
[0074] In some embodiments, the first plurality of propellers 202 and/or second plurality of propellers 204 can receive power from a second power source 210. For example,
[0075] As will be appreciated, a first power source 208 and a second power source 210 can be stacked as shown to create a coaxial power source. In these embodiments, the first power source 208 may include a first rotary shaft and the second power source 210 may include a second rotary shaft. The first and second rotary shafts can be coaxial so as to provide the stacked propeller 202, 204 construct, as shown. It is also contemplated, however, that the second power source 210 is not stacked and coaxial with the first power source 208. For example, the second power source 210 may be planar with the first power source 208, similar to a quadcopter design. In these embodiments, the respective shafts in mechanical communication with the first power source 208 and the second power source 210 would not be coaxial. It is also contemplated that, in embodiments wherein the first power source 208 and the second power source 210 are not coaxial, a first plurality of propellers 202 connected to a first power source 208 and second plurality of propellers 204 connected to a second power source 210 can be coplanar.
[0076] It is contemplated that a vehicle control system 200 can include more than two power sources 208, 210. For example, a single vehicle control system can include three, four, or more power sources. A quadcopter, for example, has four separate power sources. It is also contemplated that a vehicle could have more than one stacked, coaxial construct. For example, the stacked first power source 208 and second power source 210 in
[0077] As described above, unlike previous designs, the presently-described systems and methods decouple the movement of the vehicle from the thrust production. The components described thus far would be considered to be a part of vehicle thrust production, or a propulsion system. For example, the first plurality of propellers 202, second plurality of propellers 204, power sources 208, 210, and similar components provide thrust to the system and are considered a part of the propulsion system. The additional features descried for
[0078] In some embodiments, a vehicle control system 200 may include a first mass 212. The first mass 212 may be used to shift the center of gravity to create the moment-arms described above for changing the position of a vehicle. In some embodiments, the first mass 212 may be movable across a first length 214, as shown in the figure. The first length 214 may be a bar, track, rod, or other length that allows the mass to move from a first position to the second position. For example, and not limitation, the first mass 212 may include a linear motor that moves the first mass 212 from a first position to a second position along a rod, bar, or similar length. A linear motor could include a BLDC linear motor, a solenoid actuator, and the like.
[0079] In some embodiments, a vehicle control system 200 may include a second mass 216. The second mass 216 may be similar to the first mass 212. In some embodiments, the second mass 216 may be moveable across a length, e.g., second length 218, similar to the first mass 212. The second mass 216 may include similar electric motors as described above for the first mass 212. It is contemplated that the first length 214 and the second length 218 are not parallel to each other. For example, the movement of the first mass 212 and the movement of the second mass 216 can be used to move the center of gravity of the vehicle control system 200 in three dimensions instead of along a length 214, 218. This three-dimensional change to the center of gravity can provide a more precise moment of the vehicle control system 200. It is contemplated that the first length 214 and the second length 218 can be perpendicular to each other, as shown in the figure; however, the first length 214 and the second length 218 are not required to be substantially perpendicular.
[0080] In some embodiments, to create three-dimensional center-of-gravity change, the vehicle control system 200 may include not two moveable masses but a single mass movable in three dimensions. For example, it is contemplated that the first mass 212 may be positioned on a rotatable first length 214. As the first mass 212 moves from a first position to a second position along the first length 214, two-dimensional movement can be provided to the vehicle control system 200; as the first length 214 is rotated, the movement of the first mass 214 can now provide three-dimensional movement for the vehicle control system 200.
[0081] It is also contemplated that the first mass 212 and/or the second mass 216 could be a liquid, and the liquid masses 212, 216 could be moved from a first position to a second position by moving the fluid from one location in the vehicle to another location. In some embodiments, the liquid could be a fuel for the one or more power sources 208, 210 described herein, and the first position and the second position could be a first fuel tank and a second fuel tank, for example.
[0082] In some embodiments, a vehicle control system 200 may include an energy source 220. The energy source can include a battery, such as a lithium polymer, nickel cadmium, nickel metal hydride batteries, and/or the like.
[0083] In some embodiments, the vehicle control system 200 may include one or more controller 222. The controller 222 may provide on-board computation for controlling the thrust (i.e., the rotary moment described above) and/or the position changes (i.e., the movement of the moveable masses described above). The controller 222 may include a flight control system, vehicle state estimation, and/or middleware for communicating with other systems. The controller 222 can include an inertial measurement unit (IMU) that may include additional components for measuring the flight of a vehicle. The IMU may include movement-detecting components including accelerometers, gyroscopes, magnetometers, barometers, and similar components. The IMU may also provide redundancy in the form of multiple components, including for example one or more accelerometers, one or more gyroscopes, one or more magnetometers, one or more barometers, and the like. Additional controller 222 features and controller design are described in greater detail herein.
[0084] In some embodiments, the vehicle control system 200 may include a movement-system frame 224. The movement-system frame 224 may be provided as support for the components of the vehicle control system 200. For example, the propulsion components (e.g., the first plurality of propellers 202, second plurality of propellers 204, power sources 208, 210, and similar features) may be connected the movement-system frame 224. Other components for altering the moment-arms (e.g., first mass 212, second mass 216, and similar features) of the vehicle control system 200 may be connected to the movement-system frame 224. Additional components may be connected to the movement-system frame 224, including but not limited to the energy source and/or controller 222.
[0085] In some embodiments, the controller 222 may include a transceiver for receiving wireless signals to control the components described herein. For example, the transceiver may receive wireless signals with instructions to move a first mass 212 from a first position to a second position along a first length 214; similar signals could include these instructions for a second mass 216. The wireless signal can also include instructions to alter the angular velocity and/or angular acceleration of a first plurality of propellers 202 and/or a second plurality of propellers. This signal can, therefore, increase the thrust of the vehicle and/or change the yaw of the vehicle. In some embodiments, the transceiver may be a component separate from the controller 222.
[0086] It is also contemplated that other components may be provided in a vehicle, and these other components may be connected to the movement-system frame 224. In some embodiments, the vehicle may include a video camera, which is a common component in UAVs, including consumer drones. As described above, the present systems are not limited to UAVs, and can be scaled to be used in manned aircrafts. Accordingly, it is contemplated that the vehicle may include a chassis and/or cabin for humans and cargo. This chassis and/or cabin can be connected to the movement system-frame 224.
[0087]
[0088]
[0089]
[0090] As described herein, the movements of the first mass 212 and/or the second mass 216 can alter the position of the center of gravity of the vehicle control system 200. This change in the center of gravity will thereby create a larger moment art at certain points of the vehicle control system. These changes in the moment arm can create at least one of a rolling moment or a pitching moment. It is contemplated that more than two masses 212, 216 may be provided in a vehicle control system 200.
[0091]
[0092]
[0093] The algorithm for controlling the vehicle may be performed by the controller 222 described above. In an exemplary embodiment a sensor driver 612 in a middleware block 606 may communicate with physical sensors of a vehicle control system to obtain raw data for the state estimator 604. The physical sensors of the vehicle may include accelerometers, gyroscopes, magnetometers, barometers, and similar components, which may be associated with the controller 222. After the state estimator 604 receives data regarding vehicle position, the behavior of the vehicle may be predicted by, for example, a flight controller 602. At this point, the flight controller 602 may adjust either the thrust of the system or the position of the system. For example, the position of the system may be altered by adjusting the position of the one or more masses described above. This adjustment may be performed by a linear motor controller 614. The linear motor controller 614 can then provide a signal for the one or more masses to move from a first position to a second position.
[0094] The prior processes describe the controller stabilizing the vehicle. The controller 222 may also receive control signals from the ground station 608 to adjust the thrust and/or position of the vehicle based on desired parameters. The control signals may include at least one of a desired position, a desired speed, or a desired attitude for the vehicle. The desired position and/or speed of the vehicle may be achieved by altering the torque of the vehicle control system 200. The desired torque may be achieved by adjusting the one or more masses described above. This adjustment may be performed by a linear motor controller 614. The linear motor controller 614 can then provide a signal for the one or more masses to move from a first position to a second position. The estimated state of the vehicle determined by the state estimator 604 and the control signal calculated by the flight controller 602 may be logged in memory storage 616 (e.g., a secure digital card) for recording in-flight data and post analysis.
[0095]
[0096] At block 720, the vehicle control system can receive a first signal, wherein the first signal includes instructions to move a first mass from a first position to a second position. This can signal can be received, for example, by the transceivers described herein. As described herein, more than one mass may be provided. For example, in some embodiments, a single mass may provide three-dimensional center-of-gravity-shifting control; in other embodiments, a first mass and a second mass may provide three-dimensional center-of-gravity-shifting control.
[0097] At block 730, the vehicle control system can move the first mass from the first position to the second position, wherein the movement of the first mass from the first position to the second position creates at least one of a rolling moment or a pitching moment. Again, this rolling or pitching moment may be produced by a first mass moving or by two masses working concurrently to shift the center of gravity.
[0098] At block 740, the vehicle control system can adjust at least one of the pitch or roll of at least a portion of the rotary-powered vehicle to alter a direction of movement of the vehicle. In some embodiments, the entire vehicle can be pitched or rolled due to the shifting of the moment arm. In other embodiments, only a portion of the vehicle may be pitched or rolled. For example, in an embodiment with a hingeably attached base frame 302 (as shown in
[0099] Process 700 may end after block 740. In some embodiments, the process 700 may further include rotating, via a second power source, a second rotary shaft such that a second plurality of propellers connected to the second rotary shaft move at a second angular velocity. In some embodiments, the process 700 may further include rotating, via the first power source, a second rotary shaft such that a second plurality of propellers connected to the second rotary shaft move at a second angular velocity. In some embodiments, the process 700 may further include receiving, via the transceiver, a second signal, wherein the second signal includes instructions to adjust at least one of the first angular velocity or the second angular velocity. These and other methods of operating a vehicle control system 200 are contemplated.
Non-Linear Controller for Coaxial Vehicles
[0100] The non-linear dynamic model of a mass-moving coaxial vehicle, for example the embodiment shown in . Moreover, any arbitrary vector, {right arrow over (x)}, and its time derivative
) where its origin is fixed at the geometric center of the vehicle (point O) and its xyz-coordinate axes rotate along with the vehicle. Similar to
, a vector and its derivative represented in
are denoted by .sup.b
) where its orientation is aligned with
; however, this frame moves as the vehicle's COG (point G) moves. The position and orientation of the coaxial helicopter are represented as relative measures to
. However, both linear and angular velocities are represented in
. Furthermore, the position of the CoG is described as a relative distance of
with respect to
. The parameters that may be used for these measures can be described as: [0101] .sup.f{right arrow over (p)} ∈
.sup.3: The position of O relative to
in
. [0102] .sup.b
.sup.3: The linear velocity of O relative to
in
. [0103] R∈SO(3): The rotational matrix from
to
. [0104] .sup.b
.sup.3: The angular velocity of
relative to
in
. [0105] .sup.b{right arrow over (r)}∈
.sup.3: The position of G; relative to O in
. [0106] .sup.b{right arrow over (r)}.sub.m.sub.
.sup.3: The position of the i.sup.th moving mass relative to
in
. [0107] .sup.b
3: The rotational speed of the i.sup.th rotor in
. [0108] .sup.b
.sup.3: The total force acting on the vehicle in
. [0109] .sup.b{right arrow over (M)}∈
.sup.3: The total moment acting on the vehicle in
. [0110] M∈
: The total mass of the vehicle. [0111] m.sub.i∈
: The mass of the i.sup.th moving mass. [0112] J∈
.sup.3×3: The total moment of inertia of the vehicle [0113] g∈
: The gravitational acceleration.
Hence, the configuration manifold for a coaxial helicopter can be represented in the special Euclidean group:
[0114] In some embodiments described herein, the translational and rotational dynamics of coaxial vehicles, e.g., the embodiment shown in
[0115] In some embodiments, a nonlinear feedback controller may have a coaxial vehicle control system follow an arbitrary twice-differential reference trajectory denoted by g.sub.ref(t) ∈SE(3) consisting of the reference position {right arrow over (p)}.sub.ref(t)∈.sup.3×3, and the reference attitude R.sub.ref (t)∈SO(3). In some embodiments, a nonlinear controller can be separated into three parts: (1) a position controller designed for the vehicle to track the reference position, (2) an attitude controller designed for the vehicle to track the reference attitude, and (3) an actuator controller designed for the actuators to provide the desired amount of forces (thrust) and moments.
[0116] As for the reference trajectory generation for the controller, the smooth function for the reference position, P.sub.ref(t), parameterized by time, t, can be generated from the least squares optimization problem given a set of waypoints, {(P.sub.ref, t.sub.i)}.sub.i=0.sup.N where P.sub.ref.sub..sup.3 and t.sub.i∈
,
where ϕ(
[0117] For the reference attitude R.sub.ref(t), its first column vector, R.sub.refē.sub.1, can be considered as the heading of the vehicle. This vector can be chosen arbitrarily; however, it may be desirable to align the vehicle's heading with the tangential line to the reference position trajectory. Therefore, the heading vector, R.sub.refē.sub.1, can be chosen to have the same direction as the unit vector of the reference velocity vector:
[0118] For the other two column vectors of the reference attitude, R.sub.refē.sub.2 and R.sub.refē.sub.3, they may satisfy the orthogonality condition of the rotation matrix, which can be obtained by the following cross products:
Once the reference attitude is determined, the reference angular velocity,
{right arrow over (ω)}.sub.ref(t)=R.sub.ref.sup.T(t){dot over (R)}.sub.ref(t) Equation 6
[0119] As for the position controller, since {right arrow over (P)}.sub.ref(t) is generated as a function expressed in , it may be beneficial to also express the translational dynamics in
as follows:
Noting that .sup.b{right arrow over (F)} has only the third component of , and .sup.b{right arrow over ({umlaut over (r)})} has only the first and the second components of
, .sup.b
[0120] Next, the tracking error vectors for the position and the velocity can be defined, respectively, as:
ē.sub.p=.sup.I
ē.sub.ν=.sup.I
Then, the stabilizing control force,
Where k.sub.p, k.sub.ν∈.sup.+ are constant positive definite matrices. However, in some embodiments, the current attitude of the vehicle may not immediately align with the desired one, and this may cause the system to become unstable. Accordingly, in some embodiments, the magnitude of the total thrust can be designed to be small if the attitude error is large so that the rotational dynamics can converge faster than the translational one. In these embodiments, by assuming ∥
[0121] Since
can be considered as the desired attitude vector,
is the dot product between the desired attitude vector and the current one. This dot product reduces the magnitude of the total thrust as the angle between these two attitude vectors becomes larger.
[0122] To achieve the reference position tracking, the position controller requires the vehicle's attitude to eb compatible with the translation input {right arrow over (F)}′.sub.d=R.sup.b{right arrow over (F)}′. This can be done by aligning the resulting vector of .sup.b
[0123] To achieve this desired attitude, the third column of the reference attitude, R.sub.refē.sub.3, can coincide with the direction of the unit vector
Nevertheless, this is not always the case since R.sub.ref(t) may have been chosen arbitrarily, as described herein. Accordingly, the following optimization problem may be solved for the correct attitude, R′.sub.ref(t).
where ⊖(•, •): SO(3)×SO(3) is the tracking error for the function given by:
⊖(R.sub.ref,R)=½Trace(I.sub.3−R.sub.ref.sup.TR) Equation 15
The solution to this optimization problem is given by:
where
is Rodrigues' formula given by:
Then, the derivative of R′.sub.ref(t) is given by:
{dot over (R)}′.sub.ref(t)=R′.sub.ref(t)
where
and,
Next, by defining the tracking error vectors for the attitude and the angular velocity
ē.sub.R=½(R′.sub.ref.sup.TR−R.sup.TR′.sub.ref).sup.v Equation 21
{right arrow over (e)}.sub.ω=.sup.b{right arrow over (ω)}−R.sup.TR′.sub.ref
where the operator (•).sup.v: so(3).fwdarw..sup.3 denotes the inverse of the operator ({dot over (•)}), and by supposing that the initial condition of the attitude lying in the sublevel set L.sub.2={R′ref, R∈SO(3)|⊖(R′.sub.ref, R)<2} satisfies
⊖(R′.sub.ref(0),R(0))<2∥ē.sub.ω(0)∥.sup.2<2k.sub.R(2−⊖(R′.sub.ref(0),R(0))) Equation 23
implying the initial attitude error must be less than 180° with respect to the rotational axis between R′.sub.ref(0) and R(0). Then, the stabilizing control moment, .sup.b
where k.sub.R, k.sub.ω∈.sup.+ are constant, and Ψ(R′.sub.ref, R)=½[Trace(R.sup.TR′.sub.ref)I.sub.3−R.sup.TR′.sub.ref].
[0124] As for the actuator controller, the controller can be considered to be broken into both a coaxial motor controller and a linear motor controller (i.e., thrust and mass-movement). As for the coaxial motor controller, the controller input for each rotor, u.sub.Ω, i=1, 2, can be determined by solving a system of two quadratic equations:
∥{right arrow over (F)}′d∥=k.sub.F.sub.
.sup.b{right arrow over (M)}.Math.{right arrow over (e)}.sub.3=k.sub.M.sub.
[0125] As for the linear controller, since .sup.b{right arrow over (r)} and .sup.b{right arrow over (F)} are orthogonal to each other, the reference position, {right arrow over (r)}.sub.ref.sub.
Next, the tracking error vectors for the position and the velocity of each moving mass can be defied, respectively as:
Then, the controller input for each linear motor,
can be given by:
where
are constant.
[0126]
[0127] The process 900 may begin at block 910, where a vehicle control system receives a reference trajectory comprising a reference attitude and a reference position. The reference attitude can further comprise a reference angular velocity for a first rotary shaft of a vehicle and a reference angular acceleration for the first rotary shaft. The reference trajectory may be received, for example, at a flight controller (e.g., flight controller 602).
[0128] At block 920, a vehicle control system can receive data indicative of an attitude and a position of the vehicle. This can be received, for example, by a state-estimator controller (e.g., state estimator 604).
[0129] At block 930, a vehicle control system can track the reference position. This tracking can be performed, for example, by a position controller interacting with one or more linear motor controllers (e.g., linear motor controller 614).
[0130] At block 940, a vehicle control system can calculate a first set of instructions to adjust a position of the vehicle. The calculation can be based at least in part on the reference position.
[0131] At block 950, a vehicle control system can adjust a position of a first mass on the vehicle to alter the position of the vehicle. This step can be performed, for example, by using the moveable masses described herein. This adjustment can be based at least in part on the first set of instructions.
[0132] At block 960, a vehicle control system can track the reference angular velocity for the first rotary shaft and the reference angular acceleration for the first rotary shaft. This can be performed, for example, via the controller 222 or a sub-controller associated therewith, such as an attitude controller. The process 900 may end at block 960. As will be described below, however, additional movement calculations may be processed before, after, or concurrently with process 900. Additionally, each step in process 900 described in the context of a single rotor can also be applied to a second rotor in a coaxial system. Also, each step in process 900 described in the context of a single moveable mass can also be applied to a second moveable mass.
[0133]
[0134] At block 1010, a vehicle control system can calculate a second set of instructions to adjust at least one of a first-rotary-shaft angular velocity or a first-rotary-shaft angular acceleration. The second set of instructions can be based at least in part on the reference angular velocity for the first rotary shaft or the reference angular acceleration for the first rotary shaft.
[0135] At block 1020, a vehicle control system can adjust at least one of the first-rotary-shaft angular velocity or the first-rotary-shaft angular acceleration. This adjustment can be provided via a first power source (e.g., first power source 208). The adjustment can be based at least in part on the second set of instructions.
[0136] At block 1030, a vehicle control system can receive at least one of a desired position, a desired speed, or a desired attitude for the vehicle. The desired movement characteristics can be received at the controller 222 or a sub-controller associated therewith, such as an actuator controller.
[0137] At block 1040, a vehicle control system can calculate a third set of instructions to alter at least one of the position of the vehicle, the first-rotary-shaft angular velocity, or the first-rotary-shaft angular acceleration. The third set of instructions can be based at least in part on the desired position, the desired speed, or the desired attitude. The calculations can be made by the controller 222 or a sub-controller, for example and not limitation a flight controller (e.g., flight controller 602).
[0138] At block 1050, a vehicle control system can adjust the position of the first mass on the vehicle to alter the position of the vehicle. This step can be performed, for example, by using the moveable masses described herein. This adjustment can be based at least in part on the third set of instructions.
[0139] At block 1060, a vehicle control system can adjust at least one of the first-rotary-shaft angular velocity or the first-rotary-shaft angular acceleration. The adjustment can be performed via the first power source (e.g., first power source 208). The adjustment can be based at least in part on the third set of instructions. The process 1000 may end at block 1060. Additional movement calculations may be processed before, after, or concurrently with process 1000. Additionally, each step in process 1000 described in the context of a single rotor can also be applied to a second rotor in a coaxial system. Also, each step in process 1000 described in the context of a single moveable mass can also be applied to a second moveable mass.
[0140] It is to be understood that the embodiments and claims disclosed herein are not limited in their application to the details of construction and arrangement of the components set forth in the description and illustrated in the drawings. Rather, the description and the drawings provide examples of the embodiments envisioned. The embodiments and claims disclosed herein are further capable of other embodiments and of being practiced and carried out in various ways. Also, it is to be understood that the phraseology and terminology employed herein are for the purposes of description and should not be regarded as limiting the claims.
[0141] Accordingly, those skilled in the art will appreciate that the conception upon which the application and claims are based may be readily utilized as a basis for the design of other structures, methods, and systems for carrying out the several purposes of the embodiments and claims presented in this application. It is important, therefore, that the claims be regarded as including such equivalent constructions.
[0142] Furthermore, the purpose of the foregoing Abstract is to enable the United States Patent and Trademark Office and the public generally, and especially including the practitioners in the art who are not familiar with patent and legal terms or phraseology, to determine quickly from a cursory inspection the nature and essence of the technical disclosure of the application. The Abstract is neither intended to define the claims of the application, nor is it intended to be limiting to the scope of the claims in any way. Instead, it is intended that the invention is defined by the claims appended hereto.