The subject matter disclosed herein relates generally to the field of rotorcraft controls and, in particular, to an advanced rotor control algorithm that utilizes vector command limiting in spherical and cylindrical coordinate frames for a rotor control volume.
Typically, a swashplate in a rotorcraft directs motion from a pilot cyclic and collective stick into motion of a rotor and its rotor blades. However, the rotor has limits on longitudinal, lateral and collective commands, which define a control volume for the rotor. In some cases, pilot cyclic and collective command points cause the rotor to move too far beyond the limits of the control volume for safe flight. Conventional control volume limiting for rotor controls relies on evaluation of specific equations representing system constraints in order to stay within the control volume. As the complexity of the constraints increase, these equations are not sufficient to optimally position rotor controls within the control volume, maximize performance or maintain control volume limits. In addition, these equations are complex and require excessive logic and computation time to execute in order to arrive at an optimal position for the rotor. Further, pilot controls that move the command point beyond the control volume requires elaborate calculations in order to arrive at a command point on the surface of the control volume. A control law that utilizes vector command limiting for rotor control that is significantly lower in complexity would be well received in the art.
According to one aspect of the invention, a method for vector limiting of a rotor control volume for a helicopter includes receiving signals with a processor indicative of a displacement command for a rotor during a flight maneuver; determining with the processor an origination point for a command vector in a reference frame; determining with the processor the command vector in the reference frame; determining with the processor a command radius for the command vector; comparing with the processor the command radius with values of estimated command radii in a look-up table; and determining with the processor a control volume limited command in response to the comparing of the command radius with the estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include determining the origination point in one of a spherical coordinate frame or a cylindrical coordinate frame.
In addition one or more of the features described above, or as an alternative, further embodiments could include comparing the command radius with an estimated command radius as a function of command heading.
In addition one or more of the features described above, or as an alternative, further embodiments could include comparing the command radius with a maximum estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include determining the control volume limiting command from an interpolated value of the estimated command radius while the command radius is less than the maximum estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include determining the control volume limited command from a scaled estimated command radius the maximum estimated command radius while the command radius is greater than the maximum estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include determining the control volume limited command for a control volume of the rotor.
According to another aspect of the invention, control system for vector limiting of a rotor control volume for a helicopter, includes one or more controllers configured to issue a displacement command during a flight maneuver; a computer operably connected to the one or more controllers and configured to: receive signals with a processor indicative of a displacement command for a rotor during a flight maneuver; determine with the processor an origination point for a command vector in a reference frame; determine with the processor the command vector in the reference frame; determine with the processor a command radius for the command vector; compare with the processor the command radius with values of estimated command radii in a look-up table; and determine with the processor a control volume limited command in response to the comparing of the command radius with the estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include determining the origination point in one of a spherical coordinate frame or a cylindrical coordinate frame.
In addition one or more of the features described above, or as an alternative, further embodiments could include comparing the command radius with an estimated command radius as a function of command heading.
In addition one or more of the features described above, or as an alternative, further embodiments could include comparing the command radius with a maximum estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include determining the control volume limiting command from an interpolated value of the estimated command radius while the command radius is less than the maximum estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include determining the control volume limited command from a scaled estimated command radius the maximum estimated command radius while the command radius is greater than the maximum estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include determining the control volume limited command for a control volume of the rotor.
According to another aspect of the invention, a helicopter having an airframe; a main rotor with a plurality of rotor blades; and a control system for vector limiting of a control volume of the rotor in the helicopter, includes one or more controllers configured to issue a displacement command during a flight maneuver; a computer operably connected to the one or more controllers and configured to: receive signals with a processor indicative of a displacement command for a rotor during a flight maneuver; determine with the processor an origination point for a command vector in a reference frame; determine with the processor the command vector in the reference frame; determine with the processor a command radius for the command vector; compare with the processor the command radius with values of estimated command radii in a look-up table; and determine with the processor a control volume limited command in response to the comparing of the command radius with the estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include wherein the computer is configured to determining the origination point in one of a spherical coordinate frame or a cylindrical coordinate frame.
In addition one or more of the features described above, or as an alternative, further embodiments could include a computer that is configured to compare the command radius with an estimated command radius as a function of command heading.
In addition one or more of the features described above, or as an alternative, further embodiments could include a computer that is configured to compare the command radius with a maximum estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include a computer that is configured to determine the control volume limiting command from an interpolated value of the estimated command radius while the command radius is less than the maximum estimated command radius.
In addition one or more of the features described above, or as an alternative, further embodiments could include a computer that is configured to determine the control volume limited command from a scaled estimated command radius the maximum estimated command radius while the command radius is greater than the maximum estimated command radius.
Other aspects, features, and techniques of the invention will become more apparent from the following description taken in conjunction with the drawings.
The subject matter, which is regarded as the invention, is particularly pointed out and distinctly claimed in the claims at the conclusion of the specification. The foregoing and other features, and advantages of the invention are apparent from the following detailed description taken in conjunction with the accompanying drawings in which like elements are numbered alike in the several FIGURES:
Referring now to the drawings,
In control system 200, pilot inputs 204, for example, from a controller such as a pilot collective and/or cyclic stick are received by flight control computer 202 (FCC 202) as commanded pitch or roll rates. Pilot inputs 204 include commands to control a direction of flight, for example, roll, pitch or the like. A number of sensors 206 are located on helicopter 100 to sense flight parameters of helicopter 100 such as pitch and/or roll angular velocities, pitch and/or roll angular accelerations, vertical acceleration, airspeed, air density, or the like. Control system 200 includes a FCC 202 that automatically determines commands as a function of a main rotor control volume and commanded collective and cyclic rates in order to produce a desired flight control command 216 as a control volume limited command. In an embodiment, FCC 202 includes a memory 210. Memory 210 stores control volume limiting algorithm 208 as executable instructions that is executed by processor 212. The instructions may be stored or organized in any manner and at any level of abstraction, such as in connection with the execution of control volume limiting algorithm 208. The algorithm when executed by processor 204, enables the computer system 200 to perform the features of the invention as discussed herein Processor 212 may be any type of processor (CPU), including a general purpose processor, a digital signal processor, a microcontroller, an application specific integrated circuit, a field programmable gate array or the like. Also, in embodiments, memory 210 may include random access memory (RAM), read only memory (ROM), or other electronic, optical, magnetic or any other computer readable medium onto which is stored the control volume limiting algorithm 208 described below.
As shown, the exemplary process is initiated at 402 where a pilot command is received by FCC 202 from pilot inputs 204. The command can include a collective command, a longitudinal cyclic command, and/or a lateral cyclic command (e.g., A1s, B1s, Theta0). In 404, an origination point is determined for control volume in a reference frame. In an example, the center of the control volume 300 is defined as the vector origin for a limiting command vector. For an example cylindrical reference frame, vector origin (A0, B0, Theta0) can be defined as:
(A0,B0,Theta0)=(A1s,B1s) at point of desired point of origin and Theta0position (1)
In 406, command vectors are calculated or determined from the pilot command set (A1s, B1s, Theta0) according to equations (2)-(5). The command vector is determined from a length/magnitude of the command and a command heading. The command vector is plotted within the reference frame with the tail of the command vector originating from the vector origin and the head of the command vector being determined from the length/magnitude of the command and the command heading. Next, a command radius for the command vector is determined. In a non-limiting example, the command radius is a radial distance in the spherical or cylindrical coordinate frame.
Compute Control Volume Command Vectors from Input Command Set (A1s, B1s)
A1=A1s−A0; (2)
B1=B1s−B0 (3)
Compute ψ, θ, and Command Radius (r)
r=(A12+B12)1/2 (4)
ψ=tan−1(B1,A1) (5)
In 408, the command vector with its command radius is compared to values stored in a command radius look-up table for determination of a control volume limited command according to equations (6)-(9). The command radius look-up table stores values of radial distance of vectors as a function of command heading from the origin to each surface of the control volume as an estimated command radius. In embodiments, for a spherical coordinate frame, the look-up table stores values for a radial distance of vectors from the origin of the control volume as a function of polar angle and azimuth angle and, for a cylindrical coordinate frame, the look-up table stores values of radial distance of vectors from the origin of the control volume as a function of angular position and height. Also, the look-up table stores a maximum radial distance of vectors from the origin to the surface of the control volume as maximum estimated command radius. The command radius for the command vector is compared to the estimated command radius for the same heading.
Find Nearest Neighbors in the Maximum Command Radius Look-Up Table (R)
nψ=floor((ψ−π)/dψ) (6)
nψ2=nψ+1 (7)
nTheta0=floor((Theta0−minTheta0)/dTheta0) (8)
nTheta02=nTheta0+1 (9)
In 410, an interpolated value for a stored command radius at the same heading (which represents a command vector from the origin along the same direction as the pilot command in the control volume) is returned as an actual control volume limited command if the command radius is within the control volume. But, if command radius is greater than the maximum command radius, the maximum stored command radius along the same heading (which represents a scaled command radius at the control volume surface) is returned as the control volume limited command according to equations (10)-(17).
Interpolate to Find Maximum Allowable Command Radius (r)
kψ=(nψ2−(ψ−π))/dψ (10)
ktheta0=(ntheta0−(Theta0−minthata0))/dtheta0 (11)
R=kψ*(R(nψ,ntheta0)*ktheta0+R(nψ,ntheta0+1)*(1−ktheta0))+(1−kψ)*(R(nψ+1,ntheta0)*ktheta0+R(nψ+1,ntheta0+1)*(1−ktheta0)) (12)
If Command Radius is Greater than Maximum Allowed, Appropriately Scale Command
If (r>R) (13)
A1=A1*R/r (14)
B1=B1*R/r (15)
Calculate A1s, B1s, and Theta0 as a Control Volume Limited Command
A1s=A1+A0 (16)
B1s=B1+B0 (17)
The control volume limited command is applied to the main rotor 104 (
The terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of the invention. While the description of the present invention has been presented for purposes of illustration and description, it is not intended to be exhaustive or limited to the invention in the form disclosed. Many modifications, variations, alterations, substitutions or equivalent arrangements not hereto described will be apparent to those of ordinary skill in the art without departing from the scope and spirit of the invention. Additionally, while the various embodiments of the invention have been described, it is to be understood that aspects of the invention may include only some of the described embodiments. Accordingly, the invention is not to be seen as limited by the foregoing description, but is only limited by the scope of the appended claims.
This invention was made with Government support with the United States Navy under Contract No. N00019-06-C-0081. The Government therefore has certain rights in this invention.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/US15/36876 | 6/22/2015 | WO | 00 |
Number | Date | Country | |
---|---|---|---|
62043480 | Aug 2014 | US |