Программная реализация БИХ-фильтра в информационно-измерительном канале

//ИИК абсолютного атмосферного давления (температуры)
//цель - исследование БИХ-фильтров
//https://github.com/orgua/iLib/blob/master/src/i2c.h
#include "i2c.h"
//https://github.com/orgua/iLib/blob/master/src/i2c_BMP280.h
#include "i2c_BMP280.h"
//https://github.com/arduino-libraries/LiquidCrystal
#include <LiquidCrystal.h>
//https://github.com/orgua/iLib/tree/master/examples/i2c_BMP280
BMP280 bmp280;

const int rs = 12, en = 11, d4 = 6, d5 = 5, d6 = 4, d7 = 3;
//const int rs = PB4, en = PB3, d4 = PD6, d5 = PD5, d6 = PD4, d7 = PD3;
LiquidCrystal lcd(rs, en, d4, d5, d6, d7);

float pascal_f = 100500;
float filter_K = 1;
const int analogInPin = A0; //аналоговый вход от потенциометра
int sensorValue = 0;        //сигнал от потенциометра
int outputValue = 0;

void setup()
{
    Serial.begin(9600);
    //Serial.print("Probe BMP280: ");
    if (bmp280.initialize()) {
      //Serial.println("Sensor found");
      ;
    }
    else
    {
        Serial.println("Sensor missing");
        while (1) {}
    }
    bmp280.setEnabled(0);
    bmp280.triggerMeasurement();
    bmp280.setFilterRatio(0);
    lcd.begin(16, 2);
    lcd.setCursor(0, 0);
    lcd.print("measure");
    lcd.setCursor(7, 1);
    lcd.print("Pa");
    lcd.setCursor(10, 0);
    lcd.print("filter");
}

void loop()
{
    float temperature;
    float pascal, hpascal;

    sensorValue = analogRead(analogInPin);
    outputValue = map(sensorValue, 0, 1023, 1, 50);
    filter_K = outputValue;
    bmp280.awaitMeasurement();
    bmp280.getTemperature(temperature);
    temperature -= 1.7; //поправка
    bmp280.getPressure(pascal);
    pascal -= 50;//поправка
    hpascal = pascal/100.;
    bmp280.triggerMeasurement();
    pascal_f = (pascal_f * (filter_K - 1) + pascal) / filter_K; //(6)
    Serial.println(pascal_f,0);
    if(pascal_f < 100000)
      lcd.setCursor(6, 1);
      lcd.print(" ");
    lcd.setCursor(0, 1);
    lcd.print(pascal_f,0);
    if(filter_K < 10)
      lcd.setCursor(13, 1);
      lcd.print(" ");
    lcd.setCursor(10, 1); 
    lcd.print(filter_K,1);
    delay(300);
}

import numpy as np
import matplotlib.pyplot as plt
import serial
from drawnow import drawnow
import datetime, time

k = 6.0 #коэффициент фильтрации + 1
filter_K = 1 + k

#вывод выборки в графическое окно
def cur_graf():
    plt.title("BMP280")
    plt.ylim( 100450, 100510 )
    plt.plot(nw, lw1,  "r.-", label='измеренное')
    plt.plot(nw, lw1f, "b.-", label='фильтрованное')
    plt.legend(loc='best')
    plt.ylabel(r'$давление, Па$')
    plt.xlabel(r'$номер  измерения$')
    plt.grid(True)
#вывод всех списков в графическое окно
def all_graf():
    plt.close()
    fig=plt.figure()
    ax = fig.add_subplot(111)
    fig.subplots_adjust(top=0.85)
    ax.set_title("датчик BMP280n" +
                  str(count_v) + "-й эксперимент " +
                  "(" + now.strftime("%d-%m-%Y %H:%M") + ")")
    ax.set_ylabel(r'$давление, Па$')
    ax.set_xlabel(r'$номер  измерения$' +
                   '; (период опроса датчика: {:.6f}, c)'.format(Ts))
    ax.text(0.95, 0.03,
        "Коэффициент фильтра: " + str(filter_K) + "n",
        verticalalignment='bottom', horizontalalignment='right',
        transform=ax.transAxes,
        color='black', fontsize=14)
    plt.plot( n, l1,  "r-", label='измеренное')
    plt.plot( n, l1f, "b-", label='фильтрованное')
    plt.legend(loc='best')
    plt.grid(True)
    plt.show()
#определяем количество измерений
# общее количество измерений
str_m   = input("введите количество измерений: ") 
m = eval(str_m)
# количество элементов выборки
mw  = 16
#настроить параметры последовательного порта
ser = serial.Serial()
ser.baudrate = 9600
port_num = input("введите номер последовательного порта: ")
ser.port = 'COM' + port_num
ser
#открыть последовательный порт
try:
    ser.open()
    ser.is_open
    print("соединились с: " + ser.portstr)
except serial.SerialException:
    print("нет соединения с портом: " + ser.portstr)
    raise SystemExit(1)
#определяем списки
l1  = [] # для значений давления
l1f = [] # для фильтрованных значений давления
t1  = [] # для значений моментов времени
lw1 = [] # для значений выборки давления
lw1f= [] # для фильтрованных значений выборки давления
n   = [] # для значений моментов выборки
nw  = [] # для значений выборки моментов времени
#подготовить файлы на диске для записи
filename = 'count.txt'
in_file = open(filename,"r")
count = in_file.read()
count_v = eval(count) + 1
in_file.close()
in_file = open(filename,"w")
count = str(count_v)
in_file.write(count)
in_file.close()
filename = count + '_' + filename
out_file = open(filename,"w")
#вывод информации для оператора на консоль
print("nпараметры:n")
print("n - номер измерения;")
print("P - давление, Па;")
print("nизмеряемые значения величины давленияn")
print('{0}{1}n'.format('n'.rjust(4),'P'.rjust(10)))
#считывание данных из последовательного порта
#накопление списков
#формирование текущей выборки
#вывод значений текущей выборки в графическое окно
i = 0
while i < m:
    n.append(i) 
    nw.append(n[i])
    if i >= mw:
        nw.pop(0)
    line1 = ser.readline().decode('utf-8')[:-2]
    t1.append(time.time())
    if line1:
        l1.append(eval(line1))
        lw1.append(l1[i])
        if i :
            l1f.append( (l1f[i-1]*(filter_K - 1) + l1[i])/filter_K ) #(6)
            lw1f.append(l1f[i])
        else :
            l1f.append(l1[i])
            lw1f.append(l1f[i])
        if i >= mw:
            lw1.pop(0)
            lw1f.pop(0)
    print('{0:4d} {1:10.2f} {2:10.2f}'.format(n[i],l1[i],l1f[i]) )
    drawnow(cur_graf)
    i += 1
#закрыть последовательный порт
ser.close()
ser.is_open
time_tm = t1[m - 1] - t1[0]
print("nпродолжительность времени измерений: {0:.3f}, c".format(time_tm))
Ts = time_tm / (m - 1)
print("nпериод опроса датчика: {0:.6f}, c".format(Ts))
#запись таблицы в файл
print("nтаблица находится в файле {}n".format(filename))
for i in np.arange(0,len(n),1):
    count = str(n[i]) + "t" + str(l1[i]) + "n"
    out_file.write(count)
#закрыть файл с таблицей
out_file.close()
out_file.closed
#получить дату и время
now = datetime.datetime.now()
#вывести график в графическое окно
all_graf()
end = input("nнажмите Ctrl-C, чтобы выйти ")