RU2615221C2 - Method for providing vibration resistance of pendulum accelerometer of linear accelerations with digital feedback and vibration pendulum accelerometer - Google Patents
Method for providing vibration resistance of pendulum accelerometer of linear accelerations with digital feedback and vibration pendulum accelerometer Download PDFInfo
- Publication number
- RU2615221C2 RU2615221C2 RU2015116808A RU2015116808A RU2615221C2 RU 2615221 C2 RU2615221 C2 RU 2615221C2 RU 2015116808 A RU2015116808 A RU 2015116808A RU 2015116808 A RU2015116808 A RU 2015116808A RU 2615221 C2 RU2615221 C2 RU 2615221C2
- Authority
- RU
- Russia
- Prior art keywords
- input
- accelerometer
- microcontroller
- value
- voltage
- Prior art date
Links
- 230000001133 acceleration Effects 0.000 title claims abstract description 36
- 238000000034 method Methods 0.000 title claims description 22
- 230000008859 change Effects 0.000 claims abstract description 9
- 238000004804 winding Methods 0.000 claims abstract description 8
- 238000005070 sampling Methods 0.000 claims description 32
- 230000005540 biological transmission Effects 0.000 claims description 31
- 238000012546 transfer Methods 0.000 claims description 18
- 230000009471 action Effects 0.000 claims description 8
- 239000003381 stabilizer Substances 0.000 claims description 6
- 230000015572 biosynthetic process Effects 0.000 claims description 5
- 238000013016 damping Methods 0.000 claims description 5
- 238000012937 correction Methods 0.000 claims description 3
- 230000005284 excitation Effects 0.000 claims description 3
- 102000010410 Nogo Proteins Human genes 0.000 claims 1
- 108010077641 Nogo Proteins Proteins 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 4
- 238000005259 measurement Methods 0.000 abstract description 2
- 108010074506 Transfer Factor Proteins 0.000 abstract 4
- 239000000126 substance Substances 0.000 abstract 1
- 230000006870 function Effects 0.000 description 14
- 238000013461 design Methods 0.000 description 9
- 230000008569 process Effects 0.000 description 8
- 230000007704 transition Effects 0.000 description 7
- 230000033001 locomotion Effects 0.000 description 4
- 230000001052 transient effect Effects 0.000 description 4
- 150000002500 ions Chemical class 0.000 description 3
- 230000010355 oscillation Effects 0.000 description 3
- 239000011148 porous material Substances 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 239000000725 suspension Substances 0.000 description 3
- NRJAVPSFFCBXDT-HUESYALOSA-N 1,2-distearoyl-sn-glycero-3-phosphocholine Chemical compound CCCCCCCCCCCCCCCCCC(=O)OC[C@H](COP([O-])(=O)OCC[N+](C)(C)C)OC(=O)CCCCCCCCCCCCCCCCC NRJAVPSFFCBXDT-HUESYALOSA-N 0.000 description 2
- 230000006378 damage Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000001105 regulatory effect Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000005352 clarification Methods 0.000 description 1
- 239000013078 crystal Substances 0.000 description 1
- 235000021475 low acid canned food Nutrition 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000013139 quantization Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measurement Of Mechanical Vibrations Or Ultrasonic Waves (AREA)
- Vibration Prevention Devices (AREA)
Abstract
Description
Способ обеспечения виброустойчивости маятникового акселерометра линейных ускорений с цифровой обратной связью и виброустойчивый маятниковый акселерометрA method of ensuring vibration stability of a pendulum accelerometer of linear accelerations with digital feedback and a vibration-proof pendulum accelerometer
Изобретение относится к измерительной технике и может быть использовано в области приборов для измерения линейного ускорения.The invention relates to measuring equipment and can be used in the field of instruments for measuring linear acceleration.
Известен способ обеспечения виброустойчивости таких измерителей линейных ускорений в условиях динамических воздействий, описанный в [1, стр. 138]. Способ состоит в выборе при проектировании акселерометра одного параметра - крутизны характеристики (коэффициента передачи) усилителя обратной связи с зоной линейности, превышающей предельно возможные амплитуды колебаний чувствительного элемента акселерометра в переходном процессе.A known method of ensuring the vibration resistance of such linear acceleration meters under dynamic conditions, described in [1, p. 138]. The method consists in choosing one parameter when designing the accelerometer — the steepness of the characteristic (transfer coefficient) of the feedback amplifier with a linearity zone exceeding the maximum possible oscillation amplitudes of the sensitive element of the accelerometer in the transient process.
При этом следует отметить, что рассматриваются колебания чувствительного элемента именно в переходном процессе. Система обратной связи измерителя линейного ускорения обычно проектируется как астатическая, т.е. после завершения переходного процесса (если нет явлений «захвата») чувствительный элемент возвращается в исходное положение (среднее между упорами), в котором при регулировании прибора обеспечивается нулевое значение выходного сигнала измерителя.It should be noted that the vibrations of the sensitive element in the transition process are considered. The linear feedback system of the linear acceleration meter is usually designed as astatic, i.e. after the completion of the transition process (if there are no phenomena of "capture"), the sensitive element returns to its original position (the average between the stops), in which, when regulating the device, a zero value of the meter output signal is provided.
Минимизация погрешностей состоит в том, что на этапе проектирования измерителя линейного ускорения обеспечивают равенство единице параметра G=2Mx/R=1, где М=mlA=I⋅KДМ, x=T0/NUкв, R=nβ/Крег, М - момент от воздействия на маятниковость ml линейного ускорения с максимальной заданной амплитудой А, который компенсируется моментом датчика момента I⋅KДМ, х - коэффициент широтной модуляции; Т0, N, Uкв - тактовый период, число заполняющих импульсов и напряжение квантования, соответственно; nβ, Крег - коэффициент демпфирования и коэффициент передачи регулятора, соответственно.The error minimization consists in the fact that at the design stage of the linear acceleration meter they ensure that the parameter is equal to G = 2Mx / R = 1, where M = mlA = I⋅K DM , x = T 0 / NU q , R = n β / K reg , M is the moment from the impact on the pendulum ml of linear acceleration with a maximum specified amplitude A, which is compensated by the moment of the moment sensor I⋅K DM , x is the coefficient of latitudinal modulation; T 0 , N, U sq - the clock period, the number of filling pulses and the quantization voltage, respectively; n β , K reg - damping coefficient and gear ratio of the controller, respectively.
Таким образом, способ состоит в выборе ряда параметров акселерометра, в который входят как параметры его механической части - чувствительного элемента, так и параметры цифровой обратной связи.Thus, the method consists in selecting a number of parameters of the accelerometer, which includes both the parameters of its mechanical part - a sensitive element, and the parameters of digital feedback.
При этом в [1, стр. 176] показано, что при отклонении от 1 значения G динамические ошибки измерителя существенно возрастают. В [1, стр. 183] дана численная оценка динамической погрешности акселерометра при конкретном, практически реализованном выборе параметров акселерометра, при действии гармонической вибрации с максимальной амплитудой 20g на частоте 500 Гц, что соответствует вибрациям, задаваемым для реальных условий эксплуатации. В случае, если параметр G отклоняется от единицы в сторону увеличения либо уменьшения, то динамическая ошибка возрастает. Так, при G=0,5 динамическая ошибка возрастает в 4 раза. Для акселерометра с параметрами, приведенными в [1, стр. 181], при G=0,5 и действии гармонической вибрации с амплитудой 20g на частоте 500 Гц динамическая ошибка составляет 1,25⋅10-2g. При указанном выборе параметров акселерометр является системой близкой к линейной с обеспечением необходимых запасов устойчивости. Описанный способ принят за прототип.At the same time, it was shown in [1, p. 176] that when the value of G deviates from 1, the dynamic errors of the meter increase significantly. In [1, p. 183], a numerical estimate of the dynamic error of the accelerometer is given for a specific, practically implemented choice of accelerometer parameters, under the action of harmonic vibration with a maximum amplitude of 20g at a frequency of 500 Hz, which corresponds to the vibrations specified for actual operating conditions. If the parameter G deviates from unity in the direction of increase or decrease, then the dynamic error increases. So, with G = 0.5, the dynamic error increases 4 times. For an accelerometer with the parameters given in [1, p. 181], with G = 0.5 and the action of harmonic vibration with an amplitude of 20g at a frequency of 500 Hz, the dynamic error is 1.25⋅10 -2 g. With the indicated selection of parameters, the accelerometer is close to linear with the necessary stability margins. The described method is adopted as a prototype.
Недостаток прототипа заключается в том, что в акселерометре, как в любой близкой к линейной системе автоматического управления с конечными запасами устойчивости, существуют частоты, соответствующие пиковым значениям их АЧХ, при которых отклонения чувствительного элемента максимальны, больше, чем отклонения на других частотах даже при максимальных входных ускорениях. Поэтому отклонение чувствительного элемента на этих частотах, и главное, при скачкообразных воздействиях, могут быть значительными, вплоть до удара чувствительного элемента об упор. Однозначный выбор параметров акселерометра при его проектировании в соответствии со способом-прототипом не позволяет исключить возникновение динамических погрешностей, вплоть до ударов об упоры чувствительного элемента, при скачкообразных вибровоздействиях, которые не могут быть прогнозируемы при проектировании акселерометра.The disadvantage of the prototype is that in the accelerometer, as in any close-to-linear automatic control system with finite stability margins, there are frequencies corresponding to the peak values of their frequency response at which the deviations of the sensor are maximum, greater than deviations at other frequencies even at maximum input accelerations. Therefore, the deviation of the sensitive element at these frequencies, and most importantly, with spasmodic effects, can be significant, up to the impact of the sensitive element against the stop. An unambiguous choice of the parameters of the accelerometer during its design in accordance with the prototype method does not preclude the occurrence of dynamic errors, up to impacts on the stops of the sensitive element, with spasmodic vibrations that cannot be predicted when designing the accelerometer.
Задачей изобретения является обеспечение виброустойчивости маятниковых акселерометров с цифровой обратной связью при действии линейных ускорений и вибраций любого характера и любой амплитуды, величина которых не была прогнозирована на этапе проектирования прибора, при этом входные воздействия, естественно, не должны создавать возмущающие моменты, большие, чем максимальный момент датчика моментаThe objective of the invention is to provide vibration stability of pendulum accelerometers with digital feedback under the action of linear accelerations and vibrations of any nature and any amplitude, the magnitude of which was not predicted at the design stage of the device, while the input effects, of course, should not create disturbing moments greater than the maximum torque sensor moment
Технический результат достигается тем, что в способе обеспечения виброустойчивости маятникового акселерометра линейных ускорений с цифровой обратной связью, заключающемся в том, что используют маятниковый акселерометр, в цифровой обратной связи которого устанавливают значения периода дискретизации Т0 работы широтно-импульсного модулятора (ШИМ), маятниковости акселерометра, коэффициента демпфирования, коэффициента передачи регулятора Крег, обеспечивающие минимальную динамическую ошибку акселерометра при действии вибраций с максимальным заданным значением амплитуды линейного ускорения, согласно изобретению, измеряют напряжение Uyп на входе АЦП цифрового усилителя при отклонении чувствительного элемента до упора, записывают в память контроллера: пороговое напряжение Uпop: Uпop=Uyп/кзап, где кзап - коэффициент запаса; значение коэффициента передачи регулятора Крег mах, при котором при выбранных параметрах обеспечивается устойчивость системы с минимально допустимыми запасами по амплитуде и фазе, цифровой код уровня сигнала на входе ШИМ U* max, при котором длительность импульса τ(nT0), где n - целое число, равна периоду дискретизации Т0, значение коэффициента К* корректировки значения коэффициента передачи регулятора Крег, при эксплуатации акселерометра обеспечивают изменение значения коэффициента передачи регулятора в микроконтроллере от Крег до Крег mах по закону:The technical result is achieved by the fact that in the method of providing vibration stability of a pendulum accelerometer of linear accelerations with digital feedback, which consists in the use of a pendulum accelerometer, the digital feedback of which sets the sampling period T 0 of the pulse width modulator (PWM), the pendulum of the accelerometer , damping coefficient, gear ratio of the regulator K reg , providing the minimum dynamic error of the accelerometer under the action of vibrations with max imalnym specify the value of the linear acceleration amplitude according to the invention, measured U Yn voltage at the ADC input digital amplifier rejecting the sensing element until it stops, are recorded in the controller memory of the threshold voltage U thresh: U thresh = U Yn / k app, where zap - factor stock; the value of the regulator transmission coefficient K reg max , at which, with the chosen parameters, the system is stable with the minimum allowable margins in amplitude and phase, the digital code of the signal level at the PWM input is U * max , at which the pulse duration is τ (nT 0 ), where n is an integer numbers equal to the sampling period T 0, K-value * coefficient correction value K reg transmission controller, during operation of the accelerometer values provide a change in the microcontroller of the controller gain K to K reg er max according to the law:
, ,
для чего на каждом шаге дискретизации выполняют измерение и сравнение в микроконтроллере напряжения U(nT0) на входе АЦП усилителя со значением Uпор; при значениях напряжений U(nT0), меньших либо равных Uпор, для организованного внутри микроконтроллера ШИМ формируют в микроконтроллере цифровой входной сигнал U*(nT0), соответствующий текущему значению напряжения U(nT0) при значении коэффициента передачи регулятора Крег; обеспечивают формирование ШИМ последовательности импульсов постоянной амплитуды и длительностью τ(nT0)=[U*(nT0)/U* max]⋅Т0; определяют в микроконтроллере тот шаг дискретизации, на котором U(nT0) больше Uпop, обеспечивают на последующих шагах дискретизации формирование в микроконтроллере увеличенного цифрового сигнала U*(nT0)ув для ШИМ, соответствующего значению коэффициента передачи Крег+(|U(nT0)|-Uпop)⋅K*, что обеспечивает увеличение длительности импульсов на выходе ШИМ до величины τ(nT0)ув=[U*(nT0)ув/U* max]⋅T0; обеспечивают соответствующее увеличение длительности открытого состояния, определяемого величиной τ(nT0)ув, переключателя тока усилителя мощности, что обеспечивает поступление с выхода усилителя мощности в обмотку датчика момента акселерометра последовательности импульсов тока стабилизированной амплитуды и увеличенной длительности, определяют тот шаг дискретизации, на котором на входе АЦП напряжение U(nT0) меньше либо равно Uпop, после чего обеспечивают возврат системы обратной связи к режиму работы со значением коэффициента передачи равным Крег.why at each sampling step, they measure and compare in the microcontroller the voltage U (nT 0 ) at the input of the ADC amplifier with the value of U pores ; when the voltage values U (nT 0 ) are less than or equal to U pores , for the PWM organized inside the microcontroller, a digital input signal U * (nT 0 ) corresponding to the current voltage U (nT 0 ) at the regulator transmission coefficient K reg is generated in the microcontroller; provide the formation of a PWM sequence of pulses of constant amplitude and duration τ (nT 0 ) = [U * (nT 0 ) / U * max ] ⋅ T 0 ; the sampling step is determined in the microcontroller at which U (nT 0 ) is greater than U pop ; at the subsequent sampling steps, the increased digital signal U * (nT 0 ) uv is generated in the microcontroller for the PWM corresponding to the value of the transmission coefficient K reg + (| U ( nT 0 ) | -U pop ) ⋅K * , which provides an increase in the pulse width at the PWM output to the value τ (nT 0 ) uV = [U * (nT 0 ) uV / U * max ] ⋅T 0 ; provide a corresponding increase in the duration of the open state, determined by the value of τ (nT 0 ) uv , of the current switch of the power amplifier, which ensures that a sequence of stabilized amplitude and increased pulse current pulses from the output of the power amplifier to the winding of the accelerometer moment sensor determines the sampling step at which ADC input voltage U (nT 0) is less than or equal to U thresh then provide feedback system returns to an operating mode with coefficient value before the Chi equal to the reg.
Маятниковый акселерометр с цифровой обратной связью [1, стр. 163] выбран в качестве прототипа. Прототип содержит чувствительный элемент, емкостной датчик угла, магнитоэлектрический датчик момента, цифровой усилитель обратной связи, включающий предварительный усилитель, систему формирования цифровой обратной связи, содержащую преобразователь напряжение - временной интервал по схеме ШИМ, выполненный на аналоговых элементах (интегрирующей емкости либо операционном усилителе, включенном по схеме интегратора), усилитель мощности, включающий переключатель тока и стабилизатор тока, генератор тактовой частоты, генератор заполняющих импульсов (внешний генератор), при этом выход датчика угла соединен с входом предварительного усилителя, выход которого соединен с входом системы цифровой обратной связи, а выход последней соединен с входом магнитоэлектрического датчика момента.A pendulum accelerometer with digital feedback [1, p. 163] is selected as a prototype. The prototype contains a sensitive element, a capacitive angle sensor, a magnetoelectric moment sensor, a digital feedback amplifier, including a preamplifier, a digital feedback generation system containing a voltage-time converter according to the PWM scheme, performed on analog elements (integrating capacitance or an operational amplifier included according to the integrator circuit), a power amplifier including a current switch and a current stabilizer, a clock generator, a fill generator pulses (external clock), the angle sensor output is connected to the preamplifier input, whose output is connected to the input of a digital feedback system, and an output connected to the input of the last magnetoelectric torquer.
Прототип имеет структуру с однозначно выбранными параметрами, перечисленными выше, которые обеспечивают минимальную динамическую погрешность при амплитуде виброускорения, не превышающей заданное ожидаемое значение. Это является недостатком прототипа, поскольку при случайных выбросах вибрационных и линейных ускорений не обеспечивается не только допустимое значение динамической погрешности при возникновении переходного процесса с большой амплитудой, но может произойти удар чувствительного элемента об упор с разрушением чувствительного элемента.The prototype has a structure with uniquely selected parameters listed above, which provide the minimum dynamic error with an amplitude of vibration acceleration not exceeding the specified expected value. This is a disadvantage of the prototype, because with random emissions of vibrational and linear accelerations, not only is the acceptable value of the dynamic error in the event of a transient with a large amplitude, but a shock of the sensing element against the stop may occur with the destruction of the sensing element.
Задачей изобретения является введение в конструкцию маятникового акселерометра с цифровой обратной связью элементов, которые позволили бы реализовать способ обеспечения виброустойчивости маятниковых акселерометров с цифровой обратной связью при действии вибраций любого характера и любой амплитуды, величина которой не была прогнозирована на этапе проектирования прибора.The objective of the invention is to introduce into the design of a pendulum accelerometer with digital feedback elements that would allow to implement a method of ensuring vibration stability of pendulum accelerometers with digital feedback under the influence of vibrations of any nature and any amplitude, the value of which was not predicted at the design stage of the device.
Технический результат достигается тем, что в виброустойчивом маятниковом акселерометре с цифровой обратной связью, включающим маятниковый чувствительный элемент, емкостной датчик угла, магнитоэлектрический датчик момента, цифровой усилитель обратной связи, включающий предварительный усилитель, преобразователь напряжение - временной интервал, внешний генератор и усилитель мощности, включающий переключатель тока и стабилизатор тока, при этом датчик угла, цифровой усилитель обратной связи и датчик момента соединены последовательно, согласно изобретению, преобразователь напряжение - временной интервал выполнен в виде микроконтроллера, в котором реализованы АЦП, центральный вычислитель, умножитель частоты, первый таймер, формирующий тактовую частоту, ШИМ, образованный вторым таймером и сравнивающим устройством.The technical result is achieved in that in a vibration-proof pendulum accelerometer with digital feedback, including a pendulum sensing element, a capacitive angle sensor, a magnetoelectric moment sensor, a digital feedback amplifier, including a pre-amplifier, a voltage converter - time interval, an external generator and a power amplifier, including a current switch and a current stabilizer, while an angle sensor, a digital feedback amplifier and a torque sensor are connected in series with According to the invention, the voltage-time interval converter is made in the form of a microcontroller in which an ADC, a central computer, a frequency multiplier, a first timer that generates a clock frequency, a PWM formed by a second timer and a comparator are implemented.
Предлагаемый способ состоит из следующих операций.The proposed method consists of the following operations.
1. На этапе проектирования акселерометра с цифровой обратной связью:1. At the design stage of the accelerometer with digital feedback:
1.1. Для определения алгоритма работы цифровой обратной связи, который выражается разностным уравнением, и максимального значения коэффициента передачи регулятора Kpeг max выполняют следующие операции:1.1. To determine the algorithm of digital feedback, which is expressed by a difference equation, and the maximum value of the coefficient of transfer of the controller K pe max perform the following operations:
1.1.1. Записывают дифференциальное уравнение движения маятника акселерометра в виде:1.1.1. The differential equation of motion of the pendulum of the accelerometer is written in the form:
В этом уравнении:
Iβ, nβ - момент инерции маятника относительно оси подвеса и коэффициент демпфирования движений маятника, соответственно;I β , n β is the moment of inertia of the pendulum relative to the suspension axis and the damping coefficient of the pendulum movements, respectively;
Cm - жесткость подвеса маятника; МДМ - момент датчика момента; m - масса маятника; l - плечо (расстояние от оси подвеса до центра масс маятника); А - ускорение.C m - stiffness of the pendulum suspension; M DM - torque sensor moment; m is the mass of the pendulum; l - shoulder (distance from the suspension axis to the center of mass of the pendulum); A - acceleration.
1.1.2. Методами теории автоматического регулирования определяют дискретную частотную передаточную функцию цифрового усилителя обратной связи (ЦУОС), обеспечивающую необходимые запасы устойчивости и динамические характеристики акселерометра. Для чего составляют структурную схему акселерометра с цифровой обратной связью (ЦОС) с учетом уравнения (1), которая имеет вид, показанный на рис. 1.1.1.2. The methods of the theory of automatic control determine the discrete frequency transfer function of a digital feedback amplifier (CCA), which provides the necessary stability margins and dynamic characteristics of the accelerometer. What is the structural diagram of the accelerometer with digital feedback (DSP) taking into account equation (1), which has the form shown in Fig. one.
На рис. 1 обозначено:In fig. 1 is indicated:
1 - микроконтроллер;1 - microcontroller;
2 - WM(s) - передаточная функция маятника;2 - W M (s) - transfer function of the pendulum;
3 - КУМ - коэффициент передачи усилителя мощности;3 - K UM - transmission coefficient of the power amplifier;
4 - КПУ - коэффициент усиления предварительного усилителя (ПУ);4 - To PU - gain of the preliminary amplifier (PU);
5 - КДУ - коэффициент передачи датчика угла;5 - K DU - gear ratio of the angle sensor;
6 - КДМ - коэффициент передачи датчика момента;6 - K DM - coefficient of transmission of the torque sensor;
7 - ml - маятниковость.7 - ml - pendulum.
Для пояснения рассмотрим конкретный численный пример, относящийся к акселерометру КХ67-041 разработки предприятия ПО «Корпус».For clarification, we consider a specific numerical example related to the KX67-041 accelerometer developed by the Korpus enterprise.
Для этого акселерометра с учетом численных значений параметров, входящих в передаточную функцию WM(s),For this accelerometer, taking into account the numerical values of the parameters included in the transfer function W M (s),
КДУ=182 В/рад, КДМ=150 гсм/А, Iβ=1,2⋅10-4 гсмс2, nβ≅0,05 гсмс,K AV = 182 V / rad, K AM = 150 gcm / A, I β = 1,2⋅10 -4 GSM 2, n β ≅0,05 GSM,
Cm=1,6 гсм/рад, передаточная функция Wa(s), равная WM(s)⋅КДУ⋅КДМ, имеет вид:C m = 1,6 gcm / rad, the transfer function W a (s), equal to W M (s) ⋅K control ⋅K DM, has the form:
Передаточной функции (2) соответствует дискретная частотная передаточная функцияThe transfer function (2) corresponds to a discrete frequency transfer function
По этой передаточной функции построена асимптотическая логарифмическая амплитудная характеристика (ЛАЧХ) на рис. 2 (ломаная 8).Based on this transfer function, the asymptotic logarithmic amplitude characteristic (LFC) in Fig. 2 (broken line 8).
На рис. 2 построена также желаемая ЛАЧХ разомкнутой системы (ломаная 9), при которой обеспечиваются астатизм системы, требуемые запасы устойчивости по фазе и амплитуде, определяются показатель колебательности и время переходного процесса. По разности ломаных 8 и 9 записывают дискретную частотную передаточную функцию ЦУОС, обеспечивающую необходимые запасы устойчивости и динамические характеристики акселерометра, которая имеет вид:In fig. 2, the desired LACF of an open system (polyline 9) is also constructed, which ensures the system astatism, the required stability margins in phase and amplitude, and the oscillation index and the transition process time are determined. According to the difference between
1.1.3. Получают разностное уравнение - алгоритм работы цифрового вычислителя, для чего с помощью подстановки в (4) находится дискретная передаточная функция (при Т0=0,5⋅10-4 с)1.1.3. Get the difference equation - the algorithm of the digital computer, for which, using substitution in (4) there is a discrete transfer function (at T 0 = 0.5 ⋅ 10 -4 s)
и соответствующее (5) разностное уравнение приand the corresponding difference equation (5) for
где IДМ(nT0) - среднее за период Т0 значение тока датчика момента.where I DM (nT 0 ) is the average over the period T 0 the value of the current of the torque sensor.
Уравнение (6) является алгоритмом работы цифрового усилителя обратной связи акселерометра линейных ускорений, разработанного с использованием чувствительного элемента акселерометра КХ67-041.Equation (6) is the algorithm of the digital feedback amplifier of the linear acceleration accelerometer, developed using the sensitive element of the accelerometer KX67-041.
В общем случае уравнение вида (6) может быть записано для любого акселерометра с цифровой системой обратной связи, называется разностным уравнением и является алгоритмом работы цифрового вычислителя.In the general case, an equation of the form (6) can be written for any accelerometer with a digital feedback system, called a difference equation and is the algorithm of the digital computer.
На рис. 2 показана также фазовая характеристика (кривая 10) разомкнутой системы, построенная по передаточной функцииIn fig. 2 also shows the phase characteristic (curve 10) of the open system, constructed by the transfer function
Wраз(jλ)=Wa(jλ)⋅D(jλ).W times (jλ) = W a (jλ) ⋅ D (jλ).
1.1.4. Определяются значения Крег и Крег mах; при Крег обеспечивается штатная работа системы с заданными запасами устойчивости по амплитуде и фазе; при Крег max для системы имеются минимально допустимые запасы по амплитуде (не менее 6 дБ) и по фазе (не менее 30°). Рассчитывается время переходного процесса tпep при Крег.1.1.4. The values of K reg and K reg max are determined; when K reg ensures regular operation of the system with the given stability margins in amplitude and phase; at К reg max for the system there are minimum allowable reserves in amplitude (not less than 6 dB) and in phase (not less than 30 ° ). The transient time t pper is calculated at K reg .
Согласно частотным характеристикам на рис. 2 для рассматриваемого примера при номинальном коэффициенте передачи регулятора Крег=КДУ⋅КДМ⋅КЦУОС=182⋅150⋅1=2,73⋅104 гсм/рад, частота среза разомкнутой системы составляет 3000 рад/сек, запас устойчивости по фазе - 59°, по амплитуде - ≈16 дБ.According to the frequency characteristics in Fig. 2 for this example at a nominal transmission ratio controller K = K Control reg ⋅K DM ⋅K TSUOS = 182⋅150⋅1 = 2,73⋅10 4 gsm / rad, the open loop crossover frequency is 3,000 rad / s, the stability margin of phase - 59 °, in amplitude - ≈16 dB.
Достаточный запас устойчивости по фазе 30° соответствует частоте 7500 рад/сек. Следовательно, при увеличении частоты среза разомкнутой системы до 7500 рад/сек, что будет при увеличении КЦУОС (следовательно, и Крег) в три раза, замкнутая система останется устойчивой. Таким образом, Крег mах = 3 ⋅ Крег.A sufficient phase margin of 30 ° corresponds to a frequency of 7500 rad / s. Consequently, with an increase in the cutoff frequency of an open system to 7500 rad / s, which will be a three-fold increase in K DSPC (and therefore K reg ), the closed system will remain stable. Thus, K reg max = 3 ⋅ K reg .
Определяется значение коэффициента К*, при котором обеспечивается переход от Крег к Крег mах за несколько периодов дискретизации Т0 (3…4).The value of the coefficient K * is determined, at which the transition from K reg to K reg max for several sampling periods T 0 (3 ... 4) is ensured.
1.1.5. Разрабатывают программу, обеспечивающую работу центрального вычислителя микроконтроллера в соответствии с разностным уравнением, в рассматриваемом примере - с алгоритмом (6),1.1.5. A program is developed that ensures the operation of the central computer of the microcontroller in accordance with the difference equation, in the considered example with the algorithm (6),
1.1.6. Разрабатывают программу работы микроконтроллера, в которой коэффициент передачи Крег=Крег(nT0) изменяется по закону1.1.6. A microcontroller work program is developed in which the transmission coefficient K reg = K reg (nT 0 ) changes according to the law
Изменение Крег=Крег(nT0) осуществляется за счет изменения КЦУОС - коэффициента передачи цифрового усилителя обратной связи.The change in K reg = K reg (nT 0 ) is due to a change in K DSP - transmission coefficient of the digital feedback amplifier.
1.1.7. Разрабатывают программу формирования ШИМ длительности импульса постоянной амплитуды по закону τ(nT0)=[U*(nT0)/U* max]Т0, где U*(nT0) - цифровой код уровня сигнала на входе ШИМ, U* max - тот же цифровой код при длительности импульса τ(nT0), равной периоду дискретизации Т0.1.1.7. A program is being developed for generating PWM pulse widths of constant amplitude according to the law τ (nT 0 ) = [U * (nT 0 ) / U * max ] T 0 , where U * (nT 0 ) is the digital code of the signal level at the input of the PWM, U * max - the same digital code with a pulse duration τ (nT 0 ) equal to the sampling period T 0 .
Физический смысл U*(nT0) и U*max может быть пояснен на рис. 3. Показана «цифровая пила», которую строит второй таймер микроконтроллера. Он выдает массив возрастающих цифровых кодов в зависимости от времени. Цифровой вычислитель преобразует напряжение на входе АЦП в кодовый уровень U*(nT0), в организованном программным образом сравнивающем устройстве микроконтроллера U*(nT0) сравнивается с «цифровой пилой» и отсекается момент времени, когда наступает равенство кода U*(nT0) и соответствующего цифрового значения кода на «пиле». Так формируется длительность импульса ШИМ. U*max - это максимальный цифровой уровень «цифровой пилы», которому соответствует длительность импульса τ(nT0), равная периоду дискретизации Т0.The physical meaning of U * (nT 0 ) and U * max can be explained in Fig. 3. The "digital saw", which is built by the second timer of the microcontroller, is shown. It produces an array of incremental digital codes versus time. The digital computer converts the voltage at the input of the ADC to the code level U * (nT 0 ), in the programmer’s comparing device of the microcontroller U * (nT 0 ), it is compared with the “digital saw” and the time is cut off when the equality of the code U * (nT 0 ) and the corresponding digital value of the code on the “saw”. So the pulse width of the PWM is formed. U * max is the maximum digital level of the "digital saw", which corresponds to the pulse duration τ (nT 0 ), equal to the sampling period T 0 .
1.2. Изготавливается опытный образец акселерометра.1.2. A prototype accelerometer is being manufactured.
На этапе изготовления измеряют напряжение Uyп на входе АЦП цифрового усилителя при отклонении чувствительного элемента до упора.At the manufacturing stage, the voltage U yп is measured at the input of the ADC of the digital amplifier when the sensor is deflected to the stop.
1.3. Выбирается коэффициент запаса кзап и определяется пороговое значение напряжения на входе АЦП Uпор=Uуп/кзап.1.3. The safety factor to zap is selected and the threshold value of the voltage at the input of the ADC U pore = U up / k zap is determined.
1.4. Вычисляется Крег=КДУ⋅КДМ⋅КЦУОС, для рассматриваемого примера КЦУОС=11.4. It is calculated K reg = K DU МK DM ⋅K TsUOS , for the considered example K TsUOS = 1
1.5. В память контроллера записывают:1.5. The controller memory is written:
- выбранное значение Uпop=Uуп/кзап,- the selected value of U pop = U up / to app ,
- значение Крег max,- the value of K reg max ,
- максимальное цифровое значение сигнала U* max для формирования последовательности импульсов на выходе ШИМ,- the maximum digital value of the signal U * max for the formation of a sequence of pulses at the output of the PWM,
- значение коэффициента К* корректировки значения коэффициента передачи регулятора,- the value of the coefficient K * adjustment of the value of the gear ratio of the regulator,
- программу, осуществляющую работу цифрового вычислителя контроллера в соответствии с разностным уравнением, в рассматриваемом примере - с алгоритмом (6),- a program that performs the work of a digital computer controller in accordance with the difference equation, in the considered example - with the algorithm (6),
- программу работы контроллера, в которой коэффициент передачи Крег(nT0) изменяется по закону (7). Изменение осуществляется за счет изменения КЦУОС - коэффициента передачи цифрового усилителя обратной связи,- the program of the controller, in which the transmission coefficient K reg (nT 0 ) changes according to the law (7). The change is due to a change in the DSPC - transmission coefficient of the digital feedback amplifier,
- программу формирования ШИМ длительности τ(nT0) импульса постоянной амплитуды по закону τ(nT0)=[U*(nT0)/U* max]⋅T0.- a PWM generation program of duration τ (nT 0 ) of a constant amplitude pulse according to the law τ (nT 0 ) = [U * (nT 0 ) / U * max ] ⋅ T 0 .
1.6. В эксплуатации акселерометра программным способом система цифровой обратной связи выполняет следующие операции. 1.6. In operation of the accelerometer programmatically, the digital feedback system performs the following operations.
1.6.1. Обеспечивает измерение напряжения, поступающего с выхода предварительного усилителя на вход АЦП на каждом шаге дискретизации U(nT0).1.6.1. Provides a measurement of the voltage supplied from the output of the pre-amplifier to the ADC input at each sampling step U (nT 0 ).
1.6.2. Центральный вычислитель на каждом такте дискретизации nT0 по записанной в память программе, реализующей алгоритм - разностное уравнение, рассчитывает цифровой код IДМ(nT0), который соответствует среднему за период Т0 значению тока датчика момента, который, в свою очередь, пропорционален измеренному линейному ускорению.1.6.2. The central calculator at each sampling cycle nT 0 according to the stored program that implements the algorithm - difference equation, calculates the digital code I DM (nT 0 ), which corresponds to the average value of the current of the torque sensor over a period T 0 , which, in turn, is proportional to the measured linear acceleration.
Для расчета цифрового кода IДМ(nT0) используются его значения на предыдущих шагах IДМ[(n-1)Т0], IДМ[(n-2)Т0], а также значения напряжения на входе АЦП UДУ(nT0), UДУ[(n-1)Т0], UДУ[(n-2)Т0 с коэффициентами, записанными в разностном уравнении.To calculate the digital code I ДМ (nT 0 ), its values are used at the previous steps I ДМ [(n-1) Т 0 ], I ДМ [(n-2) Т 0 ], as well as the voltage value at the input of the ADC U ДУ ( nT 0 ), U ДУ [(n-1) Т 0 ], U ДУ [(n-2) Т 0 with coefficients written in the difference equation.
1.6.3. Микроконтроллер обеспечивает сравнение измеренного напряжения U(nT0) с Uпop.1.6.3. The microcontroller provides a comparison of the measured voltage U (nT 0 ) with U pop .
1.6.4. Если U(nT0) меньше либо равно Uпop, то работа системы обратной связи обеспечена при значении коэффициента передачи, равном Крег.1.6.4. If U (nT 0 ) is less than or equal to U pop , then the feedback system is provided with a transmission coefficient equal to K reg .
1.6.5. Цифровой вычислитель формирует цифровой выходной сигнал U*(nT0), соответствующий измеренному сигналу U(nT0) на входе АЦП.1.6.5. The digital computer generates a digital output signal U * (nT 0 ) corresponding to the measured signal U (nT 0 ) at the ADC input.
1.6.6. Сигналы U*(nT0) поступают на вход ШИМ, организованного внутри микроконтроллера.1.6.6. Signals U * (nT 0 ) are fed to the PWM input, organized inside the microcontroller.
1.6.7. ШИМ в соответствии с сигналом U*(nT0) формирует последовательность импульсов напряжения, амплитуда которых постоянна и близка к напряжению питания микроконтроллера, а длительность τ(nT0) определяется выражением:1.6.7. PWM in accordance with the signal U * (nT 0 ) forms a sequence of voltage pulses, the amplitude of which is constant and close to the supply voltage of the microcontroller, and the duration τ (nT 0 ) is determined by the expression:
1.6.8. Если на каком-то шаге дискретизации в условиях эксплуатации сигнал на входе АЦП U(nT0) становится больше Uпop, то автоматически осуществляется переход на работу системы обратной связи при значении коэффициента передачи, равном Крег+(|U(nT0)|-Uпop)⋅К*. При этом микроконтроллер на каждом последующем шаге дискретизации вычисляет разность |U(nT0)|-Uпоp, умножает вычисленную разность на К* и увеличивает значение коэффициента передачи на полученное значение. При этом полученное значение коэффициента передачи не должно превышать значения Крег mах. При этом обеспечивается форсированный возврат системы к значению величины напряжения на входе АЦП U(nT0), которое меньше либо равно Uпop.1.6.8. If at some step of sampling in operating conditions the signal at the input of the ADC U (nT 0 ) becomes greater than U pop , then the feedback system will automatically switch to the operation of the feedback system with the transmission coefficient equal to K reg + (| U (nT 0 ) | -U pop ) ⋅K * . In this case, the microcontroller at each subsequent sampling step calculates the difference | U (nT 0 ) | -U p , multiplies the calculated difference by K * and increases the value of the transfer coefficient by the obtained value. Moreover, the obtained value of the transmission coefficient should not exceed the value of K reg max . This ensures a forced return of the system to the value of the voltage at the ADC input U (nT 0 ), which is less than or equal to U pop .
Рассмотрим, как обеспечивается этот процесс.Consider how this process is provided.
Задача импульсов, поступающих с выхода ШИМ на вход усилителя мощности, только одна: обеспечить открытие переключателя тока усилителя мощности на промежуток времени, равный указанным строго регламентированным значениям τ(nT0). В усилителе мощности (рис. 4) переключатель тока реализован на транзисторах, обозначенных T1 (11), Т2 (12), Т3 (13), Т4 (14). Например, если управляющий импульс на входе усилителя мощности открыл транзисторы T1 и Т2, то от операционного усилителя (15), который входит в состав стабилизатора тока усилителя мощности, ток пойдет через транзистор T1, обмотку датчика момента акселерометра, транзистор Т2 и резисторы Rэт (16), R1 (17), R2 (18). Падение напряжение на резисторе R2 является напряжением обратной связи операционного усилителя. Операционный усилитель и резисторы Rэт, R1, R2 реализуют обратную связь и вместе с источником опорного напряжения (ИОН) (19) образуют стабилизатор тока. ИОН, предназначенный для подачи на вход операционного усилителя высокостабильного напряжения, и резисторы Rэт, R1, R2 выбираются с повышенными требованиями к стабильности. Например, в качестве ИОН выбрана микросхема AD780 со стабильностью напряжения 0,0005%, резисторы должны иметь стабильность 0,001%. Это обеспечивает высокостабильную амплитуду тока. Таким образом, на выходе усилителя мощности создаются импульсы тока, имеющие высоко стабильную амплитуду. При этом среднее значение тока за период дискретизации Т0 пропорционально измеряемому линейному ускорению в силу принципа действия акселерометра линейных ускорений, имеющего обратную связь, а именно mlg=кдмIос.The task of the pulses coming from the PWM output to the input of the power amplifier is only one: to ensure the opening of the current switch of the power amplifier for a period of time equal to the specified strictly regulated values of τ (nT 0 ). In the power amplifier (Fig. 4), the current switch is implemented on transistors designated T 1 (11), T 2 (12), T 3 (13), T 4 (14). For example, if the control pulse at the input of the power amplifier opened the transistors T 1 and T 2 , then from the operational amplifier (15), which is part of the current stabilizer of the power amplifier, the current will go through the transistor T 1 , the winding of the accelerometer torque sensor, transistor T 2 and resistors R et (16), R 1 (17), R 2 (18). The voltage drop across the resistor R 2 is the feedback voltage of the operational amplifier. The operational amplifier and resistors R et , R 1 , R 2 realize feedback and, together with a reference voltage source (ION) (19) form a current stabilizer. An ION designed to supply a highly stable voltage to the input of an operational amplifier, and resistors R et , R 1 , R 2 are selected with increased stability requirements. For example, an AD780 chip with a voltage stability of 0.0005% was chosen as an ION; resistors should have a stability of 0.001%. This provides a highly stable current amplitude. Thus, current pulses having a highly stable amplitude are created at the output of the power amplifier. Moreover, the average current value for the sampling period T 0 is proportional to the measured linear acceleration due to the principle of operation of the linear acceleration accelerometer with feedback, namely mlg = k dm Ioc.
Таким образом, в момент времени, когда момент от маятниковости с учетом действующего линейного ускорения mlg станет равен моменту датчика момента kдмIос (kдм - крутизна характеристики датчика момента, Ioc - ток обратной связи), напряжение с датчика угла по окончании переходного процесса становится равным нулю. Система - в равновесии.Thus, at the moment when the moment from the pendulum, taking into account the effective linear acceleration mlg, becomes equal to the moment of the moment sensor k dm IОС (k dm is the steepness of the characteristic of the moment sensor, Ioc is the feedback current), the voltage from the angle sensor at the end of the transition process becomes equal to zero. The system is in balance.
Рассмотрим пример работы акселерометра КХ67-041 с приведенными выше техническими характеристиками в условиях скачкообразного изменения в условиях эксплуатации линейного ускорения; выражением (6) задан алгоритм работы цифровой обратной связи акселерометра; в память контролера записан закон изменения коэффициента передачи (7). При проектировании акселерометра с цифровой обратной связью выбраны и записаны в память контроллера значения коэффициентов Крег=2,73⋅104, получаемый при КЦУОС=1, Крег mах=8,19⋅104, (при КЦУОС mах=3), выбранный из условия обеспечения запасов по амплитуде и фазе, соответственно, 6 дБ и 30°.Consider the example of the operation of the KX67-041 accelerometer with the above technical characteristics under conditions of a jump in the operating conditions of linear acceleration; expression (6) sets the algorithm for the digital feedback of the accelerometer; the law of change in the transmission coefficient (7) is recorded in the controller's memory. When designing the accelerometer with digital feedback, the coefficients K reg = 2.73⋅10 4 obtained at K TsUOS = 1, K reg max = 8.19⋅10 4 , (with K TsUOS max = 3, were selected and written into the controller memory ), selected from the conditions for providing reserves in amplitude and phase, respectively, 6 dB and 30 °.
Для рассматриваемой конструкции акселерометра упоры расположены от среднего положения на углах ±6,8'. Выбран коэффициент запаса кзап=10. Напряжение на входе АЦП при отклонении маятника до упора Uуп=3,6 В.For the design of the accelerometer under consideration, the stops are located from the middle position at angles of ± 6.8 '. The safety factor is selected to app. = 10. The voltage at the input of the ADC when the pendulum is deflected to the stop U up = 3.6 V.
С учетом выбранного коэффициента запаса появление на входе АЦП напряжения 0,36 В соответствует отклонению маятника на угол 0,68'. Поэтому выбрано значение порогового напряжения Uпop=0,36 В, которое записано в память контроллера.Given the selected safety factor, the appearance of a voltage of 0.36 V at the input of the ADC corresponds to a deviation of the pendulum by an angle of 0.68 '. Therefore, the selected value of the threshold voltage U pop = 0.36 V, which is recorded in the controller memory.
В контроллер записана программа изменения коэффициента передачи в соответствии с законом (7).A program for changing the transmission coefficient in accordance with law (7) is recorded in the controller.
Для того чтобы угол отклонения маятника не превысил ±6,8', при скачке линейного ускорения до 10g была выбрана величина К*=25.In order for the pendulum deviation angle not to exceed ± 6.8 ', when the linear acceleration jumps to 10 g, the value K * = 25 was chosen.
Таким образом, определены параметры, определяющие работу системы с переменным коэффициентом передачи:Thus, the parameters that determine the operation of the system with a variable transmission coefficient are defined:
Крег=2,73⋅104 (КЦУОС=1); К*=25; Uпop=0,36 В; Крег mах=8,19⋅104 (КЦУОС max=3).To reg = 2,73⋅10 4 (To TsUOS = 1); K * = 25; U pop = 0.36 V; To reg max = 8.19⋅10 4 (To TsUOS max = 3).
На рис. 5 представлены амплитудно-фазовые частотные характеристики замкнутой системы «акселерометр - цифровая обратная связь», построенные с использованием математической модели, включающей передаточную функцию (2) и алгоритм (6). Показано, что система обладает необходимыми запасами устойчивости, полоса пропускания составляет ~ 640 Гц, показатель колебательности не превышает 1,1, что близко к характеристикам КХ67-041 с аналоговым усилителем обратной связи.In fig. Figure 5 shows the amplitude-phase frequency characteristics of the closed system "accelerometer - digital feedback" constructed using a mathematical model that includes the transfer function (2) and algorithm (6). It is shown that the system has the necessary stability margins, the passband is ~ 640 Hz, the oscillation index does not exceed 1.1, which is close to the characteristics of the KX67-041 with an analog feedback amplifier.
Выполнено моделирование переходных процессов в акселерометре.Simulation of transients in the accelerometer is performed.
Моделирование акселерометра с цифровой обратной связью (ЦОС) показало следующее: есть переходный процесс по углу β в акселерометре с передаточной функцией аналоговой части (2) и ЦОС, работающей в соответствии с алгоритмом (6) при скачкообразном воздействии ускорения в 10g. По окончании переходного процесса угол β в астатической системе сходится к нулю, однако его максимальная величина достигла 4⋅10-3 рад=13,76' (моделирование проводилось при отсутствии «упоров», ограничивающих движение маятника). В реальном приборе КХ67-041 «упоры» ограничивают движение маятника углом ±6,8'.The simulation of the digital feedback accelerometer (DSP) showed the following: there is a transient in the angle β in the accelerometer with the transfer function of the analog part (2) and the DSP operating in accordance with algorithm (6) under the spasmodic action of acceleration of 10g. At the end of the transition process, the angle β in the astatic system converges to zero, however, its maximum value reached 4⋅10 -3 rad = 13.76 '(modeling was carried out in the absence of “stops” restricting the movement of the pendulum). In a real device KX67-041, the “stops” limit the movement of the pendulum to an angle of ± 6.8 '.
Переходной процесс в акселерометре с «упорами». Возмущением, как и в первом случае, является скачок ускорения 10g. Произошел удар маятника об «упор». Это явление крайне нежелательное, т.к. может привести к разрушению маятника или, в лучшем случае, к некоторой потере выходной информации.The transition process in the accelerometer with "stops". The perturbation, as in the first case, is an acceleration jump of 10g. There was a pendulum strike about the "emphasis". This phenomenon is extremely undesirable, because can lead to the destruction of the pendulum or, at best, to some loss of output information.
Предлагаемый способ обеспечения виброустойчивости акселерометра исключает такие явления.The proposed method of providing vibration resistance of the accelerometer eliminates such phenomena.
Результаты моделирования акселерометра, для которого коэффициент передачи алгоритма (6) изменяется в соответствии с законом (7) при указанных выше численных значениях параметров:The simulation results of the accelerometer, for which the transmission coefficient of algorithm (6) changes in accordance with the law (7) at the above numerical values of the parameters:
Крег=2,73⋅104 (КЦУОС=1); К*=25; Uпop=0,36 B; Кpeг max=8,19⋅104 (КЦУОС max=3).To reg = 2,73⋅10 4 (To TsUOS = 1); K * = 25; U pop = 0.36 B; K peg max = 8.19⋅10 4 (K TsUOS max = 3).
Появление на входе АЦП напряжения 0,36 В соответствует отклонению маятника на угол 0,68'. Согласно графику (3) благодаря реализации переменного коэффициента передачи ЦОС согласно соотношениям (7) при скачке ускорения 10g угол отклонения маятника не превысил 1,5⋅10-3 рад=5,16', т.е. маятник не коснулся упора.The appearance at the input of the ADC voltage of 0.36 V corresponds to the deviation of the pendulum at an angle of 0.68 '. According to the graph (3), due to the implementation of the variable DSP transmission coefficient according to relations (7) with an acceleration jump of 10g, the angle of deviation of the pendulum did not exceed 1.5⋅10 -3 rad = 5.16 ', i.e. the pendulum did not touch the stop.
Чувствительный элемент имеет конструкцию, полностью соответствующую конструкции прототипа.The sensitive element has a design that is fully consistent with the design of the prototype.
Передаточная функция представленной схемы усилителя мощности равна:The transfer function of the presented power amplifier circuit is equal to:
Как видно из передаточной функции (9), для получения стабильной амплитуды импульсов тока датчика момента необходимо использование высокостабильного источника опорного напряжения UОП, высокостабильных сопротивлений R1, R2 и RЭТ. Активные элементы - операционный усилитель ОУ, транзисторы Т1-Т4 должны быть рассчитаны на ток, соответствующий диапазону измеряемых линейных ускорений, и обладать достаточным быстродействием: время включения-выключения, как правило, не должно превышать 100 нс.As can be seen from the transfer function (9), to obtain a stable amplitude of the current pulse of the torque sensor, it is necessary to use a highly stable source of reference voltage U OP , highly stable resistances R 1 , R 2 and R ET . The active elements are the op-amp operational amplifier, transistors T 1 -T 4 must be designed for a current corresponding to the range of measured linear accelerations, and have sufficient speed: the on-off time, as a rule, should not exceed 100 ns.
На рис. 6- структурная схема микроконтроллера.In fig. 6 - block diagram of the microcontroller.
Микроконтроллер (1), помимо центрального вычислителя (процессора) (20), имеет периферию, т.е. кристаллы, на которых выполнены следующие элементы: АЦП (21), ШИМ (22), первый таймер (23) и второй таймер (24), умножитель частоты (25), сравнивающее устройство (26). ШИМ образуют второй таймер и сравнивающее устройство.The microcontroller (1), in addition to the central computer (processor) (20), has peripherals, i.e. crystals on which the following elements are made: ADC (21), PWM (22), the first timer (23) and the second timer (24), a frequency multiplier (25), a comparator (26). PWM form a second timer and a comparator.
Акселерометр с цифровой обратной связью работает следующим образом. При действии ускорения вокруг оси торсиона акселерометра создается момент, с датчика угла напряжение поступает на предварительный усилитель (27), с предварительного усилителя на АЦП. С источника стабилизированного напряжения (28) на АЦП подается напряжение питания. Внешний генератор (29) запускает умножитель частоты микроконтроллера. В реализованном на предприятии макетном образце внешний генератор выдает 10 мГц, а умножитель частоты формирует 80 мГц. Эта частота является синхрочастотой и подается на АЦП, на вход центрального вычислителя, на первый и второй таймеры. Центральный вычислитель запускает АЦП и с выхода АЦП принимает данные в цифровых кодах UДУ(nT0), UДУ[(n-1)Т0], UДУ[(n-2)Т0. В центральный вычислитель записаны все перечисленные выше программы и числовые данные по параметрам К*, кзап, Uпop, U* max, Крег mах. Первый таймер формирует период дискретизации Т0 и подает его в центральный вычислитель. На акселерометр первый таймер подает частоту возбуждения датчика угла. Центральный вычислитель на каждом такте дискретизации nT0 по записанной в память программе, реализующей алгоритм - разностное уравнение, рассчитывает цифровой код IДМ(nT0), который соответствует среднему за период Т0 значению тока датчика момента, который, в свою очередь, пропорционален измеренному линейному ускорению (для расчета цифрового кода IДМ(nT0) используются его значения на предыдущих шагах IДМ[(n-1)Т0], IДМ[(n-2)Т0], а также значения UДУ(nT0), UДУ[(n-1)Т0], UДУ[(n-2)Т0 с коэффициентами, записанными в разностном уравнении); этот цифровой код преобразуется в цифровую выходную информацию (унитарный код, RS-стандарт, Манчестер …) и подается в систему управления изделием, на котором установлен акселерометр).The accelerometer with digital feedback operates as follows. Under the action of acceleration, a moment is created around the axis of the accelerometer torsion, voltage is supplied from the angle sensor to the pre-amplifier (27), from the pre-amplifier to the ADC. The voltage source is supplied from the stabilized voltage source (28) to the ADC. An external generator (29) starts the frequency multiplier of the microcontroller. In the prototype model implemented at the enterprise, the external generator gives out 10 MHz, and the frequency multiplier forms 80 MHz. This frequency is a clock frequency and is fed to the ADC, to the input of the central computer, to the first and second timers. The central computer starts the ADC and from the ADC output receives data in digital codes U DU (nT 0 ), U DU [(n-1) T 0 ], U DU [(n-2) T 0 . The central computer contains all of the above programs and numerical data on the parameters K *, to zap, thresh the U, U * max, K max reg. The first timer generates a sampling period T 0 and feeds it to the central computer. To the accelerometer, the first timer feeds the excitation frequency of the angle sensor. The central calculator at each sampling cycle nT 0 according to the stored program that implements the algorithm - difference equation, calculates the digital code I DM (nT 0 ), which corresponds to the average value of the current of the torque sensor over a period T 0 , which, in turn, is proportional to the measured linear acceleration (to calculate the digital code I DM (nT 0 ), its values are used in the previous steps I DM [(n-1) T 0 ], I DM [(n-2) T 0 ], as well as the values of U ДУ (nT 0 ), U ДУ [(n-1) Т 0 ], U ДУ [(n-2) Т 0 with coefficients written in the difference equation); this digital code is converted to digital output information (unitary code, RS-standard, Manchester ...) and fed into the product control system on which the accelerometer is installed).
В центральном вычислителе на каждом шаге дискретизации напряжение U(nT0), поступающее на вход АЦП, после преобразования в код, сравнивается с Uпор. При напряжениях, меньших либо равных Uпop, формируется цифровой сигнал U*(nT0) для ШИМ, соответствующий значению коэффициента передачи Крег, и длительность импульсов в сравнивающем устройстве равна τ(nT0)=[U*(nT0)/U* max]⋅T0.In the central computer, at each sampling step, the voltage U (nT 0 ) supplied to the ADC input, after conversion to code, is compared with U then . At voltages less than or equal to U pop , a digital signal U * (nT 0 ) is generated for the PWM, corresponding to the value of the transmission coefficient K reg , and the pulse duration in the comparator is τ (nT 0 ) = [U * (nT 0 ) / U * max ] ⋅T 0 .
Центральный вычислитель определяет тот шаг дискретизации, на котором U(nT0) больше Uпop и обеспечивает на последующих шагах дискретизации формирование увеличенного дискретного сигнала U*(nT0)ув для ШИМ, одновременно рассчитывается новое значение коэффициента передачи регулятора, равное Крег+(|U(nT0)|-Uпор)⋅К*, что обеспечивает увеличение длительности импульсов на выходе ШИМ до величины τ(nT0)ув=[U*(nT0)ув/U* max]⋅T0.The central calculator determines the sampling step at which U (nT 0 ) is greater than U pop and ensures the formation of an increased discrete signal U * (nT 0 ) uv for PWM at subsequent sampling steps, at the same time, a new value of the regulator transmission coefficient is calculated, equal to K reg + ( | U (nT 0 ) | -U then ) ⋅К * , which provides an increase in the pulse duration at the PWM output to τ (nT 0 ) uv = [U * (nT 0 ) uV / U * max ] ⋅T 0 .
Аналогично, на том шаге дискретизации, на котором U(nT0) становится меньше Uпop, обеспечивается возврат к значению коэффициента передачи Крег. Similarly, at that sampling step, at which U (nT 0 ) becomes less than U pop , a return to the value of the transmission coefficient K reg is provided .
Сформированный цифровой сигнал U*(nT0) для ШИМ передается на сравнивающее устройство, на которое второй таймер подает сформированную «цифровую пилу».The generated digital signal U * (nT 0 ) for the PWM is transmitted to a comparator, to which the second timer supplies the generated “digital saw”.
В сравнивающем устройстве выполняется сравнение кода U*(nT0) со значениями «цифровой пилы» и отсекается момент времени, когда наступает равенство кода U*(nT0) и соответствующего цифрового значения кода на «пиле». Так формируется длительность импульса ШИМ. По каналу плюс или минус (в зависимости от знака измеренного линейного ускорения) эти импульсы определенной длительности поступают на входы усилителя мощности, в котором амплитуда импульсов стабилизируется и поступает в обмотку датчика момента акселерометра.In the comparison device, the code U * (nT 0 ) is compared with the values of the “digital saw” and the time is cut off when the equality of the code U * (nT 0 ) and the corresponding digital code value on the “saw” occurs. So the pulse width of the PWM is formed. On the plus or minus channel (depending on the sign of the measured linear acceleration), these pulses of a certain duration arrive at the inputs of the power amplifier, in which the pulse amplitude is stabilized and enters the winding of the accelerometer moment sensor.
Таким образом, заявлены:Thus declared:
1. Способ обеспечения виброустойчивости маятникового акселерометра линейных ускорений с цифровой обратной связью, заключающийся в том, что используют маятниковый акселерометр, в цифровой обратной связи которого устанавливают значения периода дискретизации Т0 работы широтно-импульсного модулятора (ШИМ), маятниковости акселерометра, коэффициента демпфирования, коэффициента передачи регулятора Крег, обеспечивающие минимальную динамическую ошибку акселерометра при действии вибраций с максимальным заданным значением амплитуды линейного ускорения. Отличительная особенность заключается в том, что измеряют напряжение Uyп на входе АЦП цифрового усилителя при отклонении чувствительного элемента до упора, записывают в память контроллера: пороговое напряжение Uпop: Uпop=Uyп/кзап, где кзап - коэффициент запаса; значение коэффициента передачи регулятора Крег mах, при котором при выбранных параметрах обеспечивается устойчивость системы с минимально допустимыми запасами по амплитуде и фазе, цифровой код уровня сигнала на входе ШИМ U* max, при котором длительность импульса τ(nT0), где n - целое число, равна периоду дискретизации Т0, значение коэффициента К* корректировки значения коэффициента передачи регулятора Крег, при эксплуатации акселерометра обеспечивают изменение значения коэффициента передачи регулятора в микроконтроллере от Крег до Крег mах по закону1. A method of ensuring the vibration resistance of a pendulum accelerometer of linear acceleration with digital feedback, which consists in using a pendulum accelerometer, in the digital feedback of which the values of the sampling period T 0 of the pulse width modulator (PWM), the pendulum of the accelerometer, damping coefficient, coefficient are used the transmission of the regulator K reg , providing the minimum dynamic error of the accelerometer under the action of vibrations with a maximum specified value of the linear amplitude acceleration. The distinguishing feature is that the measured voltage U Yn at the ADC input at the digital amplifier element deviates to the stop, is written in the controller's memory of the threshold voltage U thresh: U = U thresh Yn / k app, where zap - a safety factor; the value of the regulator transmission coefficient K reg max , at which, with the chosen parameters, the system is stable with the minimum allowable margins in amplitude and phase, the digital code of the signal level at the PWM input is U * max , at which the pulse duration is τ (nT 0 ), where n is an integer numbers equal to the sampling period T 0, K-value * coefficient correction value K reg transmission controller, during operation of the accelerometer values provide a change in the microcontroller of the controller gain K to K reg er max by law
для чего на каждом шаге дискретизации выполняют измерение и сравнение в микроконтроллере напряжения U(nT0) на входе АЦП усилителя со значением Uпop; при значениях напряжений U(nT0), меньших либо равных Uпop, для организованного внутри микроконтроллера ШИМ формируют в микроконтроллере цифровой входной сигнал U*(nT0), соответствующий текущему значению напряжения U(nT0) при значении коэффициента передачи регулятора Крег; обеспечивают формирование ШИМ последовательности импульсов постоянной амплитуды и длительностью τ(nT0)=[U*(nT0)/U* max]⋅T0; определяют в микроконтроллере тот шаг дискретизации, на котором U(nT0) больше Uпop,обеспечивают на последующих шагах дискретизации формирование в микроконтроллере увеличенного цифрового сигнала U*(nT0)ув для ШИМ, соответствующего значению коэффициента передачи Крег+(|U(nT0)|-Uпop)⋅К*, что обеспечивает увеличение длительности импульсов на выходе ШИМ до величины τ(nT0)ув=[U*(nT0)ув/U* max]⋅T0; обеспечивают соответствующее увеличение длительности открытого состояния, определяемого величиной τ(nT0)ув, переключателя тока усилителя мощности, что обеспечивает поступление с выхода усилителя мощности в обмотку датчика момента акселерометра последовательности импульсов тока стабилизированной амплитуды и увеличенной длительности, определяют тот шаг дискретизации, на котором на входе АЦП напряжение U(nT0) меньше либо равно Uпop, после чего обеспечивают возврат системы обратной связи к режиму работы со значением коэффициента передачи равным Крег.why at each sampling step, they measure and compare in the microcontroller the voltage U (nT 0 ) at the input of the ADC of the amplifier with the value of U pop ; when the voltage values U (nT 0 ) are less than or equal to U pop , for the PWM organized inside the microcontroller, a digital input signal U * (nT 0 ) corresponding to the current voltage U (nT 0 ) at the regulator transmission coefficient K reg is generated in the microcontroller; provide the formation of a PWM sequence of pulses of constant amplitude and duration τ (nT 0 ) = [U * (nT 0 ) / U * max ] ⋅ T 0 ; the sampling step is determined in the microcontroller at which U (nT 0 ) is greater than U pop ; at the subsequent sampling steps, the increased digital signal U * (nT 0 ) uv is generated in the microcontroller for the PWM corresponding to the value of the transmission coefficient K reg + (| U ( nT 0 ) | -U pop ) ⋅К * , which provides an increase in the pulse width at the PWM output to the value τ (nT 0 ) uV = [U * (nT 0 ) uV / U * max ] ⋅T 0 ; provide a corresponding increase in the duration of the open state, determined by the value of τ (nT 0 ) uv , of the current switch of the power amplifier, which ensures that a sequence of stabilized amplitude and increased pulse current pulses from the output of the power amplifier to the winding of the accelerometer moment sensor determines the sampling step at which ADC input voltage U (nT 0) is less than or equal to U thresh then provide feedback system returns to an operating mode with coefficient value before the Chi equal to the reg.
2. Виброустойчивый маятниковый акселерометр с цифровой обратной связью, включающий маятниковый чувствительный элемент, емкостной датчик угла, магнитоэлектрический датчик момента, цифровой усилитель обратной связи, включающий предварительный усилитель, преобразователь напряжение - временной интервал, внешний генератор и усилитель мощности, включающий переключатель тока и стабилизатор тока, при этом датчик угла, цифровой усилитель обратной связи и датчик момента соединены последовательно. Отличительная особенность заключается в том, что преобразователь напряжение - временной интервал выполнен в виде микроконтроллера, в котором реализованы АЦП, центральный вычислитель, умножитель частоты, первый таймер (Т1), формирующий тактовую частоту, широтно-импульсный модулятор, образованный вторым таймером (Т2) и сравнивающим устройством, при этом входом микроконтроллера является первый вход АЦП, второй вход АЦП соединен с источником стабилизированного напряжения, вход умножителя частоты соединен с выходом внешнего генератора, выход умножителя частоты соединен с третьим входом АЦП, вторым входом центрального вычислителя, входом Т1 и первым входом Т2; первый выход центрального вычислителя соединен с четвертым входом АЦП, а выход АЦП соединен с первым входом центрального вычислителя; первый выход Т1 соединен с третьим входом центрального вычислителя и вторым входом Т2; выход Т2 соединен с первым входом сравнивающего устройства, второй выход центрального вычислителя соединен с вторым входом сравнивающего устройства и является выходом микроконтроллера, выдающим в цифровом виде информацию об измеренном линейном ускорении; второй выход Т1 соединен с обмоткой возбуждения датчика угла акселерометра; выход сравнивающего устройства, формирующего импульсы напряжения, соединен с входом усилителя мощности.2. Vibration-resistant pendulum accelerometer with digital feedback, including a pendulum sensing element, a capacitive angle sensor, a magnetoelectric moment sensor, a digital feedback amplifier, including a pre-amplifier, a voltage-time interval converter, an external generator and a power amplifier, including a current switch and a current stabilizer while the angle sensor, the digital feedback amplifier and the torque sensor are connected in series. A distinctive feature is that the voltage-time interval converter is made in the form of a microcontroller that implements an ADC, a central computer, a frequency multiplier, a first timer (T1) that generates a clock frequency, a pulse-width modulator formed by a second timer (T2), and a comparator, the input of the microcontroller is the first input of the ADC, the second input of the ADC is connected to a stabilized voltage source, the input of the frequency multiplier is connected to the output of an external generator, q the frequency multiplier is connected to the third input of the ADC, the second input of the central computer, the input T1 and the first input T2; the first output of the central computer is connected to the fourth input of the ADC, and the output of the ADC is connected to the first input of the central computer; the first output T1 is connected to the third input of the central computer and the second input T2; the output T2 is connected to the first input of the comparing device, the second output of the central calculator is connected to the second input of the comparing device and is the output of the microcontroller, which digitally gives information about the measured linear acceleration; the second output T1 is connected to the excitation winding of the accelerometer angle sensor; the output of the comparing device generating the voltage pulses is connected to the input of the power amplifier.
Литература:Literature:
1. Коновалов С.Ф. Теория виброустойчивости акселерометров. - М.: Машиностроение, 1991 г.1. Konovalov S.F. Theory of vibration resistance of accelerometers. - M.: Engineering, 1991
2. С.М. Федоров, А.П. Литвинов. Автоматические системы с цифровыми управляющими машинами. – М., Л.: Энергия, 1965.2. S.M. Fedorov, A.P. Litvinov. Automatic systems with digital control machines. - M., L .: Energy, 1965.
3. Бессекерский В.А, Попов Е.П. Теория систем автоматического регулирования. – М.: Наука, 1966.3. Bessekersky V.A., Popov E.P. Theory of automatic control systems. - M .: Nauka, 1966.
Claims (4)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2015116808A RU2615221C2 (en) | 2015-04-30 | 2015-04-30 | Method for providing vibration resistance of pendulum accelerometer of linear accelerations with digital feedback and vibration pendulum accelerometer |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2015116808A RU2615221C2 (en) | 2015-04-30 | 2015-04-30 | Method for providing vibration resistance of pendulum accelerometer of linear accelerations with digital feedback and vibration pendulum accelerometer |
Publications (2)
Publication Number | Publication Date |
---|---|
RU2015116808A RU2015116808A (en) | 2016-11-20 |
RU2615221C2 true RU2615221C2 (en) | 2017-04-04 |
Family
ID=57759613
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
RU2015116808A RU2615221C2 (en) | 2015-04-30 | 2015-04-30 | Method for providing vibration resistance of pendulum accelerometer of linear accelerations with digital feedback and vibration pendulum accelerometer |
Country Status (1)
Country | Link |
---|---|
RU (1) | RU2615221C2 (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU528510A1 (en) * | 1974-11-06 | 1976-09-15 | Московское Высшее Техническое Училище Им.Н.Э.Баумана | Accelerometer vibration test method |
SU1839937A1 (en) * | 1967-06-15 | 2006-06-10 | Государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А. Пилюгина" (ГУП "НПЦ АП") | Method for increasing vibration durability of accelerometer |
RU2341805C1 (en) * | 2007-07-03 | 2008-12-20 | Федеральное государственное унитарное предприятие "Научно-исследовательский институт физических измерений" | Compensating accelerometer |
US20090281756A1 (en) * | 2008-05-08 | 2009-11-12 | L-3 Communications Corporation | Accelerometer and Method for Error Compensation |
-
2015
- 2015-04-30 RU RU2015116808A patent/RU2615221C2/en active IP Right Revival
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU1839937A1 (en) * | 1967-06-15 | 2006-06-10 | Государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А. Пилюгина" (ГУП "НПЦ АП") | Method for increasing vibration durability of accelerometer |
SU528510A1 (en) * | 1974-11-06 | 1976-09-15 | Московское Высшее Техническое Училище Им.Н.Э.Баумана | Accelerometer vibration test method |
RU2341805C1 (en) * | 2007-07-03 | 2008-12-20 | Федеральное государственное унитарное предприятие "Научно-исследовательский институт физических измерений" | Compensating accelerometer |
US20090281756A1 (en) * | 2008-05-08 | 2009-11-12 | L-3 Communications Corporation | Accelerometer and Method for Error Compensation |
Also Published As
Publication number | Publication date |
---|---|
RU2015116808A (en) | 2016-11-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110134010B (en) | Power attraction repetitive control method adopting equivalent disturbance compensation servo system | |
RU2501063C2 (en) | Residue analysis apparatus and method for detecting system errors in aircraft system behaviour | |
CN107544245B (en) | Discrete repetitive control method for motor servo system using first-order inertial attraction law with disturbance expansion compensation | |
CN104635492A (en) | Parametric adaptive feed-forward control method of guide head stabilizing platform | |
CN107544244A (en) | Discrete repetitive control method for motor servo system based on elliptic attraction law and equivalent disturbance expansion state compensation | |
CN105549381A (en) | Discrete repetition control method based on attraction law | |
CN110955974A (en) | Rocket recovery simulation platform and implementation method | |
CN110716430B (en) | A fast attracting repetitive control method of servo system using equivalent disturbance compensation | |
KR20110115466A (en) | Design method of vertical follower flight controller of vertical plane | |
US8878699B2 (en) | Method for providing a pilot warning signal for a pilot of an aircraft, computer program product and warning device | |
JP5769368B2 (en) | System and method for reducing vibration rectification error in a closed loop accelerometer system | |
CN110032073A (en) | 1/2 power with equivalent disturbance compensation attracts repetitive control | |
CN104467612A (en) | Voice coil motor control method and lens focusing system | |
RU2615221C2 (en) | Method for providing vibration resistance of pendulum accelerometer of linear accelerations with digital feedback and vibration pendulum accelerometer | |
CN103605288A (en) | One-fourth period repetitive controller based on attractive rule | |
JP2016080538A (en) | Vibration testing device, vibration testing method | |
Diaz et al. | Concurrent design of multimode input shapers and link dynamics for flexible manipulators | |
EP4339621A1 (en) | Mems accelerometer systems | |
CN103812368A (en) | Quarter period repeated controller for converter | |
Tkany et al. | Flatness-Based Feedforward Control of a Stacker Crane with Online Trajectory Generation | |
RU2658125C1 (en) | Method for determining parameters of natural tones of structure vibrations in resonant tests | |
Ziemkiewicz | Entropy of timekeeping in a mechanical clock | |
Tomczyk et al. | Impact of the reference model on the values of maximum dynamic error | |
US12013242B2 (en) | Method for reading data from inertial sensors | |
RU2398287C1 (en) | Demonstration gyroscopic integrator |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
MM4A | The patent is invalid due to non-payment of fees |
Effective date: 20200501 |
|
NF4A | Reinstatement of patent |
Effective date: 20210521 |
|
PC43 | Official registration of the transfer of the exclusive right without contract for inventions |
Effective date: 20220325 |