| 0,0 → 1,77 |
|---|
| /* |
| MS561101BA_movaverage.pde - Reads from the sensors and outputs a moving averaged pressure reading |
| |
| Copyright (C) 2011 Fabio Varesano <fvaresano@yahoo.it> |
| |
| Development of this code has been supported by the Department of Computer Science, |
| Universita' degli Studi di Torino, Italy within the Piemonte Project |
| http://www.piemonte.di.unito.it/ |
| |
| |
| This program is free software: you can redistribute it and/or modify |
| it under the terms of the version 3 GNU General Public License as |
| published by the Free Software Foundation. |
| |
| This program is distributed in the hope that it will be useful, |
| but WITHOUT ANY WARRANTY; without even the implied warranty of |
| MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| GNU General Public License for more details. |
| |
| You should have received a copy of the GNU General Public License |
| along with this program. If not, see <http://www.gnu.org/licenses/>. |
| |
| */ |
| |
| |
| //#define DEBUG_V |
| |
| #include <Wire.h> |
| //#include <DebugUtils.h> |
| #include <MS561101BA.h> |
| |
| |
| #define MOVAVG_SIZE 32 |
| |
| MS561101BA baro = MS561101BA(); |
| |
| float movavg_buff[MOVAVG_SIZE]; |
| int movavg_i=0; |
| |
| |
| void setup() { |
| Wire.begin(); |
| Serial.begin(9600); |
| delay(1000); |
| |
| // Suppose that the CSB pin is connected to GND. |
| // You'll have to check this on your breakout schematics |
| baro.init(MS561101BA_ADDR_CSB_LOW); |
| delay(100); |
| |
| // populate movavg_buff before starting loop |
| for(int i=0; i<MOVAVG_SIZE; i++) { |
| movavg_buff[i] = baro.getPressure(MS561101BA_OSR_4096); |
| } |
| } |
| |
| void loop() { |
| Serial.print(" temp: "); |
| Serial.print(baro.getTemperature(MS561101BA_OSR_4096)); |
| Serial.print(" degC pres: "); |
| pushAvg(baro.getPressure(MS561101BA_OSR_4096)); |
| Serial.print(getAvg(movavg_buff, MOVAVG_SIZE)); |
| Serial.println(" mbar"); |
| } |
| |
| void pushAvg(float val) { |
| movavg_buff[movavg_i] = val; |
| movavg_i = (movavg_i + 1) % MOVAVG_SIZE; |
| } |
| |
| float getAvg(float * buff, int size) { |
| float sum = 0.0; |
| for(int i=0; i<size; i++) { |
| sum += buff[i]; |
| } |
| return sum / size; |
| } |