Прибор не показывает значение

Это мой первый вопрос на форме, так что извините за какие-либо неточности.
Собираю высотомер на плате Arduino nano. Столкнулся с такой проблемой, что после загрузки кода и включения прибора, аппарат не показывает высоту от нулевой точки, более того, я даже не могу задать нулевой уровень. Несмотря на это, прибор работает исправно и показывает давление, высоту над уровнем моря и температуру, а так же реагирует на нажатия кнопок (одна отвечает за обновление данных, другая за переключение показаний). Идею увидел на канале voltnik. Помогите пожалуйста!
//#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <Adafruit_Sensor.h>
#include <Adafruit_BMP280.h>
#include <EEPROMex.h>

#define OLED_RESET 4
#define but1 2 // пин кнопки1
#define but2 3 // пин кнопки2

#define longpress 3000 // сколько длительное нажатие
#define screen_ref 300 // обновление экрана каждые милисекунд
#define but_protect 100 // защита дребегза кнопки
#define mass_l 10 // длинна массива средних

Adafruit_SSD1306 display(OLED_RESET);
Adafruit_BMP280 bmp; // I2C

long now_millis, last_millis, last_but1, last_but2; // миллисекунды для отсчета
byte num_ekr = 0 ; // номер отображения экрана
float pressure_zero = 1005.00; // нулевая точка давления

float pressure[mass_l]; // массив давления
float temp[mass_l]; // массив температуры
float pres_sr = 0, temp_sr = 0, alt_sr = 0; // среднее давление и температура
byte pos = 0, sensorVal1, sensorVal2;
boolean pressed = false;
//=====================================
void setup() {
boolean baro = false;
Serial.begin(9600);

pinMode(but1, INPUT_PULLUP);
pinMode(but2, INPUT_PULLUP);

pinMode(5, OUTPUT); // использую контакт как массу для одной из кнопок
digitalWrite(5, 0);

pressure_zero = EEPROM.readFloat(0); // читаем из памяти значение давления в нулевой точке

if (!bmp.begin()) {
Serial.println(F(“Could not find a valid BMP280 sensor, check wiring!”));
while (1);
}

display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
display.cp437(true);
display.clearDisplay();
testdrawrect();
delay(200);

// начальное заполнение массива
display.clearDisplay();
display.setTextColor(WHITE);
display.setTextSize(1);
display.setCursor(30,40);
display.println(“Loading…”);
pres_sr = 0;
temp_sr = 0;
for (byte i=0; i<mass_l; i++) {
pressure[i] = bmp.readPressure();
temp[i] = bmp.readTemperature();
pres_sr = pres_sr + pressure[i];
temp_sr = temp_sr + temp[i];
//display.print(i);
display.drawRect(0, 30, i*8, 5, WHITE);
display.display();
delay(50);
}
pres_sr /= mass_l;
temp_sr /= mass_l;
}
//=====================================
void loop() {
sensorVal1 = digitalRead(but1);
sensorVal2 = digitalRead(but2);
now_millis = millis(); // разово на цикл запоминаем старт милисекунд

// обработка нажатия кнопки 1
if ((sensorVal1 == LOW) & (now_millis - last_but1)> but_protect) {
num_ekr = (num_ekr+1) % 6;
Serial.println(num_ekr);
last_but1 = now_millis + 500; // +500мс задержка следующего нажатия кнопки 1
}

// обработка длинного нажатия кнопки 2
if ((sensorVal2 == LOW) & (!pressed)) {
last_but2 = now_millis;
pressed = true;
}
// если держали более 3 секунд
if (pressed & ((now_millis-last_but2) > longpress)) {
pressure_zero = pres_sr / 100;
EEPROM.writeFloat(0,pressure_zero); // записываем в память значение давления в нулевой точке
display.clearDisplay();
display.setTextSize(2);
display.setCursor(0,0);
display.print(“Writing…”);
display.display();
pressed = false;
delay(500);
last_but2 = now_millis;
}
// обработка отпускания кнопки 2
if ((sensorVal2 == HIGH) & pressed) {
if ((now_millis - last_but2)> but_protect) { // короткое нажатие кнопки 2 если надо
Serial.println(“Short Press!”);
}
pressed = false;
}

// цикл обновления экрана
if (now_millis - last_millis > screen_ref) {

//цикл обновления массива температуры и давления
pos = (pos + 1) % mass_l;
pressure[pos] = bmp.readPressure();
temp[pos] = bmp.readTemperature();

// пересчет средних значений
pres_sr = 0;
temp_sr = 0;
// пересчет средних значений
for (byte i=0; i<mass_l; i++) {
//Serial.print(pressure[i]); Serial.print(" ");
pres_sr = pres_sr + pressure[i];
temp_sr = temp_sr + temp[i];
}
pres_sr /= mass_l;
temp_sr /= mass_l;

// вывод на экран
switch (num_ekr) {
case 0:
display.clearDisplay();
display.setTextSize(1);
display.setCursor(0,0);
display.println(" Baro-280"); display.println();
display.print("Press: "); display.println(pres_sr);
display.print("Alt Sea: "); display.println(bmp.readAltitude());
display.print("Alt Zero: "); display.println(calcAltitude(pressure_zero, pres_sr));
display.print("Temp: "); display.println(temp_sr);
display.display();
break;
case 1:
display.clearDisplay();
display.setTextSize(2);
display.setCursor(0,0);
display.print(“Pressure”);
display.setCursor(0,24);
display.println(pres_sr);
display.display();
break;
case 2:
display.clearDisplay();
display.setTextSize(2);
display.setCursor(0,0);
display.print(“Alt Sea”);
display.setCursor(0,24);
display.println(bmp.readAltitude());
display.display();
break;
case 3:
display.clearDisplay();
display.setTextSize(2);
display.setCursor(0,0);
display.print(“Alt Zero1”);
display.setCursor(0,24);
display.println(calcAltitude(pressure_zero, pres_sr));
display.setTextSize(1);
display.setCursor(0,48);
display.print(“filtered”);
display.display();
break;
case 4:
display.clearDisplay();
display.setTextSize(2);
display.setCursor(0,0);
display.print(“Alt Zero2”);
display.setCursor(0,24);
display.println(calcAltitude(pressure_zero, pressure[pos]));
display.display();
break;
case 5:
display.clearDisplay();
display.setTextSize(2);
display.setCursor(0,0);
display.print(“Temp”);
display.setCursor(0,24);
display.println(temp_sr);
display.display();
break;
}

last_millis = now_millis;
}

}
//===================================== квадратики на старте
void testdrawrect(void) {
for (int16_t i=0; i<display.height()/2; i+=2) {
display.drawRect(i, i, display.width()-2i, display.height()-2i, WHITE);
display.display();
delay(1);
}
}
//===================================== расчет высоты
float calcAltitude(float seaLevelhPa, float pressure) {
float altitude;
pressure /= 100;
altitude = 44330 * (1.0 - pow(pressure / seaLevelhPa, 0.1903));
return altitude;
}

image

2 лайка

@Stepan
Начните с того, чтобы вставить код в сообщение правильно. Иначе ваше общение с форумом на этом и закончится, а мне бы этого не хотелось, потому как вопрос интересный

Слона надо есть по частям.
Оттестировать маленькими программами все непонятки, а уж затем всю простыню.
Ну и программу вставить правильно.