Цифровой фильтр — SU 1739483 (original) (raw)
(51)5 Н 03 Н 21 ГОСУДАРСТВЕННЫЙ КОМИТЕТПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИЯМПРИ ГКНТ СССР ОПИСАНИЕ ИЗО ЕНИ К АВ 916/09 4.906.92. Бюл. М 21Бурый, И,П. Блинов376.56(088.8)рское свидетельство32, кл, Н 03 Н 21/00рское свидетельств65, кл. Н 03 Н 21/00(57) Изобретение относится к вычислителной технике и может быть использовано дл(56) АвтМ 10564АвтМ 13852 КОМУ СВИДЕТЕЛЬСТВУ фильтрации результатов измерении физического параметра в условиях нарушений в каналах связи, Сущность изобретения: цифровой фильтр содержит три вычитателя 1, 36, 17, умножители 2-12, 37; 39 - 41, три элемента 13 - 15 задержки, семь сумматоров 16 - 18, 32 - 35 триггер 19, элемент И 20, блок элементов И 21, счетчик 22, блок 23 памяти, квадратор 24, пять делителей 25, 27-29, 44 два инвертора 26, 43, два экспоненциальных преобразователя 30, 31, блок 38 извлечения квадратного корня, 21 - 1-4 - 16 - 13 - 3 - 2-1, 1- 24-25-26-27-30-39-7-35-9-10-43-17-141739483 12-18-32-28-38-40-41-34-44-7, 1-5-17- 11 - 8 - 4, 26 - 29 - 31 - 31 - 41, 5 - 7-4. 7 - 36 - 6 - 5, 7-6, 20-21, 20-15-23-37-33-29, 23 Изобретение относится к вычислитель. ной технике и может быть использовано для фильтрации результатов измерений физического параметра в условиях нарушений в каналах связи,Известен фильтр Калмана, содержащий вычитатель, усилитель, интегратор, первый, второй матричные умножители, два сумматора, генератор стационарногс случайного процесса.Однако данное устройство не позволяет оценивать состояния объектов, описываемых динамической моделью, а также не учитывает возможные нарушения в канале связи, приводящие к потере устойчивости фильтрации.Наиболее близким к предлагаемому по технической сущности является фильтр Калмана, содержащий вычитатель, первый вход которого является входом фильтра, последовательно соединенные первый умножитель, первый сумматор и интегратор, выход которого является выходом устройства, второй умножитель, выход которого соединен с инверсным входом первого сумматора, третий умножитель, выход которого соединен с выходом интегратора, второй сумматор, делитель, квадратор, первый, второй синусные преобразователи, косинусный преобразователь, дополнительный интегратор, четвертый - восьмой умножители, блок памяти, первый выход которого соединен с первыми входами четвертого и шестого умножителей, второй выход блока памяти соединен с первым входом второго сумматора, а третий выход блока памяти подключен к второму входу третьего умножителя и первому входу пятого умножителя, причем входы первого синусного и косинусного преобразователей подключены к выходу первого интегратора, выход первого синус- ного преобразователя соединен с вторым входом первого сумматора, а с первым входом второго умножителя - через делитель, выход косинусного преобразователя соединен с вторым входом пятого умножителя и первым входом седьмого умножителя, выход которого соединен с вторым входом второго сумматора, а выход пятого умножителя соединен с вторым входом четвертого умно- жителя и первым входом восьмого умножителя, выход которого через квадратор 11, 23-32-27, 23-2, 23-10, 23-3-16, 23-1833 - 28,23 - 12,23 - 39 - 34,23 - 42 - 40,23-37,23 - 8 -5, 8 - 6, 18-9, 8 - 9, 22 - 23, 20 - 22 - 19 - 20. 3 ил,подключен к второму входу шестого умножителя, выход которого соединен с инверсным входом второго сумматора, выходкоторого соединен через дополнительный5 интегратор с вторыми входами второго,седьмого и восьмого умножителей и третьим входом четвертого умножителя, выходкоторого подключен к первому входу первого умножителя, второй вход которого соеди 10 нен с выходом вычитателя, второй входкоторого соединен через второй синусныйпреобразователь с выходом третьего умножителя.Данное устройство не позволяет оцени 15 вать наблюдаемые данные в условиях возможных нарушений в канале связи(передачи данных), приводящих к значительному увеличению шумовой составляющей наблюдаемого вектора.20 Цель изобретения - повышение точности фильтрации в условиях действия помехпри априорно известных вероятностях появления аномальных измерений,Указанная цель достигается тем, что в25 цифровой фильтр, содержащий последовательно соединенный первый вычитатель,первый умножитель и первый сумматор,блок памяти, первый выход которого подключен к первому входу второго сумматора,30 второй выход - к первым входам второго итретьего умножителей, а третий выход - кпервым входам четвертого и пятого умножителей, первый делитель, выход которогоподключен к первому входу шестого умно 35 жителя, а также седьмой и восьмой умножители и квадратор при этом выход второгоумножителя соединен с первым входом первого вычитателя, второй и третий вычитатели, третий - седьмой сумматоры, девятый -40 пятнадцатый умножители, второй - пятыйделители, первый и второй экспоненциальные преобразователи, первый и второй инверторы, блок извлечения квадратногокорня, первый, второй и третий элементы45 задержки, триггер, счетчик, блок элементовИ и элемент И, причем квадратор, второйделитель, первый инвертор, третий делитель, первый экспоненциальный преобразователь и одиннадцатый умножитель50 включены последовательно между выходомпервого вычитателя и вторым входом шестого умножителя, пятый делитель, блок извлеумножителя, адресные входы блока памяти 5подключены к соответствующим выходам счетчика, вход считы вания - к выходу третьего элемента задержки, вход которого объединен со счетным входом счетчика и входом разрешения блока элементов И и подключения квадратного корня, девятый и десятый умножители и третий сумматор включены последовательно между выходом второго сумматора и входом первого делителя, пятнадцатый умножитель, пятый сумматор, четвертый делитель и второй экспоненциальный преобразователь включены последовательно между первым выходом блока памяти и вторым входом десятого умножителя, выход второго сумматора соединен с вторым входом третьего делителя, выход пятого сумматора подключен к второму входу пятого делителя, выход одиннадцатого умножителя подключен к второму входу третьего сумматора, выход третьего вычитателя подключен к второму входу девятого умножителя, выход шестого умножителя соединен с первым входом седьмого умножителя и третьим входом первого умножителя, через четвертый сумматор - с первым входом восьмого умножителя и через второй вычитатель с третьим входом седьмого умножителя, выход которого подключен к первому входу двенадцатого умно- жителя, второй вход которого объединен с вторыми входами первого, седьмого и восьмого умножителей и подключен к выходу четырнадцатого умножителя, а третий и четвертый входы объединены и подключены к выходу первого вычитателя, при этом второй выход блока памяти подключен к первому входу тринадцатого умножителя, второй вход которого соединен с выходом восьмого умножителя, а выход - через второй инвертор с первым входом седьмого сумматора, четвертый выход блока памяти подключен к первому входу шестого сумматора, второй вход которого соединен с выходом пятого умножителя, а выход - с вторыми входами второго и пятого сумматоров и третьим входом восьмого умножителя, пятый выход блока памяти подключен к второму входу одиннадцатого умножителя и входу третьего вычитателя. шестой выход блока памяти подключен к второму входу пятнадцатого умножителя, седьмой выход блока памяти подключен к первому входу четырнадцатого умножителя, второй вход которого соединен с.выходом третьего умножителя, второй вход которого объединен через второй элемент задержки с вторым входом пятого умножителя и подключен к выходу седьмого сумматора, второй вход которого соединен с выходом двенадцатого 5 10 15 20 25 30 35 40 45 50 чен к выходу элемента И, первый вход которого подключен к шине тактовых импульсов, а второй вход - к выходу триггера, нулевой вход триггера подключен к выходу старших разрядов счетчика, единичный вход обьединен с установочным входом счетчика и подключен к шине импульсов запуска, второй вход блока элементов И является информационным входом цифрового фильтра, выход подключен к второму входу первого вычитателя, выход первого сумматора соединен через последовательно включенные первый элемент задержки и четвертый умножитель с вторым входом второго умножителя и является информационным выходом цифрового фильтра.На фиг, 1 представлена функциональная схема устойчивого фильтра; на фиг, 2 - функциональная схема экспоненциального преобразователя; на фиг. 3 - функциональная схема блока извлечения корня квадратного.Устойчивый фильтр содержит первый вычитатель 1, второй умножитель 2, четвертый 3, первый 4, двенадцатый 5, седьмой 6, шестой 7, четырнадцатый 8, восьмой 9, тринадцатый 10, третий 11 и пятый 12 умножители, третий 13, второй 14 и первый 15 элементы задержки, первый 16, седьмой 17 и шестой 18 сумматоры, триггер 19, элемент И 20, блок 21 элементов И, счетчик 22, блок 23 памяти, квадратор 24, второй делитель 25, первый инвертор 26, третий 27, пятый 28 и четвертый 29 делители, первый 30 и второй 31 экспоненциальные преобразователи, второй 32, пятый 34 и четвертый 35 сумматоры, второй вычитатель 36, пятнадцатый умножитель 37, блок 38 извлечения квадратного корня, одиннадцатый 39, девятый 40 и десятый 41 умножители, третий вычитатель 42, второй инвертор 43 и первый делитель 44,Экспоненциальный преобразователь содержит блоки 45 возведения в степень группы, весовые блоки 46 группы, сумматор 47 и регистр 48 числа. Входы блоков 45 являются входом преобразователя 30 (31), а выход сумматора 47 - его выходом. Преобразование осуществляется согласно выраф их схжения е =1+- , величина поступает нап=Р1входы блоков 45, число которых выбирается из требуемой точности. В регистре 48 хранится заранее записанная в него единица, которая также используется для функционирования сумматора 35, вычитателя 36 и делителя 25 (эта взаимосвязь на фиг, 1 непоказана).25 30 35 В блоке извлечения квадратного корня установка в "0" перед началом работы производится по дополнительному входу, а в каждом такте работы - через элемент ИЛИ 49 и элемент 50 задержки (фиг, 3), необходимый для обеспечения времени передачи информации с блока 38 на последующие элементы устройства,Умножители могут быть выполнены в соответствии с известным, причем трех- и более входовые умножители представляют собой последовательное соединение двух и более умножителей, когда результат умножения двух сомножителей умножается на третье, а потом на 4-е число. Блок 23 памяти представляет собой объединение семи ОЗУ, каждое из которых выполнено на микросхеме К 155 РУ 2, в которых хранится массив соответствующих параметров, объем которого соответствует объему оцениваемогомассива измерительной информации,Единичный вход триггера 19, являющийся входом запуска фильтра. соединен с устойчивым входом счетчика 22, выход старшего разряда которого подключен к нулевому входу триггера 19, прямои выход которого соединен с разрешающим входом элемента И 20, первый вход которого подключен к шине тактовых импульсов устройства, а выход соединен через элемент 15 задержки с входом считывания а через счетный вход, оставшиеся выходы счетчика 22, - с адресными входами блока 23, первый выход которого подключен к первому входу умножителя 37 и первому входу сумматору 32, второй выход - к соответствующим входам умножителей 2, 11 и 10, третий выход - к первым входам умножителей 3 и 12, четвертый выход - к первому входу сумматора 18, пятый выход к второму входу умножителя 39 и входу вычитателя 42, шестой выход - к первому входу умножителя 37, седьмой выход через умножитель 8 - к второму входу умножителя 4, вторым входам умножителей 6 и 9 и умножителя 5, третий и четвертый входы которого соединены с выходом вычитателя 1, первым входом умножителя 4, входом квадратора 24, первый вход-с выходом умножителя 6, а выход через сумматор 17, умножитель 11 - с вторым входом умножителя 8. Выход сумматора 17 через элемент 14 задержки, умножитель 12, сумматор 18 подключен к второму входу сумматора 33, второму входу сумматора 32, третьему входу умножителя 9, выход которого через умно- житель 10, инвертор 43 соединен с первым входом сумматора 17. Разрешающий вход блока 21 элементов И подключен к выходу элемента И 20, а информаторный вход явля 5 10 15 20 40 45 50 55В формализованном виде алгоритм фильтрации может быть представлен следующими уравнениями состояния и наблюдения: х(1+1)= Фк +1,хВ) + /, (1)(2) д=Нха и где х - и-мернь й вектс р состояния системы;Ф- переходная (пхп) матрица,Ч - вектор гауссовских шумов возмущений с нулевым средним;9 - а-мерный вектор наблюдений;Н - матрица наблюдений системы;ю- гауссовы шумы измерений;а- случайная величина,причем а =1 с вероятностью Р 1 соответствует нормальной работе канала измерений и а = Ь (Л 1) с вероятностью 1 Р приотказах, связанных с пропаданием полезного сигнала,Оценка вектора состояния системы хопределяется нормальной хн и аномальнойсоставляющими х; ется информационным входом фильтра, Выход блока 21 подключен к второму входу вычитателя 1, первый вход которого соединен с выходом умножителя 2, второй вход которого подключен к выходу умножителя 3 и второму входу сумматора 16, первый вход которого соединен соответственно с выходом умножителя 4, а выход - с входом элемента 13 задержки, выход которого подключен к второму входу умножителя 3, Выход сумматора 16 является информационным выходом фильтра, Выход квадратора 24 через делитель 25, инвертор 26 соединен с входами делителей 27 и 29, выходы которых подключены соответственно к входам преобразователей 30 и 31. Выход умножителя 37 через сумматор 33 соединен с вторым входом делителя 29 и вторым входом делителя 28, первый вход которого подключен к выходу сумматора 32, второму входу делителя 27, а выход через блок 38, умножители 40 и 41, сумматор 34, делитель 44 и умножитель 7 - к третьему входу умножителя 4, первому входу умножителя 6, "ретий вход которого соединен с выходом вычитателя 36, вход которого подключен к выходу умножителя 7, а через сумматор - к первому входу умножителя 9. Выход преобразователя 30 соединен с вторым входом умножителя 7 и вторым входом сумматора 34, Выход преобразователя 31 подклю ен к в 1 орому входу умножителя 41.х(К)=хн(К) Рн(К)+х (К)1-Рн(1 с), (3) но с учетом общего выражения для оценки (4) и того, что при Л 1 коэффициент усиления фильтра стремится к О, имеем 5х(1)=х(1(,1(-1)+Рн(1)Кн(1) Е (1 О(-1), (4) где Е(К К)=д(К)-Нх(КК) - характеризует обновляющий процесс в фильтре; Кн(К)= =9 Нк й- коэффициент усиления филь тра при нормальном функционировании, 9 -. ковариационная матрица погрешностей фильтрации определяется по формуле 9 = 8), к - ) 1-РнКн(1 Н) 9, ) - 1++ Чи, (6) где Ч- - ковариационная матрица шумов возмущений,Вероятность нормального функционирования канала измерений оценим как апостериорную вероятность- ) 35 й)д(1 с)-х(К, К) / Й) стериорная вероятнос ационная матрица шум 1) - (7) фил , В блоке боты з )/, котор первой выходов ходов -ыражении им образом чалом р ицй, Н,Ф ственно с ртой группедьмого вР, коэфф ициента и матпускавходетчик иггера еменьсы с Импульс з ющий вход ус "1" триггера 1 22. Напряжен 19 действует н та И 20, посл впуска поступает на за тройства. чем является 9, устанавливает в "0" сч ие с прямого выхода тр а разрешающий вход эл е чего тактг)вые импул Р, (К) - апго, что а)=1,Мк - коваизмерений.С учетом втает следующти г еред назначения матрются соответтретьей, четвего, шестого, свероятностейрицы М 4 ьтр рабо памяаписаны ые снимаВто рой, 5 , а с пято- величиныНа вход д д(К)-х ( ля 29 - образо форми первыи вход делителя елителя 27, поступает К, М)2/2, а на второй сигнал с выхода суммато м, на выходе преобра руется сигнал вида 9, каки на игнал видо ход делитера 33. Таким ователя 31(1)-х(, К) / ыходе преоб поступающий 39. хр(-д азователя 30 сигнал на первый вход умно ехр( жит входа тактовых импульсов устройства через элемент И 20 проходят на счетный вход счетчика 20 и на разрешающий вход блока 21 элементов И, обеспечивая поступление входного сигнала д(к) в параллельном двоичном коде на первый вход вычитателя 1. При подсчете 1 импульсов сигналом с выхода старшего разряда счетчика 22 сбрасывается в "0" триггер 19, С помощью других выходов счетчика 22 обеспечивается адресный выбор соответствующих данных с блока 23 на каждый 1-й момент (1=1, 1) времени. Считывание данных с блока 23 производится по импульсу с выхода элемента 15 задержки, в котором происходит задержка тактового импульса на время, необходимое для срабатывания счетчика 22, На первый вход вычитателя 1 поступает сигнал, пропорциональный выражению Нкх(К М) с выхода умножителя 2, на который поступают сигнал из блока 23 памяти и сигнал х(К М) с выхода умножителя 3. На выходе вычитателя 1 формируется сигнал Е(К, К), который поступает на первый вход умножителя 4 и на третий и четвертый входы умножителя 5, причем третий вход умножителя 5 так закоммутирован с выходом вычитателя 1, чтобы его выходной Е был представлен в транспонированном виде, С выхода вычитателя 1 сигнал преобразуется в квадраторе 24, На третий вход умножителя 4 поступает сигнал Рн(к) с выхода умножителя 7, а на второй - сигнал соответствующий Кн(К) с выхода умножителя 8. Таким образом, на выходе сумматора 16 получаем сигнал вида (4), На выходе квадратора 24 формируется сигнал д(к)-х(к, И), который делится на два делителем 25, инвертируется инвертором 26. На выходе сумматора 32 формируется сигнал вида О) к - ) + К), который поступает в делитель 27, где вырабатывается сигнал, пропорциональный параметру А, На выходе сумматора ЗЗ формируется сигнал вида 81,к - ) +Л М), причем параметр Л по 2 2 ступает на соответствующий вход умножителя 37 с шестого выхода блока 23.Величина Рс пятого выхода блска 23 поступает на второй вход умножителя 39, на выходе которого вырабатывается сигнал, пропорциональный Р ехр(А), который действует на второй вход умножителя 7, На выходе вычитателя 42 формируется сигнал, пропорциональный величине (1-Р Я, который действует на второй вход умножителя 40, на первый вхац которого поступает сигнал (И, к - 1+к) /(В, к - 1+А Мц с выхода блока 38, После преобразований в умнакителе 41 и сумматоре 34 сигнал действует на делитель 44, в котором формируется сигнал, пропорциональный отношению единицы к выражению в квадратных скобках уравнения (7). На выходе умножлтеля 7 вырабатывается сигнал, соатветствуюгций выражению (7),Сигнал Рн с выхода умножителя 7 поступает на первые входы сумматора Зб и вычитателя Зб, на выходе первого из которых формируется сигнал 1+Рнф), а на выходе второго - сигнал 1-Рн, который поступает на третий вход умнокителя б, в котором умножается на К(8 и Р,ф). С выхода умножителя б сигнал действует на первый вход умножителя 5, на второй вход каторага поступает напряжение с выхода умножителя 8, который подключен к выхадуумнокителя 11, На выходе умнажителя 5 формируется сигнал вида Рн(1)(1- -РнЯКн(К)Л 1 Кн, На выходе умножителя 10 после умножения в умнажителе 9 вырабатывается сигнал, пропорциональный1+Рн(кЯКн 9 с, к - 1После инвертирования в инвертаре 43 и суммирования в сумматоре 17 формируется сигнал вида (5), который после преобразования в умножителях 11 и 8 представляет соаай значение КЯ), а после задержки на такт в элементе 14 задержки, умножения на 1 к - 1 в умножителе 12 и суммирования в сумматоре 18 с величиной Чвырабатывается сигнал вида (б),Таким образом, предлагаемый фильтр по сравнению с известными обеспечивает повышение очности фильтрации путем устойчивого оценивания сигналов в условиях жесткой помеховой обстановки. Зкспериментальные исследования подтверждают сходимость предлагаемого фильтра,Формула изобретения ЦиФровой фильтр, содержащий последовательна соединенные первый вычитатель, первый умножитель и г,ервый сумматор. блок памяти, первый выход которого подключен к первому входу второго сумматора, второй выход - к первым входам 5 10 15 20 25 30 40 50 55 вгорого и третьего умнокителей, а третий выход - к первым входам четвертого и пятого умножителей, первыл делитель, вь ход которого подключен к первому входу шестого умножителя, а также седьмой и восьмой умножители и квадратор, при э гам выход второго умнажителя соединен с первым входом первого вычитателя, о т л и ч а ю щ и й с я тем, что, с целью повышения избирательности в условиях действия помех при априорна известных вероятностях появления аномальных измерений, в него введены второй и третий вычитатели, третий, четвертый, пятый, шестой и седьмол сумматоры, девятый, десятый, одиннадцатый, двенадцатый, тринадцатый, четырнадцатый и пятнадцатый умножители, второй, третий, четвертый и пятый делители, первый и второй экспоненциальные преобразователи, первый и второй инверторы, блок извлечения квадратного корня, первый, второй и третий элементы задержки, триггер, счетчик, блок элементов И и элемент И, причем квадратор, второй делиель, инвертор, третий делитель, первый экспаненциальный преобразователь и одиннадцатый умножитель включены последовательно между выходам первого вычитателя и вторым входом шестого умножителя, пятый делитель, блок извлечения квадратного корня, девятый умнажитель и третий сумматор включены последовательно между выходом второго сумматора и входом первого делителя, пятнадцатый умножитель, пятый сумматор, четвертый делитель и второй экспоненцлальный преобразователь включены последовательна между первым выходом блока памяти и вторым входом десятого умножителя, выход второго сумматора соединен с вторым входом третьего делителя, выход пятого сумматора подключен к второму входу пятого делителя, выход одиннадцатого умнажителя подключен к второму входу третьего сумматора, выход третьего вычитателя подключен к второму входу девятога,умножителя, выход шестого умножителя соединен с первым входом седьмого умнажителя и третьим входом первого умножителя, через чегаертый сумматор - с первым входом восьмого умножителя, через второй вычитатель - с третьим входом седьмого умножителя, выход которого подключен к первому входу двенадцатого умножителя, второй вход которого обьединен с вторыми входами первого, седьмого и восьмого умножителей и подключен к выходу четырнадцатого умножителя, а третий и четвертый входы обьединены и подключены к выходу первого вычитателя, прл этом второй выход блока памяти подключен к перво14 1739483 13 Составитель А.БурыиРедактор Н.Лазаренко Техред М.Моргентал Коррек Ци Заказ 2009 Тираж ПодписноеВНИИПИ Государственного комитета по изобретениям и открытиям113035, Москва, Ж, Раушская наб 4/5 КНТ СС оизводственно-издательский комбинат "Патент", г. Ужгород, ул,Гагарина, 10 му входу тринадцатого умножителя, второй вход которого соединен с выходом восьмого умножителя, а выход через второй инвертор - с первым входом седьмого сумматора, четвертый выход блока памяти подключен к первому входу шестого сумматора, второй вход которого соединен с выходом пятого умножителя, а выход - с вторыми входами второго и пятого сумматоров и с третьим входом восьмого умножителя, пятый выход блока памяти подключен к второму входу одиннадцатого умножителя и входу третьего вычитателя, шестой выход блока памяти подключен к второму входу пятнадцатого умножителя, седьмой выход блока памяти подключен к первому входу четырнадцатого умножителя, второй вход которого соединен с выходом третьего умножителя, второй вход которого объединен через второй элемент задержки с вторым входом пятого умножителя и подключен к выходу седьмого сумматора, второй вход которого соединен с выходом двенадцатого умножителя, адресные входы блока памяти подключены к соответствующим выходам счетчика, вход считывания - к выходу третьего элемента 5 задержки, вход которого объединен со счетным входом счетчика и входом разрешения блока элементов И и подключен к выходу элемента И, первый вход которого подключен к шине тактовых импульсов, а второй вход - к 10 выходу триггера, нулевой вход триггера подключен к выходу старших разрядов счетчика, единичный вход объединен с установочным входом счетчика и подключен к шине импульсов запуска, второй вход блока элементов И 15 является информационным входом цифрового фильтра, выход подключен к второму входу первого вычитателя, выход первого сумматора соединен через последовательно включенные первый элемент задержки и четвертый 20 умножитель со вторым входом второго умножителя и является информационным выходом цифрового фильтра,