Gbias for rate based autopilot
10480904 ยท 2019-11-19
Assignee
Inventors
- David J. Schorr (Austin, TX, US)
- Jeremy B. Gibson (Bedford, NH, US)
- James H. Steenson (New Boston, NH, US)
Cpc classification
F41G7/2246
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
G06F17/11
PHYSICS
F41G7/2213
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F41G7/22
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F42B15/10
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F42B15/01
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F41G7/36
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
G05D1/10
PHYSICS
F41G7/226
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F41G7/2293
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
International classification
F41G7/22
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
G06F17/11
PHYSICS
G05D1/10
PHYSICS
F42B15/10
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F41G7/36
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
Abstract
A device, system, and method for shaping the trajectory of a projectile employing a Gravity bias, Gbias. The system includes a seeker, a guidance filter, a pitch rate filter, an actuator, pitch/yaw/roll coupled aerodynamics, and lateral rate sensors. It receives roll orientation input to a guidance and control autopilot; it applies Additional Gbias to that produced by the null rate command to the lateral control loops of the guidance and control autopilot device. The lateral rate command is equal to the desired Additional Gbias divided by an estimate of the projectile velocity. The Additional Gbias is translated to a rate command and incorporated into guidance loop commands to boost an Inherent Gbias to shape the trajectory of the projectile to the target.
Claims
1. A method for shaping a trajectory of a projectile comprising: obtaining input to a guidance and control autopilot system of the projectile, wherein the input comprises roll orientation with respect to gravity, and an estimate of a velocity of the projectile, and providing the input to at least one processor of the guidance and control autopilot system; applying an Additional gravity bias (Gbias) to an Inherent Gbias; determining a total rate command by the at least one processor of the guidance and control autopilot system, wherein an additional rate command is determined by dividing the Additional Gbias by the estimate of the velocity of the projectile; and whereby the guidance and control autopilot system is configured to guide the projectile to a target using the total rate command of the guidance and control autopilot system.
2. The method of claim 1, comprising: determining the Inherent Gbias amount produced by null guidance and control lateral rate control loops of the guidance and control autopilot system.
3. The method of claim 1, comprising: determining a Desired Gbias amount; and determining the Additional Gbias amount.
4. The method of claim 3, wherein an orientation of a roll inertial guidance coordinate frame with respect to gravity is utilized to partition the Desired Gbias into pitch and yaw control loops.
5. The method of claim 3, wherein the Desired Gbias magnitude balances guidance errors with trajectory lofting to produce a near 0 G airframe in an end game.
6. The method of claim 3, wherein the Desired Gbias lofts the trajectory after a seeker laser acquisition.
7. The method of claim 1, where
8. The method of claim 1, wherein the guidance and control autopilot system does not comprise an accelerometer, whereby complexity and cost of the projectile is reduced.
9. The method of claim 1, wherein terminal lateral G requirements of an airframe are ballistic, near 0 G, and residual airframe lateral Gs are available to absorb other endgame guidance errors; the other endgame guidance errors comprising rate sensor errors and seeker errors that have a random orientation with respect to gravity.
10. A system for shaping a trajectory of a projectile comprising: a guidance and control autopilot; at least one processor of the guidance and control autopilot executing a program performing as follows: processing a roll orientation with respect to gravity and an estimate of a velocity of the projectile; determining an Inherent Gbias amount produced by null guidance and control lateral rate control loops of the guidance and control autopilot; determining a Desired Gbias amount; determining an Additional Gbias amount; applying the Additional Gbias to the Inherent Gbias; determining a total rate command by the at least one processor of the guidance and control autopilot system, wherein the total rate command is determined by dividing the Desired Gbias by the estimate of the velocity of the projectile; and guiding the projectile to a target using the total rate command from the guidance and control autopilot.
11. The system of claim 10 wherein the guidance and control autopilot comprises: lateral acceleration sensors; lateral turn rate sensors; velocity sensors; and an orientation determination system, wherein the orientation determination system receives input from the lateral acceleration sensors, the lateral turn rate sensors, and the velocity sensors.
12. The system of claim 10, wherein the roll orientation is input after launch.
13. The system of claim 10, where
14. The system of claim 10, wherein determination of the roll orientation with respect to gravity comprises a magnetometer.
15. The system of claim 10, wherein determination of the roll orientation with respect to gravity comprises an initialized inertial measurement unit (IMU).
16. The system of claim 10, wherein sensors of the guidance and control autopilot comprise only rate sensors.
17. The system of claim 10, wherein the guidance and control autopilot comprises a seeker.
18. The system of claim 10, wherein the guidance and control autopilot is an angular rate based autopilot.
19. The system of claim 10, wherein the system does not comprise an accelerometer, whereby complexity and cost of the projectile is reduced.
20. A guidance and control autopilot device for shaping a trajectory of a projectile comprising: a feed forward section; a guidance filter; pitch/yaw/roll coupled aerodynamics; a feed forward section; a pitch rate sensor; wherein at least one processor determines a total rate command equal to an Additional Gbias divided by an estimate of a velocity of the projectile, combined with guidance loop commands, incorporating a roll orientation with respect to gravity; and whereby the guidance and control autopilot device is configured to guide the projectile to a target.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9) These and other features of the present embodiments will be understood better by reading the following detailed description, taken together with the figures herein described. The accompanying drawings are not intended to be drawn to scale. For purposes of clarity, not every component may be labeled in every drawing.
DETAILED DESCRIPTION
(10) The features and advantages described herein are not all-inclusive and, in particular, many additional features and advantages will be apparent to one of ordinary skill in the art in view of the drawings, specification, and claims. Moreover, it should be noted that the language used in the specification has been selected principally for readability and instructional purposes, and not to limit in any way the scope of the inventive subject matter. The invention is susceptible of many embodiments. What follows is illustrative, but not exhaustive, of the scope of the invention.
(11) Embodiments augment the rate loop architecture with a small Gbias in the vertical direction. Embodiments include input of roll orientation with respect to gravity. In embodiments, the ability to determine the roll orientation with respect to gravity provides for a much more direct and effective way of reshaping the vertical trajectory to increase range, probability of hit, and warhead results.
(12) Advantages include a large increase in maximum effective range with no negative impact on short and mid-range targets. Flight path angles and rocket pitch angles are substantially improved, providing for a much higher probability of hit, improved fuze function on horizontal targets, and much closer ground impacts for near misses, resulting in much higher warhead accuracy and effectiveness for longer range targets.
(13) Embodiments provide for trajectory shaping and performance improvement for any rate-based autopilot design.
(14)
(15) In embodiments, Gbias is added to shape the guided rocket trajectory. The total rate bias that is introduced is determined based on the additional vertical Gs that are preferred above inherent levels that are produced by the null rate command of the guidance and control lateral control loops. It is possible for Gbias values below 1.0 to result in sagging trajectories, poor flight path angles, ground impacts in front of the target and reduced accuracy. For embodiments, the objective is to add Additional Gbias to boost the Inherent low Gbias to 1.0 or more. The Additional Gbias is translated to a rate command for use by the lateral control loops as follows, where {dot over ()}.sub.c is the additional rate command (735) for use by the lateral control loops, a.sub.m is an estimate of additional acceleration of the projectile, V.sub.m is the estimate of the velocity of the projectile (710), and Gbias is the Additional Gbias (725).
(16)
(17) The total rate command introduced to the airframe is equal to the Additional Gbias divided by an estimate of the missile velocity V.sub.m combined with the guidance loop commands. Typical turn rate command produced by the Additional Gbias is under 1 degree per second (i.e. (0.4Gs*9.81)/(300 m/s)=>0.75 degrees/second), but has a dramatic effect on the trajectory shape. The roll orientation (with respect to the direction of gravity) of the rocket is known. The orientation of the rocket with respect to gravity is utilized to partition the bias into the pitch and yaw control loops. In embodiments, the Gbias components of the airframe turn rate commands are added with guidance commands to produce a total turn rate command for the airframe.
(18)
(19)
where {dot over ()}.sub.c=the additional rate command for use by the lateral control loops, a.sub.m=the additional lateral acceleration of the missile, V.sub.m=an estimate of the velocity of the missile (710), and Gbias=the Additional Gbias (725).
(20)
(21)
(22)
(23)
(24) The substantial increase in accuracy at longer ranges is primarily caused by a large reduction in the maneuver requirements on the airframe due to the trajectory shaping. A Gbias has been selected that lofts the trajectory after seeker laser acquisition so that proportional navigation guidance commands can pull the airframe down into the target at a rate that is similar to a ballistic trajectory. The terminal guidance vertical Gs required before the addition of Gbias were approximately 1 G or more, while with Gbias, the terminal lateral G requirements of the airframe are near 0 Gs (ballistic). As a result, the residual airframe lateral G capability is then available to absorb other endgame guidance errors such as rate sensor errors and seeker errors that have a random orientation with respect to gravity.
(25)
(26)
(27) The computing system used for shaping the trajectory of a projectile employing a Gravity bias for performing (or controlling) the operations or functions described hereinabove with respect to the system and/or the method may include a processor, I/O devices, a memory system, and a network adaptor. The computing system includes a program module (not shown) for performing (or controlling) the operations or functions described hereinabove with respect to the system and/or the method according to exemplary embodiments. For example, the program module may include routines, programs, objects, components, logic, data structures, or the like, for performing particular tasks or implement particular abstract data types. The processor may execute instructions written in the program module to perform (or control) the operations or functions described hereinabove with respect to the system and/or the method. The program module may be programmed into the integrated circuits of the processor. In an exemplary embodiment, the program module may be stored in the memory system or in a remote computer system storage media.
(28) The computing system may include a variety of computing system readable media. Such media may be any available media that is accessible by the computer system, and it may include both volatile and non-volatile media, removable and non-removable media.
(29) The memory system can include computer system readable media in the form of volatile memory, such as random access memory (RAM) and/or cache memory or others. The computer system may further include other removable/non-removable, volatile/non-volatile computer system storage media. The computer system can communicate with one or more devices using the network adapter. The network adapter may support wired communications based on Internet, LAN, WAN, or the like, or wireless communications based on CDMA, GSM, wideband CDMA, CDMA-2000, TDMA, LTE, wireless LAN, Bluetooth, or the like.
(30) The present disclosure describes a system, a method, and/or a computer program product at any possible technical detail level of integration. The computer program product may include a computer readable storage medium (or media) having computer readable program instructions thereon for causing a processor to carry out aspects of the present invention.
(31) The computer readable storage medium can be a tangible device that can retain and store instructions for use by an instruction execution device. The computer readable storage medium may be, for example, but is not limited to, an electronic storage device, a magnetic storage device, an optical storage device, an electromagnetic storage device, a semiconductor storage device, or any suitable combination of the foregoing. A non-exhaustive list of more specific examples of the computer readable storage medium includes the following: a portable computer diskette, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or Flash memory), a static random access memory (SRAM), a portable compact disc read-only memory (CD-ROM), a digital versatile disk (DVD), a memory stick, a floppy disk, a mechanically encoded device such as punch-cards or raised structures in a groove having instructions recorded thereon, and any suitable combination of the foregoing. A computer readable storage medium, as used herein, is not to be construed as being transitory signals per se, such as radio waves or other freely propagating electromagnetic waves, electromagnetic waves propagating through a waveguide or other transmission media (e.g., light pulses passing through a fiber-optic cable), or electrical signals transmitted through a wire.
(32) Computer readable program instructions described herein can be downloaded to respective computing/processing devices from a computer readable storage medium or to an external computer or external storage device via a network, for example, the Internet, a local area network, a wide area network and/or a wireless network. The network may comprise copper transmission cables, optical transmission fibers, wireless transmission, routers, firewalls, switches, gateway computers and/or edge servers. A network adapter card or network interface in each computing/processing device receives computer readable program instructions from the network and forwards the computer readable program instructions for storage in a computer readable storage medium within the respective computing/processing device.
(33) Computer readable program instructions for carrying out operations of the present invention may be assembler instructions, instruction-set-architecture (ISA) instructions, machine instructions, machine dependent instructions, microcode, firmware instructions, state-setting data, configuration data for integrated circuitry, or either source code or object code written in any combination of one or more programming languages, including an object oriented programming language such as Smalltalk, C++ or the like, and procedural programming languages, such as the C programming language or similar programming languages. The computer readable program instructions may execute entirely on the user's computer, partly on the user's computer, as a stand-alone software package, partly on the user's computer and partly on a remote computer or entirely on the remote computer or server. In the latter scenario, the remote computer may be connected to the user's computer through any type of network, including a local area network (LAN) or a wide area network (WAN), or the connection may be made to an external computer (for example, through the Internet using an Internet Service Provider). In some embodiments, electronic circuitry including, for example, programmable logic circuitry, field-programmable gate arrays (FPGA), or programmable logic arrays (PLA) may execute the computer readable program instructions by utilizing state information of the computer readable program instructions to personalize the electronic circuitry, in order to perform aspects of the present invention.
(34) Aspects of the present invention are described herein with reference to a flowchart illustration and/or block diagram of methods, apparatus (systems), and computer program products according to embodiments of the invention. It will be understood that each block of the flowchart illustrations and/or block diagrams, and combinations of blocks in the flowchart illustrations and/or block diagrams, can be implemented by computer readable program instructions.
(35) These computer readable program instructions may be provided to a processor of a general purpose computer, special purpose computer, or other programmable data processing apparatus to produce a machine, such that the instructions, which execute via the processor of the computer or other programmable data processing apparatus, create means for implementing the functions/acts specified in the flowchart and/or block diagram block or blocks. These computer readable program instructions may also be stored in a computer readable storage medium that can direct a computer, a programmable data processing apparatus, and/or other devices to function in a particular manner, such that the computer readable storage medium having instructions stored therein comprises an article of manufacture including instructions which implement aspects of the function/act specified in the flowchart and/or block diagram block or blocks.
(36) The computer readable program instructions may also be loaded onto a computer, other programmable data processing apparatus, or other device to cause a series of operational steps to be performed on the computer, other programmable apparatus or other device to produce a computer implemented process, such that the instructions which execute on the computer, other programmable apparatus, or other device implement the functions/acts specified in the flowchart and/or block diagram block or blocks.
(37) The flowchart and block diagrams in the Figures illustrate the architecture, functionality, and operation of possible implementations of systems, methods, and computer program products according to various embodiments of the present invention. In this regard, each block in the flowchart or block diagrams may represent a module, segment, or portion of instructions, which comprises one or more executable instructions for implementing the specified logical function(s). In some alternative implementations, the functions noted in the blocks may occur out of the order noted in the Figures. For example, two blocks shown in succession may, in fact, be executed substantially concurrently, or the blocks may sometimes be executed in the reverse order, depending upon the functionality involved. It will also be noted that each block of the block diagrams and/or flowchart illustration, and combinations of blocks in the block diagrams and/or flowchart illustration, can be implemented by special purpose hardware-based systems that perform the specified functions or acts or carry out combinations of special purpose hardware and computer instructions.
(38) The foregoing description of the embodiments has been presented for the purposes of illustration and description. It is not intended to be exhaustive or to limit the invention to the precise form disclosed. Many modifications and variations are possible in light of this disclosure. It is intended that the scope of the present disclosure be limited not by this detailed description, but rather by the claims appended hereto.
(39) A number of implementations have been described. Nevertheless, it will be understood that various modifications may be made without departing from the scope of the disclosure. Although operations are depicted in the drawings in a particular order, this should not be understood as requiring that such operations be performed in the particular order shown or in sequential order, or that all illustrated operations be performed, to achieve desirable results.
(40) Each and every page of this submission, and all contents thereon, however characterized, identified, or numbered, is considered a substantive part of this application for all purposes, irrespective of form or placement within the application. This specification is not intended to be exhaustive or to limit the invention to the precise form disclosed. Many modifications and variations are possible in light of this disclosure. Other and various embodiments will be readily apparent to those skilled in the art, from this description, figures, and the claims that follow. It is intended that the scope of the invention be limited not by this detailed description, but rather by the claims appended hereto.