RU2542690C1 - Method of forming signals of controlling missiles - Google Patents
Method of forming signals of controlling missiles Download PDFInfo
- Publication number
- RU2542690C1 RU2542690C1 RU2013155044/11A RU2013155044A RU2542690C1 RU 2542690 C1 RU2542690 C1 RU 2542690C1 RU 2013155044/11 A RU2013155044/11 A RU 2013155044/11A RU 2013155044 A RU2013155044 A RU 2013155044A RU 2542690 C1 RU2542690 C1 RU 2542690C1
- Authority
- RU
- Russia
- Prior art keywords
- projectile
- target
- signals
- velocity
- coordinates
- Prior art date
Links
Images
Landscapes
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
Abstract
Description
Предлагаемое изобретение относится к области разработки систем управления беспилотными летательными аппаратами и может быть использовано в комплексах управляемого ракетного и артиллерийского вооружения, в которых осуществляется наведение по сигналам спутниковых навигационных систем.The present invention relates to the field of development of control systems for unmanned aerial vehicles and can be used in complexes of guided missile and artillery weapons, which are guided by the signals of satellite navigation systems.
Известен способ формирования управляющих сигналов (В.И. Бабичев, В.В. Ветров, А.В. Игнатов, А.Р. Орлов «Основы устройства и функционирования артиллерийских управляемых снарядов», Тула, издательство ТулГУ, 2003 г., с.41, 108-120), включающий определение угловой скорости линии «снаряд-цель» (линии визирования цели) и формирование сигналов управления рулевым приводом, пропорциональных измеренной угловой скорости.A known method of generating control signals (V.I. Babichev, V.V. Vetrov, A.V. Ignatov, A.R. Orlov "Fundamentals of the design and functioning of artillery guided missiles", Tula, TulSU publishing house, 2003, p. 41, 108-120), which includes determining the angular velocity of the projectile-target line (line of sight of the target) and generating steering control signals proportional to the measured angular velocity.
Для реализации данного способа, называемого методом пропорциональной навигации, требуется, чтобы на борту снаряда находилась следящая за целью гироскопическая головка самонаведения (ГСН), определяющая угловую скорость линии визирования цели и формирующая сигналы, пропорциональные угловой скорости линии визирования цели:To implement this method, called the method of proportional navigation, it is required that on board the projectile there should be a gyroscopic homing head tracking the target, determining the angular velocity of the line of sight of the target and generating signals proportional to the angular velocity of the line of sight of the target:
где UY, UZ - сигналы управления рулевым приводом (РП) в вертикальной и горизонтальной плоскостях;where U Y , U Z - steering control signals (RP) in the vertical and horizontal planes;
k - коэффициент пропорциональности;k is the coefficient of proportionality;
θлв, φлв - углы наклона и поворота линии визирования цели.θ lv , φ lv - the angles of inclination and rotation of the line of sight of the target.
Фотоприемное устройство (ФПУ) ГСН при этом измеряет рассогласование между линией визирования цели и осью ФПУ:The photodetector (FPU) of the seeker measures the mismatch between the line of sight of the target and the axis of the FPU:
Δφу=θлв-ϑг; ΔφZ=φлв-ψг,Δφ y = θ lv -ϑ g ; Δφ Z = φ lv -ψ g ,
где ϑг, ψг - углы наклона и поворота гирокоординатора ГСН.where ϑ g , ψ g are the angles of inclination and rotation of the GOS gyrocoordinator.
Датчик момента преобразует сигналы Δφy, Δφz в моменты коррекции My,z, разворачивающие гирокоординатор на цель:The torque sensor converts the signals Δφ y , Δφ z at the correction moments M y, z , deploying the gyro coordinator to the target:
где k1 - коэффициент пропорциональности;where k 1 is the coefficient of proportionality;
T1 - постоянная времени ФПУ;T 1 - time constant FPU;
T2 - постоянная времени датчика момента.T 2 is the time constant of the torque sensor.
Передаточная функция гирокоординатора в упрощенной форме имеет вид:The transfer function of the gyrocoordinator in a simplified form is:
где H - кинетический момент ротора гирокоординатора.where H is the kinetic moment of the rotor of the gyrocoordinator.
Формируемые моменты коррекции и сигналы управления РП при достаточно малых T1 и T2 пропорциональны угловой скорости линии визирования цели:The formed correction moments and RP control signals at sufficiently small T 1 and T 2 are proportional to the angular velocity of the target line of sight:
где T - постоянная времени контура слежения за целью, определяемая добротностью ГСН.where T is the time constant of the tracking loop for the target, determined by the quality factor of the GOS.
Недостатком такого формирования сигналов управления является ограничение пороговой чувствительности ГСН и вследствие этого ограничение дальности начала самонаведения. Увеличение максимальной дальности стрельбы при обеспечении требуемой точности попадания снаряда в цель возможно при увеличении дальности начала самонаведения в связи с необходимостью выбора снарядом увеличивающегося с увеличением дальности стрельбы рассеивания снаряда.The disadvantage of this formation of control signals is the limitation of the threshold sensitivity of the seeker and, consequently, the limitation of the range of the start of homing. An increase in the maximum firing range while ensuring the required accuracy of hitting the projectile at the target is possible with an increase in the range of the start of homing due to the need for the projectile to increase the dispersion of the projectile increasing with increasing firing range.
Спутниковые навигационные системы (СНС), обеспечивающие определение координат и скорости снаряда, позволяют осуществлять наведение снаряда на цель до начала наведения снаряда на цель по сигналам ГСН, что позволяет увеличить максимальную дальность стрельбы. Одной из проблем, связанных с использованием СНС, является зашумленность сигналов координат и скорости (в меньшей степени) снаряда.Satellite navigation systems (SNA), providing the determination of the coordinates and velocity of the projectile, allow the projectile to be aimed at the target before the projectile is aimed at the target using GOS signals, which allows to increase the maximum firing range. One of the problems associated with the use of the SNA is the noise of the coordinate signals and the velocity (to a lesser extent) of the projectile.
Задачей предлагаемого изобретения является разработка способа формирования сигналов управления снарядом по сигналам СНС. Измерение СНС координат и скорости снаряда позволяет осуществлять наведение по методу пропорциональной навигации или по методу погони, когда сигналы управления формируются таким образом, чтобы вектор скорости снаряда был направлен на цель. Однако при наведении по методу погони контур наведения снаряда более чувствителен к расфазировке в сигналах управления, возникающей вследствие изменения требуемого угла фазирования системы при изменении частоты вращения снаряда по крену относительно его расчетного значения, определяемого при расчетном значении частоты вращения по крену. Поэтому наведение снаряда на цель по сигналам СНС осуществляется по методу пропорциональной навигации. Для обеспечения требуемой точности попадания снаряда в цель необходимо также уменьшить зашумленность измеренных СНС сигналов координат снаряда.The objective of the invention is to develop a method for generating control signals of the projectile according to the signals of the SNA. Measurement of the SNA coordinates and projectile speed allows for guidance using the proportional navigation method or the chase method, when control signals are generated so that the projectile velocity vector is aimed at the target. However, when guided by the chase method, the projectile guidance loop is more sensitive to misphasing in control signals resulting from a change in the required phasing angle of the system when the rotational speed of the projectile along the roll changes relative to its calculated value, which is determined by the calculated value of the roll speed. Therefore, the guidance of the projectile at the target by the signals of the SNA is carried out by the method of proportional navigation. To ensure the required accuracy of the projectile hitting the target, it is also necessary to reduce the noise level of the measured SSS of the projectile coordinate signals.
Решение задачи достигается тем, что в способе формирования сигналов управления снарядом, включающем определение угловой скорости линии визирования цели и формирование сигналов управления, пропорциональных угловой скорости линии визирования цели, угловую скорость линии визирования цели в вертикальной
где
Хф, Yф, Zф - сглаженные координаты снаряда;X f , Y f , Z f - the smoothed coordinates of the projectile;
Vx, Vy, Vz - проекции скорости снаряда, измеренные СНС;V x , V y , V z - projection of the velocity of the projectile, measured SNA;
Хц, Yц, Zц - координаты цели, введенные в аппаратуру снаряда перед стартом снаряда.X c , Y c , Z c - target coordinates entered into the projectile equipment before the projectile starts.
Предлагаемый способ формирования управляющих сигналов осуществляется следующим образом. Перед пуском снаряда определяют координаты цели Хц, Yц, Zц и время начала наведения по сигналам СНС, отсчитываемое от момента старта. После пуска снаряда по истечении заданного промежутка времени измеряют координаты X, Y, Z и проекции скорости снаряда Vx, Vy, Vz, последние интегрируют, разности координат X, Y, Z и интегралов от соответствующих проекций скорости фильтруют, сигналы, полученные в результате фильтрации, суммируют с интегралами от соответствующих проекций скорости. По полученным сигналам Хф, Yф, Zф, проекциям скорости снаряда Vx, Vy, Vz и координатам цели Хц, Yц, Zц определяют угловые скорости разворота линии визирования цели в соответствии с зависимостями (1), (2). Затем формируют сигналы управления рулями, пропорциональные измеренным проекциям угловой скорости.The proposed method of generating control signals is as follows. Before launching the projectile, the coordinates of the target X c , Y c , Z c and the start time of guidance on the signals of the SNA, counted from the start are determined. After the launch of the projectile after a predetermined period of time, the coordinates X, Y, Z and projections of the projectile velocity V x , V y , V z are measured, the latter are integrated, the differences between the coordinates X, Y, Z and the integrals from the corresponding velocity projections are filtered, the signals received in filtering result, summarized with the integrals of the corresponding velocity projections. The received signals X f , Y f , Z f , projections of the projectile velocity V x , V y , V z and the target coordinates X c , Y c , Z c determine the angular velocity of the turn of the line of sight of the target in accordance with the dependencies (1), ( 2). Then form the steering control signals proportional to the measured projections of the angular velocity.
Зависимости (1) и (2) позволяют вычислить угловые скорости наклона и разворота линии визирования цели. Углы наклона и разворота линии визирования цели определяются в соответствии с зависимостями:Dependencies (1) and (2) allow us to calculate the angular velocity of the slope and turn of the line of sight of the target. The angles of inclination and rotation of the line of sight of the target are determined in accordance with the dependencies:
где Y, Z - координаты снаряда.where Y, Z are the projectile coordinates.
Продифференцировав (3), (4), получим:Differentiating (3), (4), we obtain:
Угловую скорость наклона линии визирования целесообразно определять по упрощенной зависимости:The angular velocity of the slope of the line of sight, it is advisable to determine the simplified dependence:
так как величина
Угловую скорость линии визирования цели необходимо определять в соответствии с зависимостями (1), (2), так как при численном дифференцировании выражений (3), (4) возникают дополнительные помеховые составляющие.The angular velocity of the line of sight of the target must be determined in accordance with the dependencies (1), (2), since the numerical differentiation of expressions (3), (4) creates additional interference components.
Сглаживание (фильтрация) координат, измеренных СНС, в соответствии с предлагаемым способом повышает точность измерения координат снаряда. Фильтрация в данном случае основана на различном уровне шумов, содержащихся в измеренных координатах и проекциях скорости: шумы проекций скорости достаточно малы, а шумы измеренных координат требуют фильтрации. Если проинтегрировать измеренные проекции скорости, то получим оценочные значения координат, содержащие меньший шум, чем непосредственно измеренные значения координат. Но чтобы измерять координаты интегрированием проекций скорости, необходимо иметь начальные условия, которые могут быть получены непосредственным измерением координат, следовательно, на начальные условия повлияет шум, присутствующий в измеренных координатах. Кроме того, возможно накопление ошибки интегрирования. Поэтому в предлагаемом способе интегралы от проекций скорости суммируют с сигналами, полученными в результате фильтрации разностей непосредственно измеренных координат и интегралов от проекций скорости. Апериодический фильтр служит для уменьшения амплитуды шума, содержащегося в непосредственно измеренной координате, но при этом в измеренную координату вносится запаздывание. Чтобы исключить несоответствие по времени, фильтрации подвергают не координату, а ее разность с координатой, полученной интегрированием проекции скорости. Величина на выходе фильтра служит поправкой на ошибку интегрирования. Поскольку требуемая поправка, в отличие от самих координат снаряда, изменяется медленно, запаздывание, вносимое в нее фильтром, является допустимым.Smoothing (filtering) the coordinates measured by the SNA in accordance with the proposed method improves the accuracy of measuring the coordinates of the projectile. Filtering in this case is based on a different level of noise contained in the measured coordinates and velocity projections: the noise of the velocity projections is quite small, and the noise of the measured coordinates require filtering. If we integrate the measured velocity projections, we obtain estimated coordinate values containing less noise than the directly measured coordinate values. But in order to measure coordinates by integrating velocity projections, it is necessary to have initial conditions that can be obtained by direct measurement of coordinates, therefore, the noise present in the measured coordinates will affect the initial conditions. In addition, the accumulation of integration errors is possible. Therefore, in the proposed method, the integrals of the velocity projections are summed with the signals obtained by filtering the differences of the directly measured coordinates and the integrals of the velocity projections. The aperiodic filter serves to reduce the amplitude of the noise contained in the directly measured coordinate, but at the same time, delay is introduced into the measured coordinate. In order to eliminate a time mismatch, the coordinate is not filtered, but its difference with the coordinate obtained by integrating the velocity projection. The value at the output of the filter is a correction for the integration error. Since the required correction, in contrast to the projectile coordinates themselves, changes slowly, the delay introduced into it by the filter is acceptable.
Предлагаемый фильтр координат аналогичен фильтру Калмана для измеренной координаты при наличии точно измеренной скорости. Уравнения фильтра Калмана, например, для координаты X в этом случае примут вид:The proposed coordinate filter is similar to the Kalman filter for the measured coordinate in the presence of a precisely measured speed. The Kalman filter equations, for example, for the X coordinate in this case will take the form:
где Δt - интервал приема сигнала СНС;where Δt is the reception interval of the SNA signal;
Vx h-1 - измеренное на h-1 шаге значение проекции скорости снаряда;V x h-1 - measured at the h-1 step value of the projection of the velocity of the projectile;
Хизм h - измеренное значение координаты.X ISM h - the measured value of the coordinate.
Подставляя (5) в (6), получим:Substituting (5) in (6), we obtain:
Дискретное преобразование предлагаемого фильтра для координаты X определяется уравнением:The discrete transformation of the proposed filter for the X coordinate is determined by the equation:
Зависимость (9) аналогична зависимости (8) при переменной величине T, определяемой в соответствии с зависимостью:Dependence (9) is similar to dependence (8) for a variable T, determined in accordance with the dependence:
. .
В предлагаемом способе постоянная времени T изменяется дискретно.In the proposed method, the time constant T varies discretely.
Предлагаемый способ управления снарядом поясняют графические материалы, приведенные на фигурах 1-5.The proposed method of controlling the shell explain the graphic materials shown in figures 1-5.
На фиг.1 приведена угловая скорость наклона линии визирования цели при определении ее в соответствии с зависимостью (1) - процесс 2 и при дифференцировании в соответствии с зависимостью (3) - процесс 1. Из фиг.1 видно, что угловая скорость, определяемая в соответствии с зависимостью (1), менее зашумлена.Figure 1 shows the angular velocity of the slope of the line of sight of the target when determining it in accordance with the dependence (1) -
На фиг.2 приведена структурная схема предлагаемого фильтра координат. На фиг.2 обозначено:Figure 2 shows the structural diagram of the proposed filter coordinates. In figure 2 is indicated:
Хф - координата X на выходе фильтра координат;X f - X coordinate at the output of the coordinate filter;
ХV - координата, определенная интегрированием измеренной скорости;X V is the coordinate determined by integrating the measured speed;
ΔX - разность измеренных координат на выходе фильтра;ΔX is the difference of the measured coordinates at the filter output;
T - постоянная времени фильтра.T is the filter time constant.
На фиг.3, 4 приведены ошибки ΔX и ΔY определения координат X и Y без фильтрации (процесс 1), при фильтрации предлагаемым фильтром (процесс 2) с постоянной времени T, равной:Figure 3, 4 shows the errors ΔX and ΔY of determining the coordinates of X and Y without filtering (process 1), when filtering by the proposed filter (process 2) with a time constant T equal to:
а также при фильтрации фильтром Калмана без ограничения Bh (процесс 3) и при ограничении Bh при h>49 (процесс 4). Из фиг.3, 4 видно, что если коэффициент Bh фильтра Калмана не уменьшать ниже 0.05 (h>49), то при предлагаемом изменении постоянной времени предлагаемого фильтра установившиеся процессы фильтрации предлагаемым фильтром и фильтром Калмана с ограничением совпадают. Фильтр Калмана, у которого коэффициент В всегда без ограничения определяется формулой (7), подавляет шум эффективно, но постепенно уходит от истинного значения.as well as when filtering with a Kalman filter without restricting B h (process 3) and when restricting B h at h> 49 (process 4). From figure 3, 4 it is seen that if the coefficient B h of the Kalman filter is not reduced below 0.05 (h> 49), then with the proposed change in the time constant of the proposed filter, the established filtering processes by the proposed filter and the Kalman filter with a restriction coincide. The Kalman filter, for which the coefficient B is always determined without limitation by formula (7), suppresses noise efficiently, but gradually moves away from the true value.
На фиг.5 приведены ошибки определения угловой скорости наклона линии визирования цели при отсутствии фильтрации (процесс 1), при фильтрации предлагаемым фильтром (процесс 2), при фильтрации фильтром Калмана без ограничения Bh (процесс 3) и с ограничением Bh (процесс 4). Из фиг.5 видно, что применение предлагаемого фильтра обеспечивает наилучшую фильтрацию, фильтр Калмана с ограничением наиболее близок к предлагаемому фильтру. Таким образом, предлагаемая фильтрация обеспечивает требуемую точность определения угловой скорости линии визирования цели при достаточной простоте реализации.Figure 5 shows errors in determining the angular velocity of the slope of the line of sight of the target in the absence of filtration (process 1), when filtering with the proposed filter (process 2), when filtering with a Kalman filter without restriction B h (process 3) and with restriction B h (process 4 ) Figure 5 shows that the use of the proposed filter provides the best filtration, Kalman filter with a restriction is closest to the proposed filter. Thus, the proposed filtering provides the required accuracy in determining the angular velocity of the line of sight of the target with sufficient ease of implementation.
Claims (1)
где
Xф, Yф, Zф - сглаженные координаты снаряда;
Vx, Vy, Vz - проекции скорости снаряда;
Хц, Yц, Zц - координаты цели. A method for generating projectile control signals, including determining the angular velocity of the target line of sight, generating rudder control signals proportional to the angular speed of the target line of sight, characterized in that the angular velocity of the target line of sight in vertical
Where
X f , Y f , Z f - the smoothed coordinates of the projectile;
V x , V y , V z - projection of the velocity of the projectile;
X n, Y n, Z n - target coordinates.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2013155044/11A RU2542690C1 (en) | 2013-12-11 | 2013-12-11 | Method of forming signals of controlling missiles |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2013155044/11A RU2542690C1 (en) | 2013-12-11 | 2013-12-11 | Method of forming signals of controlling missiles |
Publications (1)
Publication Number | Publication Date |
---|---|
RU2542690C1 true RU2542690C1 (en) | 2015-02-20 |
Family
ID=53289106
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
RU2013155044/11A RU2542690C1 (en) | 2013-12-11 | 2013-12-11 | Method of forming signals of controlling missiles |
Country Status (1)
Country | Link |
---|---|
RU (1) | RU2542690C1 (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5042742A (en) * | 1989-12-22 | 1991-08-27 | Hughes Aircraft Company | Microcontroller for controlling an airborne vehicle |
FR2694626A1 (en) * | 1992-08-07 | 1994-02-11 | Thomson Csf | Automatic guidance procedure for missile - avoids interaction between pitch roll and yaw control systems for symmetrically controlled missiles. |
RU2224972C2 (en) * | 2002-04-04 | 2004-02-27 | Государственное унитарное предприятие "Конструкторское бюро приборостроения" | Guided missile guidance system |
RU2247298C1 (en) * | 2003-07-08 | 2005-02-27 | Государственное унитарное предприятие "Конструкторское бюро приборостроения" | Method for firing of fighting vehicle at high-speed target and system for its realization |
-
2013
- 2013-12-11 RU RU2013155044/11A patent/RU2542690C1/en active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5042742A (en) * | 1989-12-22 | 1991-08-27 | Hughes Aircraft Company | Microcontroller for controlling an airborne vehicle |
FR2694626A1 (en) * | 1992-08-07 | 1994-02-11 | Thomson Csf | Automatic guidance procedure for missile - avoids interaction between pitch roll and yaw control systems for symmetrically controlled missiles. |
RU2224972C2 (en) * | 2002-04-04 | 2004-02-27 | Государственное унитарное предприятие "Конструкторское бюро приборостроения" | Guided missile guidance system |
RU2247298C1 (en) * | 2003-07-08 | 2005-02-27 | Государственное унитарное предприятие "Конструкторское бюро приборостроения" | Method for firing of fighting vehicle at high-speed target and system for its realization |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6388661B2 (en) | Inertial navigation device | |
US6163021A (en) | Navigation system for spinning projectiles | |
EP3213034B1 (en) | Inertial navigation system with compensation of roll scale factor error | |
EP1910770B1 (en) | Apparatus and appertaining method for upfinding in spinning projectiles using a phase-lock-loop or correlator mechanism | |
WO2020114293A1 (en) | Magnetic side roll-based rotary shell muzzle initial parameter measuring method | |
CN108931155B (en) | Autonomous guidance system independent of satellite navigation extended-range guidance ammunition | |
US6345785B1 (en) | Drag-brake deployment method and apparatus for range error correction of spinning, gun-launched artillery projectiles | |
WO2008051204A2 (en) | Surface rf emitter passive ranging accuracy confirmation algorithm | |
CN111351401B (en) | Anti-sideslip guidance method applied to strapdown seeker guidance aircraft | |
KR101625509B1 (en) | Roll angle estimation method of rotating craft | |
CN111504256A (en) | Roll angle real-time estimation method based on least square method | |
US8502126B2 (en) | System and method for navigating an object | |
Kalach et al. | Loosely coupled navigation system based on expert system using fuzzy logic | |
EP2758741B1 (en) | Method and gnc system for determination of roll angle | |
RU2542690C1 (en) | Method of forming signals of controlling missiles | |
JP7342244B2 (en) | Method and system for determining depth of an object | |
WO2018107733A1 (en) | Method and device for controlling airship | |
CN112445230B (en) | High-dynamic aircraft multi-mode guidance system and guidance method under large-span complex environment | |
CN111412793B (en) | Anti-sideslip full-range coverage control system applied to remote guidance aircraft | |
US10222214B2 (en) | Digital sight for hand-carried projectile-firing device and method of controlling the same | |
RU2674401C2 (en) | Method of firing guided artillery projectile | |
JP2002538410A (en) | High-accuracy long-range light-assisted inertial-guided missile | |
RU2584400C1 (en) | Method of determining roll angle of strapdown inertial navigation system of roll artillery projectile | |
RU2254542C1 (en) | Method for guidance of flight vehicle on intensively maneuvering target | |
Yu et al. | Guidance information estimation of the semi-strapdown infrared imaging seeker |