伊生希 小林 / Mbed 2 deprecated cansat_main_copy

temp

Dependencies:   mbed SDFileSystem MS5607 ADXL345_I2C FATFileSystem

MS5607/MS5607Base.h@0:c88c3b616c00, 2020-03-16 (annotated)

Committer:
IKobayashi
Date:
Mon Mar 16 23:37:42 2020 +0900
Revision:
0:c88c3b616c00
copy

Who changed what in which revision?

UserRevisionLine numberNew contents of line
IKobayashi 0:c88c3b616c00 1 /*
IKobayashi 0:c88c3b616c00 2 Copyright (c) 2012, Senio Networks, Inc.
IKobayashi 0:c88c3b616c00 3
IKobayashi 0:c88c3b616c00 4 Permission is hereby granted, free of charge, to any person obtaining a copy
IKobayashi 0:c88c3b616c00 5 of this software and associated documentation files (the "Software"), to deal
IKobayashi 0:c88c3b616c00 6 in the Software without restriction, including without limitation the rights
IKobayashi 0:c88c3b616c00 7 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
IKobayashi 0:c88c3b616c00 8 copies of the Software, and to permit persons to whom the Software is
IKobayashi 0:c88c3b616c00 9 furnished to do so, subject to the following conditions:
IKobayashi 0:c88c3b616c00 10
IKobayashi 0:c88c3b616c00 11 The above copyright notice and this permission notice shall be included in
IKobayashi 0:c88c3b616c00 12 all copies or substantial portions of the Software.
IKobayashi 0:c88c3b616c00 13
IKobayashi 0:c88c3b616c00 14 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
IKobayashi 0:c88c3b616c00 15 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
IKobayashi 0:c88c3b616c00 16 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
IKobayashi 0:c88c3b616c00 17 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
IKobayashi 0:c88c3b616c00 18 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
IKobayashi 0:c88c3b616c00 19 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
IKobayashi 0:c88c3b616c00 20 THE SOFTWARE.
IKobayashi 0:c88c3b616c00 21 */
IKobayashi 0:c88c3b616c00 22
IKobayashi 0:c88c3b616c00 23 #ifndef MS5607_BASE_H
IKobayashi 0:c88c3b616c00 24 #define MS5607_BASE_H
IKobayashi 0:c88c3b616c00 25
IKobayashi 0:c88c3b616c00 26 class MS5607Base {
IKobayashi 0:c88c3b616c00 27 public:
IKobayashi 0:c88c3b616c00 28 void printCoefficients() {
IKobayashi 0:c88c3b616c00 29 printf("%d, %d, %d, %d, %d, %d\r\n", c1, c2, c3, c4, c5, c6);
IKobayashi 0:c88c3b616c00 30 }
IKobayashi 0:c88c3b616c00 31
IKobayashi 0:c88c3b616c00 32 int getRawTemperature() {
IKobayashi 0:c88c3b616c00 33 return readADC(ADC_D2 | OSR_4096);
IKobayashi 0:c88c3b616c00 34 }
IKobayashi 0:c88c3b616c00 35
IKobayashi 0:c88c3b616c00 36 int getRawPressure() {
IKobayashi 0:c88c3b616c00 37 return readADC(ADC_D1 | OSR_4096);
IKobayashi 0:c88c3b616c00 38 }
IKobayashi 0:c88c3b616c00 39
IKobayashi 0:c88c3b616c00 40 float getTemperature() {
IKobayashi 0:c88c3b616c00 41 int dT = getRawTemperature() - (c5 << 8);
IKobayashi 0:c88c3b616c00 42 int temp = 2000 + ((dT * c6) >> 23);
IKobayashi 0:c88c3b616c00 43
IKobayashi 0:c88c3b616c00 44 // 2nd order temperature compensation
IKobayashi 0:c88c3b616c00 45 if (temp < 2000) {
IKobayashi 0:c88c3b616c00 46 int t2 = (int64_t) dT * dT >> 31;
IKobayashi 0:c88c3b616c00 47 temp -= t2;
IKobayashi 0:c88c3b616c00 48 }
IKobayashi 0:c88c3b616c00 49
IKobayashi 0:c88c3b616c00 50 return float(temp) / 100;
IKobayashi 0:c88c3b616c00 51 }
IKobayashi 0:c88c3b616c00 52
IKobayashi 0:c88c3b616c00 53 float getPressure() {
IKobayashi 0:c88c3b616c00 54 int dT = getRawTemperature() - (c5 << 8);
IKobayashi 0:c88c3b616c00 55 int temp = 2000 + ((dT * c6) >> 23);
IKobayashi 0:c88c3b616c00 56 int64_t off = ((int64_t) c2 << 17) + ((int64_t) dT * c4 >> 6);
IKobayashi 0:c88c3b616c00 57 int64_t sens = ((int64_t) c1 << 16) + ((int64_t) dT * c3 >> 7);
IKobayashi 0:c88c3b616c00 58
IKobayashi 0:c88c3b616c00 59 // 2nd order temperature compensation
IKobayashi 0:c88c3b616c00 60 if (temp < 2000) {
IKobayashi 0:c88c3b616c00 61 int64_t off2 = (int64_t) 61 * (temp - 2000) * (temp - 2000) >> 4;
IKobayashi 0:c88c3b616c00 62 int64_t sens2 = (int64_t) 2 * (temp - 2000) * (temp - 2000);
IKobayashi 0:c88c3b616c00 63 if (temp < -1500) {
IKobayashi 0:c88c3b616c00 64 off2 += (int64_t) 15 * (temp + 1500) * (temp + 1500);
IKobayashi 0:c88c3b616c00 65 sens2 += (int64_t) 8 * (temp + 1500) * (temp + 1500);
IKobayashi 0:c88c3b616c00 66 }
IKobayashi 0:c88c3b616c00 67 off -= off2;
IKobayashi 0:c88c3b616c00 68 sens -= sens2;
IKobayashi 0:c88c3b616c00 69 }
IKobayashi 0:c88c3b616c00 70
IKobayashi 0:c88c3b616c00 71 return float((((int64_t) getRawPressure() * sens >> 21) - off) >> 15);
IKobayashi 0:c88c3b616c00 72 }
IKobayashi 0:c88c3b616c00 73
IKobayashi 0:c88c3b616c00 74 float getAltitude(int presssure = 0) {
IKobayashi 0:c88c3b616c00 75 return toAltitude(presssure ? presssure : (int) getPressure());
IKobayashi 0:c88c3b616c00 76 }
IKobayashi 0:c88c3b616c00 77
IKobayashi 0:c88c3b616c00 78 protected:
IKobayashi 0:c88c3b616c00 79 int32_t c1, c2, c3, c4, c5, c6;
IKobayashi 0:c88c3b616c00 80
IKobayashi 0:c88c3b616c00 81 enum {
IKobayashi 0:c88c3b616c00 82 RESET = 0x1E,
IKobayashi 0:c88c3b616c00 83 ADC_READ = 0x00,
IKobayashi 0:c88c3b616c00 84 ADC_CONV = 0x40,
IKobayashi 0:c88c3b616c00 85 ADC_D1 = 0x00,
IKobayashi 0:c88c3b616c00 86 ADC_D2 = 0x10,
IKobayashi 0:c88c3b616c00 87 OSR_256 = 0x00,
IKobayashi 0:c88c3b616c00 88 OSR_512 = 0x02,
IKobayashi 0:c88c3b616c00 89 OSR_1024 = 0x04,
IKobayashi 0:c88c3b616c00 90 OSR_2048 = 0x06,
IKobayashi 0:c88c3b616c00 91 OSR_4096 = 0x08,
IKobayashi 0:c88c3b616c00 92 PROM_READ = 0xA0
IKobayashi 0:c88c3b616c00 93 };
IKobayashi 0:c88c3b616c00 94
IKobayashi 0:c88c3b616c00 95 virtual void writeCommand(int command, int ms = 0) = 0;
IKobayashi 0:c88c3b616c00 96 virtual int readPROM(int address) = 0;
IKobayashi 0:c88c3b616c00 97 virtual int readADC(int command) = 0;
IKobayashi 0:c88c3b616c00 98
IKobayashi 0:c88c3b616c00 99 void init() {
IKobayashi 0:c88c3b616c00 100 writeCommand(RESET, 3);
IKobayashi 0:c88c3b616c00 101 c1 = readPROM(1);
IKobayashi 0:c88c3b616c00 102 c2 = readPROM(2);
IKobayashi 0:c88c3b616c00 103 c3 = readPROM(3);
IKobayashi 0:c88c3b616c00 104 c4 = readPROM(4);
IKobayashi 0:c88c3b616c00 105 c5 = readPROM(5);
IKobayashi 0:c88c3b616c00 106 c6 = readPROM(6);
IKobayashi 0:c88c3b616c00 107 }
IKobayashi 0:c88c3b616c00 108
IKobayashi 0:c88c3b616c00 109 float toAltitude(int pressure) {
IKobayashi 0:c88c3b616c00 110 // Ref. 29124-AltimeterAppNote1.pdf
IKobayashi 0:c88c3b616c00 111 const float R = 287.052; // specific gas constant R*/M0
IKobayashi 0:c88c3b616c00 112 const float g = 9.80665; // standard gravity
IKobayashi 0:c88c3b616c00 113 const float t_grad = 0.0065; // gradient of temperature
IKobayashi 0:c88c3b616c00 114 const float t0 = 273.15 + 15; // temperature at 0 altitude
IKobayashi 0:c88c3b616c00 115 const float p0 = 101325; // pressure at 0 altitude
IKobayashi 0:c88c3b616c00 116
IKobayashi 0:c88c3b616c00 117 return t0 / t_grad * (1 - exp((t_grad * R / g) * log(pressure / p0)));
IKobayashi 0:c88c3b616c00 118 }
IKobayashi 0:c88c3b616c00 119 };
IKobayashi 0:c88c3b616c00 120
IKobayashi 0:c88c3b616c00 121 #endif