RU2293949C1 - Two-axial controlled gyro-stabilizer - Google Patents
Two-axial controlled gyro-stabilizer Download PDFInfo
- Publication number
- RU2293949C1 RU2293949C1 RU2005130383/28A RU2005130383A RU2293949C1 RU 2293949 C1 RU2293949 C1 RU 2293949C1 RU 2005130383/28 A RU2005130383/28 A RU 2005130383/28A RU 2005130383 A RU2005130383 A RU 2005130383A RU 2293949 C1 RU2293949 C1 RU 2293949C1
- Authority
- RU
- Russia
- Prior art keywords
- input
- output
- vkksnr
- axis
- adder
- Prior art date
Links
Images
Landscapes
- Gyroscopes (AREA)
Abstract
Description
Изобретение относится к гироскопической технике, а более конкретно к двухосным управляемым индикаторным гиростабилизаторам, работающим на подвижных объектах и предназначенным для стабилизации и управления линией визирования.The invention relates to a gyroscopic technique, and more specifically to biaxial controlled indicator gyrostabilizers operating on moving objects and designed to stabilize and control the line of sight.
Известен двухосный гиростабилизатор, содержащий наружную рамку, установленную на основании с вращением относительно оси, перпендикулярной основанию, и расположенную в ней платформу, вращающуюся относительно оси, перпендикулярной оси вращения наружной рамки, установленные на осях вращения наружной рамки и платформы исполнительные двигатели, входы которых соединены через усилители с выходами установленного на платформе гироскопического датчика угла (ГДУ), входы которого соединены с устройством управления, установленные на основании датчик угловой скорости (ДУС) и датчик углового ускорения (ДУУ), оси чувствительности которых параллельны оси вращения наружной рамки, выходы которых соединены через усилитель с входами исполнительного двигателя канала наружной рамки, установленные на наружной рамке ДУС и ДУУ, оси чувствительности которых параллельны оси вращения платформы, выходы которых соединены через усилитель с исполнительным двигателем канала платформы (Фабрикант Е.А., Журавлев П.Д. Динамика следящего привода гироскопических стабилизаторов. - М.: Машиностроение, 1984. - 265 с.).Known biaxial gyrostabilizer containing an outer frame mounted on the base with rotation about an axis perpendicular to the base, and a platform located therein, rotating about an axis perpendicular to the axis of rotation of the outer frame, executive motors installed on the rotation axes of the outer frame and platform, the inputs of which are connected through amplifiers with outputs of a gyroscopic angle sensor (GDU) installed on the platform, the inputs of which are connected to a control device installed on the basis of an angular velocity sensor (DOS) and an angular acceleration sensor (DUU), the sensitivity axes of which are parallel to the axis of rotation of the outer frame, the outputs of which are connected through an amplifier to the inputs of the external frame channel motor mounted on the outer frame of the DUS and DUU, whose sensitivity axes are parallel to the axis of rotation platforms, the outputs of which are connected through an amplifier to the executive engine of the platform channel (Fabrikant E.A., Zhuravlev P.D. Dynamics of the tracking drive of gyroscopic stabilizers. - M.: Mechanical Engineering, 1984. - 265 p.).
Недостатком такого двухосного гиростабилизатора является низкая эффективность примененной схемы компенсации, поскольку в двухосных гиростабилизаторах имеются дополнительные возмущающие моменты от вязкого трения и инерционных сил, обусловленные наличием дополнительной рамки подвеса и действием трехкомпонентной качки (см., например, Пельпор Д.С., Колосов Ю.А., Рахтеенко Е.Р. Расчет и проектирование гироскопических стабилизаторов. - М.: Машиностроение, 1972. - 325 с.). При работе в режиме управления также возникают дополнительные возмущающие моменты, обусловленные угловыми скоростями управления.The disadvantage of such a biaxial gyrostabilizer is the low efficiency of the compensation scheme, since biaxial gyrostabilizers have additional disturbing moments from viscous friction and inertial forces due to the presence of an additional suspension frame and the action of three-component pitching (see, for example, Pelpor D.S., Kolosov Yu. A., Rakhteenko E.R. Calculation and design of gyroscopic stabilizers. - M.: Mashinostroenie, 1972. - 325 p.). When operating in control mode, additional disturbing moments arise due to angular control speeds.
Наиболее близким (прототипом) является двухосный управляемый гиростабилизатор (патент на изобретение РФ RU N2193160, МПК7 G 01 С 21/18, 20.11.2002. Бюл. N32).The closest (prototype) is a biaxial controlled gyrostabilizer (RF patent RU N2193160, IPC 7 G 01 C 21/18, 11/20/2002. Bull. N32).
Двухосный управляемый гиростабилизатор содержит наружную рамку, установленную на основании с вращением относительно оси, перпендикулярной основанию, и расположенную в ней платформу, вращающуюся относительно оси, перпендикулярной оси вращения наружной рамки, установленные на осях вращения наружной рамки и платформы исполнительные двигатели, входы которых соединены через усилители с выходами установленного на платформе ГДУ, входы которого соединены с устройством управления, установленные на основании ДУС и ДУУ, оси чувствительности которых параллельны оси вращения наружной рамки, установленные на наружной рамке ДУС и ДУУ, оси чувствительности которых параллельны оси вращения платформы, установленные на наружной рамке ДУС и ДУУ, оси чувствительности которых перпендикулярны осям вращения наружной рамки и платформы, а на оси вращения платформы установлен датчик угла, измеряющий угол поворота платформы относительно наружной рамки, входы усилителей исполнительных двигателей каналов наружной рамки и платформы соединены с выходами вычислителей компенсирующих сигналов каналов наружной рамки и платформы, выход ДУУ, ось чувствительности которого параллельна оси вращения наружной рамки, соединен с входом первого усилительного блока с коэффициентом передачи Тд1 (коэффициент Tд1 равен постоянной времени исполнительного двигателя канала наружной рамки) вычислителя компенсирующего сигнала канала наружной рамки (ВКСКНР), выход ДУС, ось чувствительности которого параллельна оси вращения наружной рамки, соединен с первым входом первого сумматора ВКСКНР, второй вход которого соединен с выходом первого усилительного блока ВКСКНР, выход ДУУ, ось чувствительности которого перпендикулярна осям вращения наружной рамки и платформы, соединен с входом второго усилительного блока (с коэффициентом передачи Тд1) ВКСКНР и соединен также с первым входом первого вычислительного блока (с коэффициентом передачи (Jy1+Jx2)tgφz,где φz - угол поворота платформы относительно наружной рамки, Jy1 - коэффициент, равный главному центральному моменту инерции наружной рамки относительно оси OY1, Jx2 - коэффициент, равный главному центральному моменту инерции платформы относительно оси OХ2) ВКСКНР, второй вход которого соединен с выходом датчика угла, выход ДУС, ось чувствительности которого перпендикулярна осям вращения наружной рамки и платформы, соединен с первым входом второго сумматора ВКСКНР, второй вход которого соединен с выходом второго усилительного блока ВКСКНР, выход ДУУ, ось чувствительности которого параллельна оси вращения платформы, соединен с входом третьего усилительного блока (с коэффициентом передачи Тд1) ВКСКНР, выход ДУС, ось чувствительности которого параллельна оси вращения платформы, соединен с первым входом третьего сумматора ВКСКНР, второй вход которого соединен с выходом третьего усилительного блока ВКСКНР, выход устройства управления по оси наружной рамки по угловому ускорению управления соединен с входом четвертого усилительного блока (с коэффициентом передачи Tд1) ВКСКНР, выход устройства управления по оси наружной рамки по угловой скорости управления соединен с первым входом четвертого сумматора ВКСКНР, второй вход которого соединен с выходом четвертого усилительного блока ВКСКНР, выход первого сумматора ВКСКНР соединен с входом пятого усилительного блока (с коэффициентом передачи b1, где b1 - коэффициент, равный коэффициенту вязкого трения в осях вращения наружной рамки) ВКСКНР, выход которого соединен с первым входом пятого сумматора ВКСКНР, второй вычитающий вход которого соединен с выходом второго вычислительного блока (с коэффициентом передачи b1tgφz) ВКСКНР, второй вход которого соединен с выходом датчика угла, а первый вход соединен с выходом второго сумматора ВКСКНР, третий вычитающий вход пятого сумматора ВКСКНР соединен с выходом первого умножителя ВКСКНР, первый вход которого соединен с выходом второго сумматора ВКСКНР, а второй вход соединен с выходом шестого усилительного блока (с коэффициентом передачи Jy1+Jz1-Jx1, где Jz1, Jx1 - коэффициенты, равные главным центральным моментам инерции наружной рамки относительно осей OZ1 и OХ1 соответственно) ВКСКНР, вход шестого усилительного блока ВКСКНР соединен с выходом третьего сумматора ВКСКНР, выход третьего сумматора ВКСКНР соединен также с первым входом третьего вычислительного блока (с коэффициентом передачи (Jy1+Jx2)tgφz/cosφz) ВКСКНР, второй вход которого соединен с выходом датчика угла, выход третьего вычислительного блока ВКСКНР соединен с первым входом второго умножителя ВКСКНР, второй вход которого соединен с выходом четвертого сумматора ВКСКНР, выход второго умножителя ВКСКНР соединен с первым входом шестого сумматора ВКСКНР, второй вход которого соединен с выходом пятого сумматора, а третий вычитающий вход которого соединен с выходом первого вычислительного блока ВКСКНР, выход шестого сумматора ВКСКНР является выходом вычислителя компенсирующего сигнала канала наружной рамки, выход ДУУ, ось чувствительности которого параллельна оси вращения платформы, соединен с входом седьмого усилительного блока (с коэффициентом передачи Тд2, где коэффициент Тд2 равен постоянной времени исполнительного двигателя канала платформы) вычислителя компенсирующего сигнала канала платформы (ВКСКП), выход ДУС, ось чувствительности которого параллельна оси вращения платформы, соединен с первым входом седьмого сумматора ВКСКП, второй вход которого соединен с выходом седьмого усилительного блока ВКСКП, выход ДУУ, ось чувствительности которого перпендикулярна осям вращения наружной рамки и платформы, соединен с входом восьмого усилительного блока (с коэффициентом передачи Тд2) ВКСКП, выход ДУС, ось чувствительности которого перпендикулярна осям вращения наружной рамки и платформы, соединен с первым входом восьмого сумматора ВКСКП, второй вход которого соединен с выходом восьмого усилительного блока ВКСКП, выход устройства управления по оси наружной рамки по угловому ускорению управления соединен с входом девятого усилительного блока (с коэффициентом передачи Тд2) ВКСКП и соединен с входом десятого усилительного блока (с коэффициентом передачи Тд2) ВКСКП, выход устройства управления по оси наружной рамки по угловой скорости управления соединен с первым входом девятого сумматора ВКСКП и соединен также с первым входом десятого сумматора ВКСКП, второй вход девятого сумматора ВКСКП соединен с выходом девятого усилительного блока ВКСКП, а второй вход десятого сумматора ВКСКП соединен с выходом десятого усилительного блока ВКСКП, выход восьмого сумматора ВКСКП соединен с первым входом четвертого вычислительного блока (с коэффициентом передачи 1/cosφz) ВКСКП, второй вход которого соединен с выходом датчика угла, выход четвертого вычислительного блока ВКСКП соединен с первым входом одинадцатого сумматора ВКСКП, второй вход которого соединен с выходом пятого вычислительного блока (с коэффициентом передачи 1/tgφz) ВКСКП, первый вход которого соединен с выходом девятого сумматора ВКСКП, а второй вход соединен с выходом датчика угла, выход одинадцатого сумматора ВКСКП соединен с входом одинадцатого усилительного блока (с коэффициентом передачи Jx2-Jy2,где Jy2 - коэффициент, равный главному центральному моменту платформы относительно оси OY2) ВКСКП, выход одинадцатого усилительного блока ВКСКП соединен с первым входом третьего умножителя ВКСКП, второй вход которого соединен с выходом десятого сумматора ВКСКП, выход третьего умножителя ВКСКП соединен с вторым входом двенадцатого сумматора ВКСКП, первый вход которого соединен с выходом двенадцатого усилительного блока (с коэффициентом передачи b2, где b2 - коэффициент, равный коэффициенту вязкого трения по оси платформы) ВКСКП, вход которого соединен с выходом седьмого сумматора ВКСКП, выход двенадцатого сумматора ВКСКП является выходом вычислителя компенсирующего сигнала по каналу платформы.The biaxial controlled gyrostabilizer contains an outer frame mounted on the base with rotation about an axis perpendicular to the base, and a platform located therein, rotating about an axis perpendicular to the axis of rotation of the outer frame, executive motors installed on the rotation axes of the outer frame and platform, the inputs of which are connected through amplifiers with the outputs of the GDU installed on the platform, the inputs of which are connected to the control device, installed on the basis of the remote control and remote control, the sensitivity axis which are parallel to the axis of rotation of the outer frame mounted on the outer frame of the CRS and the remote control, the sensitivity axes of which are parallel to the axis of rotation of the platform installed on the outer frame of the CRS and the remote control, whose sensitivity axes are perpendicular to the axes of rotation of the outer frame and platform, and an angle sensor is installed on the axis of rotation of the platform measuring the angle of rotation of the platform relative to the outer frame, the inputs of the amplifiers of the actuators of the channels of the outer frame and platform are connected to the outputs of the computers compensating the signal in the channels of the external frame and platform, the output of the remote control, the sensitivity axis of which is parallel to the axis of rotation of the external frame, is connected to the input of the first amplifier unit with the transmission coefficient T d1 (coefficient T d1 is equal to the time constant of the external frame channel actuator) of the calculator of the compensating signal of the external frame channel ( VKSKNR), the output of the TLS, the sensitivity axis of which is parallel to the axis of rotation of the outer frame, is connected to the first input of the first adder VKSKNR, the second input of which is connected to the output of the first amplifier tion unit VKSKNR, SLA output axis of sensitivity is perpendicular to the axes of rotation of the outer frame and the platform is connected to the input of the second amplifying unit (T g1 transmission coefficient) VKSKNR and also connected to a first input of a first computing unit (with a transmission coefficient (J y1 + J x2 ) tgφ z , where φ z is the angle of rotation of the platform relative to the outer frame, J y1 is the coefficient equal to the main central moment of inertia of the external frame relative to the axis OY1, J x2 is the coefficient equal to the main central moment of inertia of the platform relative to the axis OX2) VKKSNR, the second input of which is connected to the output of the angle sensor, the output of the remote control system, the sensitivity axis of which is perpendicular to the axes of rotation of the outer frame and platform, is connected to the first input of the second adder VKKSNR, the second input of which is connected to the output of the second amplifier unit VKKSNR, the output of the remote control , which is parallel to the axis of rotation of the platform sensitivity axis, is connected to the input of the third amplification block (T g1 transmission coefficient) VKSKNR, output CRS, an axis of sensitivity is parallel to the axis of rotation pla shape, connected to the first input of the third adder VKSKNR, a second input coupled to an output of the third amplifying unit VKSKNR, yield axis control device outer frame angular control acceleration is connected to the input of the fourth amplification block (with T d1 transmission coefficient) VKSKNR, the output control device along the axis of the outer frame, the angular velocity of control is connected to the first input of the fourth adder VKKSNR, the second input of which is connected to the output of the fourth amplifier unit VKKSNR, the output of the first sum Ator VKSKNR connected to the input of the fifth amplifier block (with a transmission coefficient b 1 where b 1 - the coefficient equal to the coefficient of viscous friction of the outer frame rotation axes) VKSKNR whose output is connected to the first input of the fifth adder VKSKNR second subtracting input connected to the output the second computing unit (with a transmission coefficient b 1 tgφ z ) VKKNR, the second input of which is connected to the output of the angle sensor, and the first input is connected to the output of the second adder VKKNR, the third subtracting input of the fifth adder VKKNR connected to the output of the first VKKSNR multiplier, the first input of which is connected to the output of the second VKKSNR adder, and the second input is connected to the output of the sixth amplifier unit (with the transmission coefficient J y1 + J z1 -J x1 , where J z1 , J x1 are the coefficients equal to the main central moments the inertia of the outer frame relative to the axes OZ1 and OX1, respectively) VKKSNR, the input of the sixth amplifier block VKKSNR is connected to the output of the third adder VKKSNR, the output of the third adder VKKSNR is also connected to the first input of the third computing unit (with the transmission coefficient ( J y1 + J x2 ) tgφ z / cosφ z ) VKKNR, the second input of which is connected to the output of the angle sensor, the output of the third computing unit VKKNR is connected to the first input of the second multiplier VKKNR, the second input of which is connected to the output of the fourth adder VKKNR, the output of the second multiplier VKKNR connected to the first input of the sixth adder VKKSNR, the second input of which is connected to the output of the fifth adder, and the third subtracting input of which is connected to the output of the first computing unit VKKSNR, the output of the sixth adder VKKSNR is the output of the computer ensiruyuschego outer frame channel signal SLA output, which is parallel to the platform axis of rotation sensitive axis, connected to the input of the seventh amplification block (with a transmission coefficient T g2, where the coefficient T d2 is a time constant servomotor channel platforms) calculating channel signal compensating platform (VKSKP) , the output of the TLS, the sensitivity axis of which is parallel to the axis of rotation of the platform, is connected to the first input of the seventh adder VKSCP, the second input of which is connected to the output of the seventh amplifier th block VKSKP, yield SLA, the axis of sensitivity is perpendicular to the axes of rotation of the outer frame and a platform connected to the input of the eighth amplifying unit (T g2 transmission coefficient) VKSKP, output CRS, an axis of sensitivity is perpendicular to the axes of rotation of the outer frame and a platform connected to the first the input of the eighth admitter VKSCP, the second input of which is connected to the output of the eighth amplifier unit VKKSP, the output of the control device along the axis of the outer frame along the angular acceleration of control is connected to the input of the ninth Call duration unit (T g2 transmission coefficient) VKSKP and connected to the input of the tenth amplification block (T g2 transmission coefficient) VKSKP, the angular speed control controls the output of the outer frame axis is connected to the first input of the ninth adder VKSKP and also connected to a first input the tenth adder VKKSP, the second input of the ninth adder VKKSP is connected to the output of the ninth amplifier block VKKSP, and the second input of the tenth adder VKKSP is connected to the output of the tenth amplifier block VKKSP, the output of the eighth sum and VKSKP connected to the first input of the fourth computing block (with a
Недостатком такого двухосного управляемого гиростабилизатора является низкая эффективность примененной схемы компенсации. При формировании компенсирующего сигнала канала наружной рамки и канала платформы коэффициенты передачи усилительных блоков прототипа определяются на основании постоянных параметров: коэффициентов вязкого трения в осях вращения и моментов инерции наружной рамы и платформы и переменными параметрами, измеряемыми ДУС, ДУУ, датчиком угла, а также угловой скоростью управления, формируемой устройством управления (см. стр.10 Патент на изобретение РФ RU N2193160 МПК7 G 01 С 21/18 «Способ повышения точности двухосного управляемого гиростабилизатора и двухосный управляемый гиростабилизатор», опубликовано 20.11.2002. Бюл. N32). Допущение о постоянстве коэффициентов вязкого трения справедливо лишь при постоянной температуре окружающей среды и полном отсутствии явления загрязнения подшипников. При изменении температуры окружающей среды или загрязнении подшипников коэффициент вязкого трения изменяет свое значение, что приводит к нарушению равенства моментов сил вязкого трения по оси наружной рамки и платформы и соответствующих составляющих компенсирующего момента по оси наружной рамки и платформы, а следовательно, к резкому снижению эффективности примененной схемы компенсации.The disadvantage of such a biaxial controlled gyrostabilizer is the low efficiency of the compensation scheme used. When forming the compensating signal of the channel of the outer frame and the channel of the platform, the transmission coefficients of the prototype amplification units are determined on the basis of constant parameters: viscous friction coefficients in the rotation axes and moments of inertia of the outer frame and platform and variable parameters measured by the TLS, DUU, angle sensor, and angular velocity control generated by the control device (see
Задачей изобретения является повышение точности двухосного управляемого индикаторного гиростабилизатора.The objective of the invention is to improve the accuracy of a biaxial controlled indicator gyrostabilizer.
Задача решается тем, что двухосный управляемый гиростабилизатор содержит наружную рамку, установленную на основании с вращением относительно оси, перпендикулярной основанию, и расположенную в ней платформу, вращающуюся относительно оси, перпендикулярной оси вращения наружной рамки, установленные на осях вращения наружной рамки и платформы исполнительные двигатели, входы которых соединены через усилители с выходами установленного на платформе ГДУ, входы которого соединены с устройством управления, установленные на основании ДУС и ДУУ, оси чувствительности которых параллельны оси вращения наружной рамки, установленные на наружной рамке ДУС и ДУУ, оси чувствительности которых параллельны оси вращения платформы, установленные на наружной рамке ДУС и ДУУ, оси чувствительности которых перпендикулярны осям вращения наружной рамки и платформы, а на оси вращения платформы установлен датчик угла, измеряющий угол поворота платформы относительно наружной рамки, входы усилителей исполнительных двигателей каналов наружной рамки и платформы соединены с выходами вычислителей компенсирующих сигналов каналов наружной рамки и платформы, выход ДУУ, ось чувствительности которого параллельна оси вращения наружной рамки, соединен с входом первого усилительного блока (с коэффициентом передачи Тд1, где коэффициент Тд1 равен постоянной времени исполнительного двигателя канала наружной рамки) вычислителя компенсирующего сигнала канала наружной рамки (ВКСКНР), выход ДУС, ось чувствительности которого параллельна оси вращения наружной рамки, соединен с первым входом первого сумматора ВКСКНР, второй вход которого соединен с выходом первого усилительного блока ВКСКНР, выход ДУУ, ось чувствительности которого перпендикулярна осям вращения наружной рамки и платформы, соединен с входом второго усилительного блока (с коэффициентом передачи Тд1) ВКСКНР и соединен также с первым входом первого вычислительного блока (с коэффициентом передачи (Jy1+Jx2)tgφz, где φz - угол поворота платформы относительно наружной рамки, Jy1 - коэффициент, равный главному центральному моменту инерции наружной рамки относительно оси OY1, Jx2 - коэффициент, равный главному центральному моменту инерции платформы относительно оси OХ2) ВКСКНР, второй вход которого соединен с выходом датчика угла, выход ДУС, ось чувствительности которого перпендикулярна осям вращения наружной рамки и платформы, соединен с первым входом второго сумматора ВКСКНР, второй вход которого соединен с выходом второго усилительного блока ВКСКНР, выход ДУУ, ось чувствительности которого параллельна оси вращения платформы, соединен с входом третьего усилительного блока (с коэффициентом передачи Тд1) ВКСКНР, выход ДУС, ось чувствительности которого параллельна оси вращения платформы, соединен с первым входом третьего сумматора ВКСКНР, второй вход которого соединен с выходом третьего усилительного блока ВКСКНР, выход устройства управления по оси наружной рамки по угловому ускорению управления соединен с входом четвертого усилительного блока (с коэффициентом передачи Тд1) ВКСКНР, выход устройства управления по оси наружной рамки по угловой скорости управления соединен с первым входом четвертого сумматора ВКСКНР, второй вход которого соединен с выходом четвертого усилительного блока ВКСКНР, выход первого сумматора ВКСКНР соединен с входом пятого усилительного блока (с коэффициентом передачи b1, где b1 - коэффициент, равный коэффициенту вязкого трения в осях вращения наружной рамки) ВКСКНР, выход второго сумматора ВКСКНР соединен с первым входом второго вычислительного блока (с коэффициентом передачи b1tgφz) ВКСКНР и соединен с первым входом первого умножителя ВКСКНР, второй вход второго вычислительного блока ВКСКНР соединен с выходом датчика угла, а второй вход первого умножителя ВКСКНР соединен с выходом шестого усилительного блока (с коэффициентом передачи Jy1+Jz1-Jx1, где Jz1, Jx1 - коэффициенты, равные главным центральным моментам инерции наружной рамки относительно осей OZ1 и OХ1 соответственно) ВКСКНР, вход шестого усилительного блока ВКСКНР соединен с выходом третьего сумматора ВКСКНР, выход третьего сумматора ВКСКНР соединен также с первым входом третьего вычислительного блока (с коэффициентом передачи (Jy1+Jx2)tgφz/cosφz) ВКСКНР, второй вход которого соединен с выходом датчика угла, выход третьего вычислительного блока ВКСКНР соединен с первым входом второго умножителя ВКСКНР, второй вход которого соединен с выходом четвертого сумматора ВКСКНР, выход второго умножителя ВКСКНР соединен с первым входом шестого сумматора ВКСКНР, второй вход которого соединен с выходом пятого сумматора ВКСКНР, а третий вычитающий вход шестого сумматора ВКСКНР соединен с выходом первого вычислительного блока ВКСКНР, третий вычитающий вход пятого сумматора ВКСКНР соединен с выходом первого умножителя ВКСКНР, первый вход пятого сумматора ВКСКНР соединен с выходом четвертого умножителя ВКСКНР, первый вход которого соединен с выходом пятого усилительного блока ВКСКНР, а второй вход которого соединен с выходом первого интегратора ВКСКНР, вход которого соединен с выходом пятого умножителя ВКСКНР, первый вход которого соединен с выходом ДУС, ось чувствительности которого параллельна оси вращения платформы, а второй вход которого соединен с выходом ГДУ по каналу наружной рамки, второй вычитающий вход пятого сумматора ВКСКНР соединен с выходом шестого умножителя ВКСКНР, первый вход которого соединен с выходом второго вычислительного блока ВКСКНР, а второй вход которого соединен с выходом первого интегратора ВКСКНР, выход шестого сумматора ВКСКНР является выходом вычислителя компенсирующего сигнала канала наружной рамки, выход ДУУ, ось чувствительности которого параллельна оси вращения платформы, соединен с входом седьмого усилительного блока (с коэффициентом передачи Тд2, где коэффициент Тд2 равен постоянной времени исполнительного двигателя канала платформы) вычислителя компенсирующего сигнала канала платформы (ВКСКП), выход ДУС, ось чувствительности которого параллельна оси вращения платформы, соединен с первым входом седьмого сумматора ВКСКП, второй вход которого соединен с выходом седьмого усилительного блока ВКСКП, выход ДУУ, ось чувствительности которого перпендикулярна осям вращения наружной рамки и платформы, соединен с входом восьмого усилительного блока (с коэффициентом передачи Тд2) ВКСКП, выход ДУС, ось чувствительности которого перпендикулярна осям вращения наружной рамки и платформы, соединен с первым входом восьмого сумматора ВКСКП, второй вход которого соединен с выходом восьмого усилительного блока ВКСКП, выход устройства управления по оси наружной рамки по угловому ускорению управления соединен с входом девятого усилительного блока (с коэффициентом передачи Тд2) ВКСКП и соединен с входом десятого усилительного блока (с коэффициентом передачи Тд2) ВКСКП, выход устройства управления по оси наружной рамки по угловой скорости управления соединен с первым входом девятого сумматора ВКСКП и соединен также с первым входом десятого сумматора ВКСКП, второй вход девятого сумматора ВКСКП соединен с выходом девятого усилительного блока ВКСКП, а второй вход десятого сумматора ВКСКП соединен с выходом десятого усилительного блока ВКСКП, выход восьмого сумматора ВКСКП соединен с первым входом четвертого вычислительного блока (с коэффициентом передачи 1/cosφz) ВКСКП, второй вход которого соединен с выходом датчика угла, выход четвертого вычислительного блока ВКСКП соединен с первым входом одинадцатого сумматора ВКСКП, второй вход которого соединен с выходом пятого вычислительного блока (с коэффициентом передачи 1/tgφz) ВКСКП, первый вход которого соединен с выходом девятого сумматора ВКСКП, а второй вход соединен с выходом датчика угла, выход одинадцатого сумматора ВКСКП соединен с входом одинадцатого усилительного блока (с коэффициентом передачи Jx2-Jy2, где Jy2 - коэффициент, равный главному центральному моменту платформы относительно оси OY2) ВКСКП, выход одинадцатого усилительного блока ВКСКП соединен с первым входом третьего умножителя ВКСКП, второй вход которого соединен с выходом десятого сумматора ВКСКП, выход третьего умножителя ВКСКП соединен с вторым входом двенадцатого сумматора ВКСКП, первый вход которого соединен с выходом седьмого умножителя ВКСКП, первый вход которого соединен с выходом двенадцатого усилительного блока (с коэффициентом передачи b2, где b2 - коэффициент, равный коэффициенту вязкого трения по оси платформы) ВКСКП, вход которого соединен с выходом седьмого сумматора ВКСКП, второй вход седьмого умножителя ВКСКП соединен с выходом второго интегратора ВКСКП, вход которого соединен с выходом восьмого умножителя ВКСКП, первый вход которого соединен с выходом ДУС, ось чувствительности которого параллельна оси вращения платформы, а второй вход соединен с выходом ГДУ по каналу платформы, выход двенадцатого сумматора ВКСКП является выходом вычислителя компенсирующего сигнала по каналу платформы.The problem is solved in that the biaxial controlled gyrostabilizer contains an outer frame mounted on the base with rotation about an axis perpendicular to the base, and a platform located therein, rotating about an axis perpendicular to the axis of rotation of the outer frame, executive motors mounted on the rotation axes of the outer frame and platform, the inputs of which are connected through amplifiers with the outputs of the GDU installed on the platform, the inputs of which are connected to the control device installed on the basis of the remote control and remote control Y, the sensitivity axes of which are parallel to the axis of rotation of the outer frame mounted on the outer frame of the DUS and DUU, the sensitivity axes of which are parallel to the axis of rotation of the platform mounted on the outer frame of the DUS and DUU, the sensitivity axes of which are perpendicular to the rotation axes of the outer frame and platform, and on the axis of rotation an angle sensor is installed on the platform, which measures the angle of rotation of the platform relative to the outer frame, the inputs of the amplifiers of the executive motors of the channels of the outer frame and the platform are connected to the outputs of the calculator compensating signals of the channels of the outer frame and the platform, yield SLA, which is parallel to the outer frame axis of rotation sensitive axis, is connected to the input of the first amplifying unit (T g1 transfer coefficient, wherein the coefficient of T d1 is the channel actuating motor time constant outer frame) calculating compensating channel signal external frame (SSCNR), the DOS output, the sensitivity axis of which is parallel to the axis of rotation of the outer frame, is connected to the first input of the first adder SSCNR, the second input of which one with the output of the first amplifying unit VKSKNR, yield SLA, the axis of sensitivity is perpendicular to the axes of rotation of the outer frame and the platform is connected to the input of the second amplifying unit (T g1 transmission coefficient) VKSKNR and also connected to a first input of a first computing unit (with a transmission coefficient ( J y1 + J x2 ) tgφ z , where φ z is the angle of rotation of the platform relative to the outer frame, J y1 is the coefficient equal to the main central moment of inertia of the outer frame relative to the axis OY1, J x2 is the coefficient equal to the main central the moment of inertia of the platform relative to the axis OX2) VKKSNR, the second input of which is connected to the output of the angle sensor, the output of the TLS, the sensitivity axis of which is perpendicular to the rotation axes of the outer frame and platform, is connected to the first input of the second adder VKKSNR, the second input of which is connected to the output of the second amplifier unit VKSKNR, yield SLA, which is parallel to the platform axis of rotation sensitive axis, is connected to the input of the third amplification block (T g1 transmission coefficient) VKSKNR, yield CRS sensitive axis kotorog parallel to the axis of rotation of the platform, connected to the first input of the third adder VKSKNR, a second input coupled to an output of the third amplifying unit VKSKNR, yield on the outer frame for angular control acceleration axis control device is connected to the input of the fourth amplification block (T g1 transmission coefficient) VKSKNR, the output of the control device along the axis of the outer frame according to the angular velocity of the control is connected to the first input of the fourth adder VKKSNR, the second input of which is connected to the output of the fourth amplifier Lok VKSKNR, the output of the first adder VKSKNR connected to the input of the fifth amplifier block (with a transmission coefficient b 1 where b 1 - the coefficient equal to the coefficient of viscous friction in the rotational axes of the outer frame) VKSKNR, the second adder output VKSKNR connected to the first input of the second calculating unit ( with a transmission coefficient b 1 tgφ z ) VKKNR and connected to the first input of the first VKKNR multiplier, the second input of the second VKKNR computing unit is connected to the output of the angle sensor, and the second input of the first VKKNR multiplier is connected to the sixth output of the amplification block (with the transmission coefficient J y1 + J z1 -J x1 , where J z1 , J x1 are the coefficients equal to the main central moments of inertia of the outer frame relative to the axes OZ1 and ОХ1, respectively) VKKSNR, the input of the sixth amplifier block VKKSNR is connected to the output of the third VKSKNR adder, the output of the third VKSKNR adder is also connected to the first input of the third computing unit (with a transmission coefficient (J y1 + J x2 ) tgφ z / cosφ z ) VKSKNR, the second input of which is connected to the output of the angle sensor, the output of the third computing unit VKSKNR is connected to first the input of the second VKKSNR multiplier, the second input of which is connected to the output of the fourth VKSKNR adder, the output of the second VKKSNR multiplier is connected to the first input of the sixth VKSKNR adder, the second input of which is connected to the output of the fifth VKSKNR adder, and the third subtracting input of the sixth VKSKNR adder is connected to the output of the first computing unit VKKSNR, the third subtracting input of the fifth adder VKKSNR is connected to the output of the first multiplier VKKSNR, the first input of the fifth adder VKKSNR is connected to the output of the fourth multiplier VKKSNR, p the first input of which is connected to the output of the fifth VKKSNR amplifier block, and the second input of which is connected to the output of the first VKKSNR integrator, whose input is connected to the output of the fifth VKKSNR multiplier, the first input of which is connected to the TLS output, the sensitivity axis of which is parallel to the axis of rotation of the platform, and the second input which is connected to the output of the GDU through the channel of the outer frame, the second subtracting input of the fifth adder VKKSNR is connected to the output of the sixth multiplier VKKSNR, the first input of which is connected to the output of the second computationally a block VKSKNR and a second input coupled to an output of the first integrator VKSKNR, the output of the sixth adder VKSKNR is the output of the calculator compensating channel outer frame signal output SLA whose axis of sensitivity is parallel to the platform axis of rotation, connected to the input of the seventh amplification block (with a transmission coefficient T d2 , where the coefficient T d2 is equal to the time constant of the executive engine of the channel of the platform) of the calculator of the compensating signal of the platform channel (VKSKP), the output of the TLS, the sensitivity axis parallel to the axis of rotation of the platform, connected to the first input of the seventh adder VKKSP, the second input of which is connected to the output of the seventh amplifier unit VKKSP, the output of the remote control, the sensitivity axis of which is perpendicular to the axes of rotation of the outer frame and platform, is connected to the input of the eighth amplifier block (with transmission coefficient T d2) VKSKP, yield CRS sensitive axis is perpendicular to the axes of rotation of the outer frame and the platform is connected to the first input of the eighth adder VKSKP, a second input coupled to an output eighth amplifying unit VKSKP, angular control the acceleration output along the axis of the control device of the outer frame connected to the input of the ninth amplifying unit (T g2 transmission coefficient) VKSKP and connected to the input of the tenth amplification block (T g2 transmission coefficient) VKSKP, the output control apparatus of the axis of the outer frame in angular velocity of control is connected to the first input of the ninth adder VKKSP and is also connected to the first input of the tenth adder VKKSP, the second input of the ninth adder VKKSP is connected to the output of dev a power amplifier VKSCP, and the second input of the tenth adder VKSCP is connected to the output of the tenth amplifier unit VKKSP, the output of the eighth adder VKKSP is connected to the first input of the fourth computing unit (with a
На фиг.1 изображена принципиальная схема двухосного управляемого гиростабилизатора. На фиг.2 и 3 изображены принципиальные схемы вычислителей компенсирующих сигналов каналов наружной рамки и платформы соответственно. На фиг.4 и 5 изображены структурные схемы вычислителей компенсирующих сигналов каналов наружной рамки и платформы соответственно. На фиг.6 и фиг.7 изображены соответственно графики ошибки стабилизации прототипа и предлагаемого двухосного управляемого гиростабилизатора. На фиг.8 изображен график выходного сигнала первого интегратора ВКСКНР.Figure 1 shows a schematic diagram of a biaxial controlled gyrostabilizer. Figure 2 and 3 shows a schematic diagram of the calculators of the compensating signals of the channels of the outer frame and platform, respectively. Figure 4 and 5 shows the structural diagrams of the computers of the compensating signals of the channels of the outer frame and platform, respectively. In Fig.6 and Fig.7 respectively shows the graphs of the stabilization error of the prototype and the proposed biaxial controlled gyrostabilizer. On Fig shows a graph of the output signal of the first integrator VKKNR.
Двухосный управляемый гиростабилизатор содержит наружную рамку 1, установленную на основании с вращением относительно оси, перпендикулярной основанию, и расположенную в ней платформу 2, вращающуюся относительно оси, перпендикулярной оси вращения наружной рамки, установленные на осях вращения наружной рамки и платформы исполнительные двигатели 3 и 4, входы которых соединены через усилители 5 и 6 с выходами установленного на платформе 2 ГДУ 7, входы которого соединены с выходами устройства управления 8, ДУС 9 и ДУУ 10, установленные на основании так, что их оси чувствительности параллельны оси вращения наружной рамки 1, ДУС 11 и ДУУ 12, установленные на наружной рамке 1 так, что их оси чувствительности параллельны оси вращения платформы 2, ДУС 13 и ДУУ 14, установленные на наружной рамке 1 так, что их оси чувствительности перпендикулярны осям чувствительности ДУС 9, 11 и ДУУ 10, 12, датчик угла 15, установленный на оси вращения платформы 2, вычислитель 16 компенсирующего сигнала канала наружной рамки, выход которого соединен с входом усилителя 5, вычислитель 17 компенсирующего сигнала канала платформы, выход которого соединен с входом усилителя 6, выход ДУУ 10 соединен с входом первого усилительного блока 18 (с коэффициентом передачи Тд1, где коэффициент Тд1 равен постоянной времени исполнительного двигателя канала наружной рамки) вычислителя компенсирующего сигнала канала наружной рамки (ВКСКНР)16, выход ДУС 9 соединен с первым входом первого сумматора 19 ВКСКНР 16, второй вход которого соединен с выходом первого усилительного блока 18 ВКСКНР 16, выход ДУУ14 соединен с входом второго усилительного блока 20 (с коэффициентом передачи Тд1) ВКСКНР 16 и соединен также с первым входом первого вычислительного блока 21 (с коэффициентом передачи (Jy1+Jx2)tgφz, где φz - угол поворота платформы 2 относительно наружной рамки 1, Jy1 - коэффициент, равный главному центральному моменту инерции наружной рамки 1 относительно оси OY1, Jx2 - коэффициент, равный главному центральному моменту инерции платформы 2 относительно оси OХ2) ВКСКНР 16, второй вход которого соединен с выходом датчика угла 15, выход ДУС 13 соединен с первым входом второго сумматора 22 ВКСКНР 16, второй вход которого соединен с выходом второго усилительного блока 20 ВКСКНР 16, выход ДУУ12 соединен с входом третьего усилительного блока 23 (с коэффициентом передачи Tд1) ВКСКНР 16, выход ДУС 11 соединен с первым входом третьего сумматора 24 ВКСКНР 16, второй вход которого соединен с выходом третьего усилительного блока 23 ВКСКНР 16, выход устройства управления 8 по оси наружной рамки по угловому ускорению управления соединен с входом четвертого усилительного блока 25 (с коэффициентом передачи Тд1) ВКСКНР 16, выход устройства управления 8 по оси наружной рамки по угловой скорости управления соединен с первым входом четвертого сумматора 26 ВКСКНР 16, второй вход которого соединен с выходом четвертого усилительного блока 25 ВКСКНР 16, выход первого сумматора 19 ВКСКНР 16 соединен с входом пятого усилительного блока 27 (с коэффициентом передачи b1, где b1 - коэффициент, равный коэффициенту вязкого трения в осях вращения наружной рамки) ВКСКНР 16, выход второго сумматора 22 ВКСКНР 16 соединен с первым входом второго вычислительного блока 28 (с коэффициентом передачи b1tgφz) BKCKHP 16 и соединен с первым входом первого умножителя 29 ВКСКНР 16, второй вход второго вычислительного блока 28 ВКСКНР 16 соединен с выходом датчика угла 15, а второй вход первого умножителя 29 ВКСКНР 16 соединен с выходом шестого усилительного блока 30 (с коэффициентом передачи Jy1+Jz1-Jx1, где Jz1, Jx1 - коэффициенты, равные главным центральным моментам инерции наружной рамки 1 относительно осей OZ1 и OХ1 соответственно) ВКСКНР 16, вход шестого усилительного блока 30 ВКСКНР 16 соединен с выходом третьего сумматора 24 ВКСКНР 16, выход третьего сумматора 24 ВКСКНР 16 соединен также с первым входом третьего вычислительного блока 31 (с коэффициентом передачи (Jy1+Jx2)tgφz/cosφz) ВКСКНР 16, второй вход которого соединен с выходом датчика угла 15, выход третьего вычислительного блока 31 ВКСКНР 16 соединен с первым входом второго умножителя 32 ВКСКНР 16, второй вход которого соединен с выходом четвертого сумматора 26 ВКСКНР 16, выход второго умножителя 32 ВКСКНР 16 соединен с первым входом шестого сумматора 33 ВКСКНР 16, второй вход которого соединен с выходом пятого сумматора 34 ВКСКНР 16, а третий вычитающий вход которого соединен с выходом первого вычислительного блока 21 ВКСКНР 16, третий вычитающий вход пятого сумматора 34 ВКСКНР 16 соединен с выходом первого умножителя 29 ВКСКНР 16, первый вход пятого сумматора 34 ВКСКНР 16 соединен с выходом четвертого умножителя 35 ВКСКНР 16, первый вход которого соединен с выходом пятого усилительного блока 27 ВКСКНР 16, а второй вход которого соединен с выходом первого интегратора 36 ВКСКНР 16, вход которого соединен с выходом пятого умножителя 37 ВКСКНР 16, первый вход которого соединен с выходом ДУС 9, а второй вход которого соединен с выходом ГДУ по каналу наружной рамки 1, второй вычитающий вход пятого сумматора 34 ВКСКНР 16 соединен с выходом шестого умножителя 38 ВКСКНР 16, первый вход которого соединен с выходом второго вычислительного блока 28 ВКСКНР 16, а второй вход которого соединен с выходом первого интегратора 36 ВКСКНР 16, выход шестого сумматора 33 ВКСКНР 16 является выходом вычислителя компенсирующего сигнала канала наружной рамки 16, выход ДУУ12 соединен с входом седьмого усилительного блока 39 (с коэффициентом передачи Тд2, где коэффициент Тд2 равен постоянной времени исполнительного двигателя канала платформы) вычислителя компенсирующего сигнала канала платформы (ВКСКП) 17, выход ДУС 11 соединен с первым входом седьмого сумматора 40 ВКСКП 17, второй вход которого соединен с выходом седьмого усилительного блока 39 ВКСКП 17, выход ДУУ 14 соединен с входом восьмого усилительного блока 41 (с коэффициентом передачи Тд2) ВКСКП17, выход ДУС 13 соединен с первым входом восьмого сумматора 42 ВКСКП 17, второй вход которого соединен с выходом восьмого усилительного блока 41 ВКСКП 17, выход устройства управления 8 по оси наружной рамки 1 по угловому ускорению управления соединен с входом девятого усилительного блока 43 (с коэффициентом передачи Тд2) ВКСКП 17 и соединен с входом десятого усилительного блока 44 (с коэффициентом передачи Тд2) ВКСКП 17, выход устройства управления 8 по оси наружной рамки 1 по угловой скорости управления соединен с первым входом девятого сумматора 45 ВКСКП 17 и соединен также с первым входом десятого сумматора 46 ВКСКП 17, второй вход девятого сумматора 45 ВКСКП 17 соединен с выходом девятого усилительного блока 43 ВКСКП 17, а второй вход десятого сумматора 46 ВКСКП 17 соединен с выходом десятого усилительного блока 44 ВКСКП 17, выход восьмого сумматора 42 ВКСКП 17 соединен с первым входом четвертого вычислительного блока 47 (с коэффициентом передачи 1/cosφz) BKCKП17, второй вход которого соединен с выходом датчика угла 15, выход четвертого вычислительного блока 47 ВКСКП 17 соединен с первым входом одиннадцатого сумматора 48 ВКСКП 17, второй вход которого соединен с выходом пятого вычислительного блока 49 (с коэффициентом передачи 1/tgφz) ВКСКП 17, первый вход которого соединен с выходом девятого сумматора 45 ВКСКП 17, а второй вход соединен с выходом датчика угла 15, выход одиннадцатого сумматора 48 ВКСКП 17 соединен с входом одиннадцатого усилительного блока 50 (с коэффициентом передачи Jx2 - Jy2, где Jy2 - коэффициент, равный главному центральному моменту платформы относительно оси OY2) ВКСКП 17, выход одиннадцатого усилительного блока 50 ВКСКП 17 соединен с первым входом третьего умножителя 51 ВКСКП 17, второй вход которого соединен с выходом десятого сумматора 46 ВКСКП 17, выход третьего умножителя 51 ВКСКП 17 соединен с вторым входом двенадцатого сумматора 52 ВКСКП 17, первый вход которого соединен с выходом седьмого умножителя 53 ВКСКП 17, первый вход которого соединен с выходом двенадцатого усилительного блока 54 (с коэффициентом передачи b2, где b2 - коэффициент, равный коэффициенту вязкого трения по оси платформы) ВКСКП 17, вход которого соединен с выходом седьмого сумматора 40 ВКСКП 17, второй вход седьмого умножителя 53 ВКСКП 17 соединен с выходом второго интегратора 55 ВКСКП 17, вход которого соединен с выходом восьмого умножителя 56 ВКСКП 17, первый вход которого соединен с выходом ДУС 11, а второй вход соединен с выходом ГДУ по каналу платформы 2, выход двенадцатого сумматора 52 ВКСКП 17 является выходом вычислителя компенсирующего сигнала по каналу платформы 2.The biaxial controlled gyrostabilizer contains an
Работа устройства происходит следующим образом.The operation of the device is as follows.
При наличии качки основания платформа 2 стремится сохранить свое положение в пространстве (в режиме стабилизации) или отследить задаваемое устройством управления 8 направление (в режиме управления) благодаря обратной связи с ГДУ 7 через усилители 5 и 6 на исполнительные двигатели 3 и 4. В то же время основание и наружная рамка 1 совершают пространственное движение относительно платформы 2, что приводит к возникновению возмущающих моментов от сил вязкого трения - b1tgφzωx1 и b1ωy0 по оси наружной рамки 1, инерционного возмущающего момента - по оси наружной рамки 1, центробежного возмущающего момента - (Jy1+Jz1-Jx1)ωx1ωz1 по оси наружной рамки 1, центробежного возмущающего момента ((Jy1+Jx2)tgφz/cosφz)ωz1ωлу по оси наружной рамки 1, момента сил вязкого трения b2ωz1 по оси вращения платформы 2, центробежного возмущающего момента (Jx2-Jy2)(ωлу/tgφz+φx1/cosφz)ωлу по оси вращения платформы 2.If there is a pitching of the base,
С целью компенсации инерционного возмущающего момента - ДУУ14 измеряет угловое ускорение Сигнал с выхода ДУУ14 подается на первый вход первого вычислительного блока 21 ВКСКНР 16, на второй вход которого подается сигнал φz с выхода датчика угла 15. Первый вычислительный блок 21 ВКСКНР 16 формирует на выходе сигнал вида который поступает на третий вычитающий вход шестого сумматора 33 ВКСКНР 16. С целью компенсации центробежного возмущающего момента ((Jy1+Jx2)tgφz/cosφz)ωz1ωлу ДУС 11 измеряет угловую скорость ωz1. Сигнал с выхода ДУС 11 поступает на первый вход третьего сумматора 24 ВКСКНР 16. Чтобы исключить отставание компенсирующего момента по отношению к возмущающему из-за инерционности исполнительного двигателя 3, ДУУ 12 измеряет угловое ускорение Сигнал с выхода ДУУ 12 поступает на вход третьего усилительного блока 23 ВКСКНР 16, который формирует на выходе сигнал вида далее этот сигнал поступает на второй вход третьего сумматора 24 ВКСКНР 16. Выходной сигнал третьего сумматора 24 ВКСКНР 16 подается на первый вход третьего вычислительного блока 31 ВКСКНР 16, на второй вход которого подается сигнал φz c выхода датчика угла 15. Третий вычислительный блок 31 ВКСКНР 16 формирует на выходе сигнал вида который поступает на первый вход второго умножителя 32 ВКСКНР 16. Сигнал с выхода устройства управления 8 по оси наружной рамки 1 по угловой скорости управления ωлу поступает на первый вход четвертого сумматора 26 ВКСКНР 16. Чтобы исключить отставание компенсирующего момента по отношению к возмущающему из-за инерционности исполнительного двигателя 3, сигнал с выхода устройства управления 8 по оси наружной рамки 1 по угловому ускорению управления поступает на вход четвертого усилительного блока 25 ВКСКНР 16, который формирует на выходе сигнал вида далее этот сигнал поступает на второй вход четвертого сумматора 26 ВКСКНР 16. Выходной сигнал четвертого сумматора 26 ВКСКНР 16 поступает на второй вход второго умножителя 32 ВКСКНР 16, который на выходе формирует компенсирующий сигнал вида Этот сигнал поступает на первый вход шестого сумматора 33 ВКСКНР 16. С целью компенсации центробежного возмущающего момента - (Jy1+Jz1-Jx1)ωx1ωz1 сигнал с выхода третьего сумматора 24 ВКСКНР 16 поступает на вход шестого усилительного блока 30 ВКСКНР 16, который формирует на выходе сигнал вида Этот сигнал поступает на второй вход первого умножителя 29 ВКСКНР 16. Кроме того, ДУС 13 измеряет угловую скорость ωx1. Сигнал с выхода ДУС 13 поступает на первый вход второго сумматора 22 ВКСКНР 16. Чтобы исключить отставание компенсирующего момента по отношению к возмущающему из-за инерционности исполнительного двигателя 3, ДУУ 14 измеряет угловое ускорение Сигнал с выхода ДУУ 14 поступает на вход второго усилительного блока 20 ВКСКНР 16, который формирует на выходе сигнал вида Этот сигнал поступает на второй вход второго сумматора 22 ВКСКНР 16. Сигнал с выхода второго сумматора 22 ВКСКНР 16 поступает на первый вход первого умножителя 29 ВКСКНР 16, который формирует на выходе компенсирующий сигнал вида Этот сигнал поступает на третий вычитающий вход пятого сумматора 34 ВКСКНР 16. Сигнал с выхода пятого сумматора 34 ВКСКНР 16 поступает на второй вход шестого сумматора 33 ВКСКНР 16. Выход шестого сумматора 33 ВКСКНР 16 является выходом ВКСКНР 16. Сигнал с выхода шестого сумматора 33 ВКСКНР 16 подается через усилитель 5 на исполнительный двигатель 3, что обеспечивает компенсацию возмущающих моментов по оси наружной рамки 1.In order to compensate for the inertial disturbing moment, DNU14 measures angular acceleration The signal from the output of the DUU14 is fed to the first input of the
С целью компенсации момента сил вязкого трения b1ωу0 ДУС 9 измеряет угловую скорость ωу0. Сигнал с выхода ДУС 9 поступает на первый вход первого сумматора 19 ВКСКНР 16. Чтобы исключить отставание компенсирующего момента по отношению к возмущающему из-за инерционности исполнительного двигателя 3, ДУУ 10 измеряет угловое ускорение Сигнал с выхода ДУУ 10 поступает на вход первого усилительного блока 18 ВКСКНР 16, который формирует на выходе сигнал далее этот сигнал поступает на второй вход первого сумматора 19 ВКСКНР 16. Выходной сигнал первого сумматора 19 ВКСКНР 16 поступает на вход пятого усилительного блока 27 ВКСКНР 16, который формирует на выходе компенсирующий сигнал вида Этот сигнал поступает на первый вход четвертого умножителя 35 ВКСКНР 16. Сигнал с выхода ДУС9 поступает также на первый вход пятого умножителя 37 ВКСКНР 16, на второй вход которого поступает сигнал ГДУ 7 по оси наружной рамки 1. Выходной сигнал пятого умножителя 37 ВКСКНР 16 поступает на вход первого интегратора 36 ВКСКНР 16. Выходной сигнал первого интегратора 36 ВКСКНР 16 поступает на второй вход четвертого умножителя 35 ВКСКНР 16. Выходной сигнал четвертого умножителя 35 ВКСКНР 16 поступает на первый вход пятого сумматора 34 ВКСКНР 16. При изменении температуры окружающей среды или загрязнении подшипников изменяется величина коэффициента сил вязкого трения по оси наружной рамки 1, что обуславливает нарушение равенства этого коэффициента и постоянного коэффициента передачи пятого усилительного блока 27 ВКСКНР 16. Это приводит к нарушению равенства возмущающего и компенсирующего моментов и появлению большой ошибки стабилизации платформы 2 по оси наружной рамки 1 от нескомпенсированного момента сил вязкого трения Δb1ωy0 (Δb1 - разность между величиной коэффициента сил вязкого трения и величиной постоянного коэффициента передачи пятого усилительного блока 27). Ошибка стабилизации от момента Δb1ωy0 имеет частоту, равную частоте изменения угловой скорости основания ωy0, и сдвиг по фазе по отношению к угловой скорости основания ωy0, стремящийся к нулю.In order to compensate for the moment of viscous friction forces b 1 ω у0 ДУС 9 measures the angular velocity ω у0 . The signal from the output of the CRS 9 is fed to the first input of the
После перемножения сигнала ДУС 9 и сигнала ГДУ 7 по оси наружной рамки 1, в котором присутствует гармоника, соответствующая ошибке стабилизации от нескомпенсированного момента сил вязкого трения Δb1ωy0, на выходе пятого умножителя 37 ВКСКНР 16 содержится постоянная составляющая сигнала и переменная составляющая сигнала. Первый интегратор 36 ВКСКНР 16 эффективно сглаживает переменную составляющую сигнала пятого умножителя 37 ВКСКНР 16 и осуществляет интегрирование постоянной составляющей сигнала пятого умножителя 37 ВКСКНР 16. В установившемся режиме величина выходного сигнала первого интегратора 36 ВКСКНР 16 равна отношению величины коэффициента сил вязкого трения по оси наружной рамки 1 к коэффициенту передачи пятого усилительного блока 27 ВКСКНР 16. На выходе четвертого умножителя 35 ВКСКНР 16 формируется скорректированный компенсирующий сигнал, амплитуда которого вновь равна амплитуде момента сил вязкого трения, что приводит к повышению точности стабилизации двухосного управляемого гиростабилизатора по оси наружной рамки 1.After multiplying the TLS signal 9 and the GDU signal 7 along the axis of the
На фиг.6 в качестве примера приведен график ошибки двухосного управляемого гиростабилизатора (прототипа) по оси наружной рамки 1 от нескомпенсированного момента сил вязкого трения Δb1ωy0 (Δb1=1 н·м·с, ωy0=sinω·t, ω=1 c-1), а на фиг.7 приведен график ошибки предлагаемого двухосного управляемого гиростабилизатора по оси наружной рамки 1. На фиг.8 приведен график выходного сигнала первого интегратора 36 ВКСКНР 16. Из приведенных графиков видно, что амплитуда ошибки предлагаемого двухосного управляемого ГС от рассмотренного возмущающего момента в 40 раз меньше, чем у прототипа.Figure 6 shows, by way of example, a graph of the error of a biaxial controlled gyrostabilizer (prototype) along the axis of the
С целью компенсации момента сил вязкого трения - b1tgφzωx1 сигнал с выхода второго сумматора 22 ВКСКНР 16 поступает на первый вход второго вычислительного блока 28 ВКСКНР 16, на второй вход которого поступает сигнал с выхода датчика угла 15. На выходе второго вычислительного блока 28 ВКСКНР 16 формируется компенсирующий сигнал который поступает на первый вход шестого умножителя 38 ВКСКНР 16, на второй вход шестого умножителя 38 ВКСКНР 16 поступает выходной сигнал первого интегратора 36 ВКСКНР 16. Выходной сигнал шестого умножителя 38 ВКСКНР 16 поступает на второй вычитающий вход пятого сумматора 34 ВКСКНР 16.In order to compensate for the moment of viscous friction forces - b 1 tgφ z ω x1, the signal from the output of the
При изменении температуры окружающей среды или загрязнении подшипников изменяется величина коэффициента сил вязкого трения по оси наружной рамки 1. Это приводит к нарушению равенства возмущающего и компенсирующего моментов и появлению большой ошибки стабилизации платформы 2 по оси наружной рамки 1 от момента - Δb1tgφzωx1 (Δb1 - разность между величиной коэффициента сил вязкого трения и постоянной величиной b1, входящей в выражение коэффициента передачи второго вычислительного блока 28 ВКСКНР 16). После перемножения выходного сигнала второго вычислительного блока 28 ВКСКНР 16 и выходного сигнала первого интегратора 36 ВКСКНР 16 (величина которого в установившемся режиме равна отношению величины коэффициента сил вязкого трения по оси наружной рамки 1 к коэффициенту передачи пятого усилительного блока 27 ВКСКНР 16, а также равна отношению величины коэффициента сил вязкого трения по оси наружной рамки 1 к постоянной величине b1, входящей в выражение коэффициента передачи второго вычислительного блока 28 ВКСКНР 16) на выходе шестого умножителя 38 ВКСКНР 16 формируется скорректированный компенсирующий сигнал, амплитуда которого вновь равна амплитуде момента сил вязкого трения - b1tgφzωx1, что приводит к повышению точности стабилизации двухосного управляемого гиростабилизатора по оси наружной рамки 1.When the ambient temperature changes or the bearings become dirty, the coefficient of viscous friction forces changes along the axis of the
С целью компенсации центробежного возмущающего момента (Jx2-Jy2)(ωлу/tgφz+ωx1/cosφz)ωлу по оси вращения платформы 2 ДУС 13 измеряет угловую скорость ωx1. Сигнал с выхода ДУС 13 поступает на первый вход восьмого сумматора 42 ВКСКП 17. Чтобы исключить отставание компенсирующего момента по отношению к возмущающему из-за инерционности исполнительного двигателя 4, ДУУ 14 измеряет угловое ускорение . Сигнал с выхода ДУУ 14 поступает на вход восьмого усилительного блока 41 ВКСКП17, который формирует на выходе сигнал вида , далее этот сигнал поступает на второй вход восьмого сумматора 42 ВКСКП 17. Выходной сигнал восьмого сумматора 42 ВКСКП 17 поступает на первый вход четвертого вычислительного блока 47 ВКСКП17, на второй вход которого поступает сигнал φz с выхода датчика угла 15. Четвертый вычислительный блок 47 ВКСКП 17 формирует на выходе сигнал вида который поступает на первый вход одиннадцатого сумматора 48 ВКСКП 17. Сигнал с выхода устройства управления 8 по оси наружной рамки 1 по угловой скорости управления ωлу поступает на первый вход девятого сумматора 45 ВКСКП17. Чтобы исключить отставание компенсирующего момента по отношению к возмущающему из-за инерционности исполнительного двигателя 4, сигнал с выхода устройства управления 8 по оси наружной рамки 1 по угловому ускорению управления поступает на вход девятого усилительного блока 43 ВКСКП17, который формирует на выходе сигнал далее этот сигнал поступает на второй вход девятого сумматора 45 ВКСКП 17. Выходной сигнал девятого сумматора 45 ВКСКП 17 поступает на первый вход пятого вычислительного блока 49 ВКСКП 17, на второй вход которого поступает сигнал φz с выхода датчика угла 15. Пятый вычислительный блок 49 ВКСКП 17 формирует на выходе сигнал вида Этот сигнал поступает на второй вход одиннадцатого сумматора 48 ВКСКП 17, выходной сигнал которого поступает на вход одиннадцатого усилительного блока 50 ВКСКП 17, на выходе которого формируется сигнал Этот сигнал поступает на первый вход третьего умножителя 51 ВКСКП 17. Сигнал с выхода устройства управления 8 по оси наружной рамки 1 по угловой скорости управления ωлу поступает на первый вход десятого сумматора 46 ВКСКП 17. Чтобы исключить отставание компенсирующего момента по отношению к возмущающему из-за инерционности исполнительного двигателя 4, сигнал с выхода устройства управления 8 по оси наружной рамки 1 по угловому ускорению управления поступает на вход десятого усилительного блока 44 ВКСКП 17, который формирует на выходе сигнал далее этот сигнал поступает на второй вход десятого сумматора 46 ВКСКП17. Выходной сигнал десятого сумматора 46 ВКСКП 17 поступает на второй вход третьего умножителя 51 ВКСКП 17, который формирует на выходе компенсирующий сигнал Этот сигнал поступает на второй вход двенадцатого сумматора 52 ВКСКП 17. Выход двенадцатого сумматора 52 ВКСКП 17 является выходом ВКСКП 17. Сигнал с выхода двенадцатого сумматора 47 ВКСКП 17 подается через усилитель 6 на исполнительный двигатель 4, что обеспечивает компенсацию возмущающих моментов по оси платформы 2.In order to compensate for the centrifugal disturbing moment (J x2 -J y2 ) (ω lu / tgφ z + ω x1 / cosφ z ) ω lu , the angular velocity ω x1 is measured along the axis of rotation of the
С целью компенсации момента сил вязкого трения ДУС 11 измеряет угловую скорость ωz1. Сигнал с выхода ДУС 11 поступает на первый вход седьмого сумматора 40 ВКСКП 17. Чтобы исключить отставание компенсирующего момента по отношению к возмущающему из-за инерционности исполнительного двигателя 4, ДУУ 12 измеряет угловое ускорение Сигнал с выхода ДУУ 12 поступает на вход седьмого усилительного блока 39 ВКСКП 17, который формирует на выходе сигнал далее этот сигнал поступает на второй вход седьмого сумматора 40 ВКСКП17. Выходной сигнал седьмого сумматора 40 ВКСКП 17 поступает на вход двенадцатого усилительного блока 54 ВКСКП 17, который формирует на выходе компенсирующий сигнал вида Этот сигнал поступает на первый вход седьмого умножителя 53 ВКСКП 17. Сигнал с выхода ДУС 11 поступает также на первый вход восьмого умножителя 56 ВКСКП 17, на второй вход которого поступает сигнал ГДУ 7 по оси платформы 2. Выходной сигнал восьмого умножителя 56 ВКСКП 17 поступает на вход второго интегратора 55 ВКСКП 17. Выходной сигнал второго интегратора 55 ВКСКП 17 поступает на второй вход седьмого умножителя 53 ВКСКП 17. Выходной сигнал седьмого умножителя 53 ВКСКП 17 поступает на первый вход двенадцатого сумматора 52 ВКСКП 17. При изменении температуры окружающей среды или загрязнении подшипников изменяется величина коэффициента сил вязкого трения по оси платформы 2, что обуславливает нарушение равенства этого коэффициента и постоянного коэффициента передачи двенадцатого усилительного блока 54 ВКСКП 17. Это приводит к нарушению равенства возмущающего и компенсирующего моментов и появлению большой ошибки стабилизации платформы 2 по оси платформы 2 от нескомпенсированного момента сил вязкого трения Δb2ωz1(Δb2 - разность между величиной коэффициента сил вязкого трения по оси платформы 2 и величиной постоянного коэффициента передачи двенадцатого усилительного блока 54 ВКСКП 17). Ошибка стабилизации от момента Δb2ωz1 имеет частоту, равную частоте изменения угловой скорости ωz1, и сдвиг по фазе по отношению к угловой скорости ωz1, стремящийся к нулю. После перемножения сигнала ДУС 11 и сигнала ГДУ 7 по оси платформы 2, в котором присутствует гармоника, соответствующая ошибке стабилизации от нескомпенсированного момента сил вязкого трения Δb2ωz1, на выходе восьмого умножителя 56 ВКСКП 17 содержится постоянная составляющая сигнала и переменная составляющая сигнала. Второй интегратор 55 ВКСКП 17 эффективно сглаживает переменную составляющую сигнала восьмого умножителя 56 ВКСКП17 и осуществляет интегрирование постоянной составляющей сигнала восьмого умножителя 56 ВКСКП 17. В установившемся режиме величина выходного сигнала второго интегратора 55 ВКСКП 17 равна отношению величины коэффициента сил вязкого трения по оси платформы 2 к постоянному коэффициенту передачи двенадцатого усилительного блока 54 ВКСКП 17. На выходе седьмого умножителя 53 ВКСКП 17 формируется скорректированный компенсирующий сигнал, амплитуда которого вновь равна амплитуде момента сил вязкого трения по оси платформы 2, что приводит к повышению точности стабилизации двухосного управляемого гиростабилизатора по оси платформы 2.In order to compensate for the moment of
Таким образом совокупность признаков предлагаемого устройства двухосного управляемого гиростабилизатора, реализация которых может быть выполнена в соответствии с фиг.1, 2, 3, позволяет повысить точность двухосного управляемого гиростабилизатора.Thus, the combination of features of the proposed device biaxial controlled gyrostabilizer, the implementation of which can be performed in accordance with figure 1, 2, 3, can improve the accuracy of the biaxial controlled gyrostabilizer.
Claims (1)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2005130383/28A RU2293949C1 (en) | 2005-09-29 | 2005-09-29 | Two-axial controlled gyro-stabilizer |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2005130383/28A RU2293949C1 (en) | 2005-09-29 | 2005-09-29 | Two-axial controlled gyro-stabilizer |
Publications (1)
Publication Number | Publication Date |
---|---|
RU2293949C1 true RU2293949C1 (en) | 2007-02-20 |
Family
ID=37863507
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
RU2005130383/28A RU2293949C1 (en) | 2005-09-29 | 2005-09-29 | Two-axial controlled gyro-stabilizer |
Country Status (1)
Country | Link |
---|---|
RU (1) | RU2293949C1 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2465553C1 (en) * | 2011-06-17 | 2012-10-27 | Открытое акционерное общество "Научно-производственный комплекс "ЭЛАРА" имени Г.А. Ильенко" (ОАО "ЭЛАРА") | Rotary biaxial device |
RU2781092C1 (en) * | 2021-04-19 | 2022-10-05 | Акционерное общество "Вологодский оптико-механический завод" | Image stabilisation system on a mobile base |
-
2005
- 2005-09-29 RU RU2005130383/28A patent/RU2293949C1/en not_active IP Right Cessation
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2465553C1 (en) * | 2011-06-17 | 2012-10-27 | Открытое акционерное общество "Научно-производственный комплекс "ЭЛАРА" имени Г.А. Ильенко" (ОАО "ЭЛАРА") | Rotary biaxial device |
RU2781092C1 (en) * | 2021-04-19 | 2022-10-05 | Акционерное общество "Вологодский оптико-механический завод" | Image stabilisation system on a mobile base |
RU2793844C1 (en) * | 2022-10-21 | 2023-04-07 | Федеральное государственное бюджетное образовательное учреждение высшего образования "Тульский государственный университет" (ТулГУ) | Biaxial indicator gyrostabilizer |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1146765C (en) | Position controller | |
KR102064630B1 (en) | Transducer acceleration compensation using a delay to match phase characteristics | |
CN105373143B (en) | Large astronomical telescope high-precision control system and method for inhibiting wind load disturbance | |
WO1988008640A1 (en) | Device for controlling speed of servo motor | |
JP2011017688A (en) | Angle measuring method and angle measuring gyro system for executing the same | |
WO2014155559A1 (en) | Notch filter, external force estimator, motor controller, and robot system | |
KR20080041693A (en) | System identification device | |
KR19980083174A (en) | Vibration Suppression Control Method and Control Apparatus of Resonance System | |
RU2293949C1 (en) | Two-axial controlled gyro-stabilizer | |
US4430606A (en) | Sheet feeding apparatus | |
CN109959391B (en) | Signal synchronization method for evaluating dynamic performance of fiber-optic gyroscope | |
JP3917094B2 (en) | Motor control method and apparatus | |
JPH10217173A (en) | Non-interferential control device of robot | |
JP2018165618A (en) | Signal processing device, detection device, physical quantity measurement device, electronic apparatus and mobile body | |
US4531392A (en) | Phase compensator for gauge control using estimate of roll eccentricity | |
RU2241959C1 (en) | Method and device for evaluating navigation parameters of controlled mobile objects | |
JP2794423B2 (en) | Vehicle drive system control device and control method | |
JP4922954B2 (en) | Position control device | |
RU2193160C1 (en) | Method increasing precision of biaxial controllable gyrostabilizer and biaxial controllable gyrostabilizer | |
Tripathi et al. | Development of Self-stabilizing Platform Using MPU-6050 as IMU | |
RU2339989C1 (en) | Longitudinal control automatic machine | |
JP2011004208A (en) | Gimbal device | |
JPH06225564A (en) | Method of measuring load constant of motor drive system | |
RU2260773C1 (en) | Sight line stabilizer | |
RU2230654C1 (en) | Control apparatus for underwater robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
TK4A | Correction to the publication in the bulletin (patent) |
Free format text: AMENDMENT TO CHAPTER -FG4A- IN JOURNAL: 5-2007 |
|
MM4A | The patent is invalid due to non-payment of fees |
Effective date: 20070930 |