果報は寝て待て: Arduinoで高度計をつくろう その3

2020年4月19日日曜日

Arduinoで高度計をつくろう その3

次に、タクトスイッチを押すとその時の高度を記憶し、その高度との差(相対値)を表示するようにしました。
プログラムです。

  1. #include <Wire.h>
  2. #include <LPS.h>
  3. #include <LiquidCrystal.h>
  4. #define set_pin   7 //7番ピンをset_pinと命名する
  5. LiquidCrystal lcd = LiquidCrystal(12,11,10,5,4,3,2);
  6. LPS ps;
  7. void setup()
  8. {
  9.   Serial.begin(9600);
  10.   Wire.begin();
  11.   lcd.begin(16, 2);
  12.   pinMode(set_pin,INPUT_PULLUP) ;  //set_pinを入力ピンでプルアップにする
  13.  
  14.   if (!ps.init())
  15.   {
  16.     Serial.println("Failed to autodetect pressure sensor!");
  17.     while (1);
  18.   }
  19.   ps.enableDefault();
  20.  
  21. }
  22. void loop()
  23. {
  24.   int i;
  25.   int set;                   //set_pinの状態
  26.   float altitude = 0;        //高度
  27.   float rel_altitude ;        //高度の相対値
  28.   float set_altitude ;        //セットしたときの高度
  29.   float disp_altitude;        //表示中の絶対値高度
  30.   float pressure = 0;        //気圧
  31.   float pressureave = 0;     //平均気圧
  32.   float temperature = 0;     //気温
  33.   for (i = 0; i < 1000; i++){
  34.    pressureave = pressureave + ps.readPressureMillibars();
  35.    pressure =  ps.readPressureMillibars();
  36.    altitude = altitude + ps.pressureToAltitudeMeters(pressure);
  37.    temperature = temperature + ps.readTemperatureC();
  38.    delay(5);
  39.   }
  40.   pressureave = pressureave /1000;
  41.   disp_altitude = altitude /1000;
  42.   temperature = temperature /1000;
  43.   set = digitalRead(set_pin);
  44.    if (set == LOW) {     // ボタンが押されていたら、
  45.    set_altitude = disp_altitude;  //disp_altitudeをset_altitudeに代入する
  46.   }
  47.  
  48.   rel_altitude = disp_altitude - set_altitude ; //高度の相対値を計算
  49.   Serial.print("p: ");
  50.   Serial.print(pressureave);
  51.   Serial.print(" mbar\ta: ");
  52.   Serial.print(disp_altitude);
  53.   Serial.print(" m\tset: ");
  54.   Serial.print(set_altitude);
  55.   Serial.print(" m\trel: ");
  56.   Serial.print(rel_altitude);
  57.   Serial.print(" m\tt: ");
  58.   Serial.print(temperature);
  59.   Serial.println(" deg C");
  60.   lcd.setCursor(0,0);                   // 液晶へ表示
  61.   //lcd.print("p: ");
  62.   lcd.print(pressureave,0);                   
  63.   lcd.print("mbr ");
  64.   lcd.print(temperature,1);
  65.   lcd.print(" deg C");
  66.  
  67.   lcd.setCursor(0,1);          //液晶の2行目に表示
  68.   lcd.print("a:");
  69.   lcd.print(disp_altitude,1);    
  70.   lcd.print("m");
  71.   lcd.print(" r:");
  72.   lcd.print(rel_altitude,1);    
  73.   lcd.print("m     ");
  74.  
  75.  
  76.  
  77.   delay(100);
  78. }
  79.  
デジタルの7ピンにタクトスイッチをつけました。
相対値をゼロmにするにはタクトスイッチを5秒以上押す必要があります…
シリアルモニタでの表示は成功です。

LCDでは、aは絶対値高度で、rが相対値高度となります。
あとは持ち運び可能にするだけです。


0 件のコメント:

コメントを投稿