Taiyo Mineo / SensorModule

Sensor module for temperature, air pressure, and humidity

Dependencies:   DHT11 LM75B mpl115a2

Dependents:   WeatherPredictor

SensorModule.cpp@2:d1f55b26ccac, 2015-02-16 (annotated)

Committer:
yukari_hinata
Date:
Mon Feb 16 07:53:35 2015 +0000
Revision:
2:d1f55b26ccac
Parent:
1:3d6d2ff7ff8a
Child:
3:c1c2c7c5fe82
changed.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yukari_hinata 0:98946a466ef8 1 #include "SensorModule.hpp"
yukari_hinata 0:98946a466ef8 2
yukari_hinata 0:98946a466ef8 3 // コンストラクタ
yukari_hinata 0:98946a466ef8 4 SensorModule::SensorModule(int n_sample)
yukari_hinata 0:98946a466ef8 5 {
yukari_hinata 1:3d6d2ff7ff8a 6 // サンプリング回数, インスタンス初期化
yukari_hinata 0:98946a466ef8 7 this->n_sample = n_sample;
yukari_hinata 0:98946a466ef8 8 this->temperture_sensor = new AnalogIn(p15);
yukari_hinata 1:3d6d2ff7ff8a 9 this->humidity_sensor = new DHT11(p11);
yukari_hinata 1:3d6d2ff7ff8a 10 this->pressure_i2c = new I2C(p9, p10);
yukari_hinata 1:3d6d2ff7ff8a 11 this->pressure_sensor = new MPL115A2(pressure_i2c);
yukari_hinata 1:3d6d2ff7ff8a 12 pressure_sensor->begin();
yukari_hinata 0:98946a466ef8 13
yukari_hinata 0:98946a466ef8 14 }
yukari_hinata 0:98946a466ef8 15
yukari_hinata 0:98946a466ef8 16 // デストラクタ
yukari_hinata 0:98946a466ef8 17 SensorModule::~SensorModule(void)
yukari_hinata 0:98946a466ef8 18 {
yukari_hinata 0:98946a466ef8 19 delete temperture_sensor;
yukari_hinata 0:98946a466ef8 20 delete humidity_sensor;
yukari_hinata 1:3d6d2ff7ff8a 21 delete pressure_i2c;
yukari_hinata 1:3d6d2ff7ff8a 22 delete pressure_sensor;
yukari_hinata 0:98946a466ef8 23 }
yukari_hinata 0:98946a466ef8 24
yukari_hinata 0:98946a466ef8 25 // 全センサーからn_sample回読み出し, 平均値で更新する.
yukari_hinata 0:98946a466ef8 26 void SensorModule::read_all_sensor(void)
yukari_hinata 0:98946a466ef8 27 {
yukari_hinata 2:d1f55b26ccac 28 int fail_count;
yukari_hinata 0:98946a466ef8 29 register float sum_temp = 0, sum_humid = 0, sum_pres = 0;
yukari_hinata 2:d1f55b26ccac 30 // float sum_temp2 = 0; 気圧センサ, 実は温度も測れる(<-LEDで明らかに熱そうなので廃止.)
yukari_hinata 0:98946a466ef8 31
yukari_hinata 1:3d6d2ff7ff8a 32 pressure_sensor->ReadSensor();
yukari_hinata 2:d1f55b26ccac 33
yukari_hinata 2:d1f55b26ccac 34 fail_count = 0;
yukari_hinata 2:d1f55b26ccac 35 while(1) {
yukari_hinata 2:d1f55b26ccac 36 if (fail_count >= 5) {
yukari_hinata 2:d1f55b26ccac 37 fprintf( stderr, "Error in Temperaure Sensor \r\n");
yukari_hinata 2:d1f55b26ccac 38 exit(1);
yukari_hinata 2:d1f55b26ccac 39 }
yukari_hinata 1:3d6d2ff7ff8a 40 // AnalogInを用いる場合は,n_samle回センサーから読み出す.
yukari_hinata 1:3d6d2ff7ff8a 41 for (int count = 0; count < n_sample; count++ ) {
yukari_hinata 1:3d6d2ff7ff8a 42 // LM61CIZの温度読み取り
yukari_hinata 1:3d6d2ff7ff8a 43 sum_temp += (temperture_sensor->read()-(0.6/3.3))/(0.01/3.3);
yukari_hinata 1:3d6d2ff7ff8a 44 // MPL115A2の気圧読み取り
yukari_hinata 1:3d6d2ff7ff8a 45 pressure_sensor->ReadSensor();
yukari_hinata 1:3d6d2ff7ff8a 46 sum_pres += pressure_sensor->GetPressure();
yukari_hinata 1:3d6d2ff7ff8a 47 // sum_temp2 += pressure_sensor->GetTemperature();
yukari_hinata 1:3d6d2ff7ff8a 48 wait(0.1);
yukari_hinata 1:3d6d2ff7ff8a 49 }
yukari_hinata 2:d1f55b26ccac 50 if ( fabsf(new_temperture - (sum_temp / n_sample)) < 40
yukari_hinata 2:d1f55b26ccac 51 && fabsf(new_pressure - (sum_pres / n_sample)) < 40 ) {
yukari_hinata 2:d1f55b26ccac 52 break;
yukari_hinata 2:d1f55b26ccac 53 } else {
yukari_hinata 2:d1f55b26ccac 54 // 異常値ならばやり直し(たま〜に異常値をとる...)
yukari_hinata 2:d1f55b26ccac 55 fail_count++;
yukari_hinata 2:d1f55b26ccac 56 }
yukari_hinata 2:d1f55b26ccac 57 }
yukari_hinata 0:98946a466ef8 58
yukari_hinata 2:d1f55b26ccac 59 // 更新
yukari_hinata 0:98946a466ef8 60 new_temperture = sum_temp / n_sample;
yukari_hinata 0:98946a466ef8 61 new_pressure = sum_pres / n_sample;
yukari_hinata 2:d1f55b26ccac 62
yukari_hinata 1:3d6d2ff7ff8a 63 // printf("LM61CIZ : %f vs. MPL115A2 : %f \r\n", sum_temp / n_sample, sum_temp2 / n_sample);
yukari_hinata 0:98946a466ef8 64
yukari_hinata 0:98946a466ef8 65 // DHT11の湿度読み取り
yukari_hinata 2:d1f55b26ccac 66 fail_count = 0;
yukari_hinata 2:d1f55b26ccac 67 while(1) {
yukari_hinata 2:d1f55b26ccac 68 if (fail_count >= 5) {
yukari_hinata 2:d1f55b26ccac 69 fprintf( stderr, "Error in Humidity Sensor \r\n");
yukari_hinata 2:d1f55b26ccac 70 exit(1);
yukari_hinata 2:d1f55b26ccac 71 }
yukari_hinata 2:d1f55b26ccac 72
yukari_hinata 2:d1f55b26ccac 73 if (humidity_sensor->readData() == DHT11::OK) {
yukari_hinata 2:d1f55b26ccac 74 new_humidity = float(humidity_sensor->readHumidity());
yukari_hinata 2:d1f55b26ccac 75 break;
yukari_hinata 2:d1f55b26ccac 76 } else {
yukari_hinata 2:d1f55b26ccac 77 fail_count++;
yukari_hinata 2:d1f55b26ccac 78 }
yukari_hinata 2:d1f55b26ccac 79 wait(0.5);
yukari_hinata 0:98946a466ef8 80 }
yukari_hinata 0:98946a466ef8 81
yukari_hinata 2:d1f55b26ccac 82 }