ms5837+arduino源程序

1. #include "MS5837.h"
   
2. #include <Wire.h>
   
3. 
   
4. #define MS5837_ADDR               0x76  
   
5. #define MS5837_RESET              0x1E
   
6. #define MS5837_ADC_READ           0x00
   
7. #define MS5837_PROM_READ          0xA0
   
8. #define MS5837_CONVERT_D1_8192    0x4A
   
9. #define MS5837_CONVERT_D2_8192    0x5A
   
10. 
    
11. const float MS5837::Pa = 100.0f;
    
12. const float MS5837::bar = 0.001f;
    
13. const float MS5837::mbar = 1.0f;
    
14. 
    
15. const uint8_t MS5837::MS5837_30BA = 0;
    
16. const uint8_t MS5837::MS5837_02BA = 1;
    
17. 
    
18. MS5837::MS5837() {
    
19.         fluidDensity = 1029;
    
20. }
    
21. 
    
22. bool MS5837::init() {
    
23.         // Reset the MS5837, per datasheet
    
24.         Wire.beginTransmission(MS5837_ADDR);
    
25.         Wire.write(MS5837_RESET);
    
26.         Wire.endTransmission();
    
27. 
    
28.         // Wait for reset to complete
    
29.         delay(10);
    
30. 
    
31.         // Read calibration values and CRC
    
32.         for ( uint8_t i = 0 ; i < 7 ; i++ ) {
    
33.                 Wire.beginTransmission(MS5837_ADDR);
    
34.                 Wire.write(MS5837_PROM_READ+i*2);
    
35.                 Wire.endTransmission();
    
36. 
    
37.                 Wire.requestFrom(MS5837_ADDR,2);
    
38.                 C[i] = (Wire.read() << 8) | Wire.read();
    
39.         }
    
40. 
    
41.         // Verify that data is correct with CRC
    
42.         uint8_t crcRead = C[0] >> 12;
    
43.         uint8_t crcCalculated = crc4(C);
    
44. 
    
45.         if ( crcCalculated == crcRead ) {
    
46.                 return true; // Initialization success
    
47.         }
    
48. 
    
49.         return false; // CRC fail
    
50. }
    
51. 
    
52. void MS5837::setModel(uint8_t model) {
    
53.         _model = model;
    
54. }
    
55. 
    
56. void MS5837::setFluidDensity(float density) {
    
57.         fluidDensity = density;
    
58. }
    
59. 
    
60. void MS5837::read() {
    
61.         // Request D1 conversion
    
62.         Wire.beginTransmission(MS5837_ADDR);
    
63.         Wire.write(MS5837_CONVERT_D1_8192);
    
64.         Wire.endTransmission();
    
65. 
    
66.         delay(20); // Max conversion time per datasheet
    
67.        
    
68.         Wire.beginTransmission(MS5837_ADDR);
    
69.         Wire.write(MS5837_ADC_READ);
    
70.         Wire.endTransmission();
    
71. 
    
72.         Wire.requestFrom(MS5837_ADDR,3);
    
73.         D1 = 0;
    
74.         D1 = Wire.read();
    
75.         D1 = (D1 << 8) | Wire.read();
    
76.         D1 = (D1 << 8) | Wire.read();
    
77.        
    
78.         // Request D2 conversion
    
79.         Wire.beginTransmission(MS5837_ADDR);
    
80.         Wire.write(MS5837_CONVERT_D2_8192);
    
81.         Wire.endTransmission();
    
82. 
    
83.         delay(20); // Max conversion time per datasheet
    
84.        
    
85.         Wire.beginTransmission(MS5837_ADDR);
    
86.         Wire.write(MS5837_ADC_READ);
    
87.         Wire.endTransmission();
    
88. 
    
89.         Wire.requestFrom(MS5837_ADDR,3);
    
90.         D2 = 0;
    
91.         D2 = Wire.read();
    
92.         D2 = (D2 << 8) | Wire.read();
    
93.         D2 = (D2 << 8) | Wire.read();
    
94. 
    
95.         calculate();
    
96. }
    
97. 
    
98. void MS5837::calculate() {
    
99.         // Given C1-C6 and D1, D2, calculated TEMP and P
    
100.         // Do conversion first and then second order temp compensation
     
101.        
     
102.         int32_t dT = 0;
     
103.         int64_t SENS = 0;
     
104.         int64_t OFF = 0;
     
105.         int32_t SENSi = 0;
     
106.         int32_t OFFi = 0;  
     
107.         int32_t Ti = 0;   
     
108.         int64_t OFF2 = 0;
     
109.         int64_t SENS2 = 0;
     
110.        
     
111.         // Terms called
     
112.         dT = D2-uint32_t(C[5])*256l;
     
113.         if ( _model == MS5837_02BA ) {
     
114.                 SENS = int64_t(C[1])*65536l+(int64_t(C[3])*dT)/128l;
     
115.                 OFF = int64_t(C[2])*131072l+(int64_t(C[4])*dT)/64l;
     
116.                 P = (D1*SENS/(2097152l)-OFF)/(32768l);
     
117.         } else {
     
118.                 SENS = int64_t(C[1])*32768l+(int64_t(C[3])*dT)/256l;
     
119.                 OFF = int64_t(C[2])*65536l+(int64_t(C[4])*dT)/128l;
     
120.                 P = (D1*SENS/(2097152l)-OFF)/(8192l);
     
121.         }
     
122.        
     
123.         // Temp conversion
     
124.         TEMP = 2000l+int64_t(dT)*C[6]/8388608LL;
     
125.        
     
126.         //Second order compensation
     
127.         if ( _model == MS5837_02BA ) {
     
128.                 if((TEMP/100)<20){         //Low temp
     
129.                         Ti = (11*int64_t(dT)*int64_t(dT))/(34359738368LL);
     
130.                         OFFi = (31*(TEMP-2000)*(TEMP-2000))/8;
     
131.                         SENSi = (63*(TEMP-2000)*(TEMP-2000))/32;
     
132.                 }
     
133.         } else {
     
134.                 if((TEMP/100)<20){         //Low temp
     
135.                         Ti = (3*int64_t(dT)*int64_t(dT))/(8589934592LL);
     
136.                         OFFi = (3*(TEMP-2000)*(TEMP-2000))/2;
     
137.                         SENSi = (5*(TEMP-2000)*(TEMP-2000))/8;
     
138.                         if((TEMP/100)<-15){    //Very low temp
     
139.                                 OFFi = OFFi+7*(TEMP+1500l)*(TEMP+1500l);
     
140.                                 SENSi = SENSi+4*(TEMP+1500l)*(TEMP+1500l);
     
141.                         }
     
142.                 }
     
143.                 else if((TEMP/100)>=20){    //High temp
     
144.                         Ti = 2*(dT*dT)/(137438953472LL);
     
145.                         OFFi = (1*(TEMP-2000)*(TEMP-2000))/16;
     
146.                         SENSi = 0;
     
147.                 }
     
148.         }
     
149.        
     
150.         OFF2 = OFF-OFFi;           //Calculate pressure and temp second order
     
151.         SENS2 = SENS-SENSi;
     
152.        
     
153.         TEMP = (TEMP-Ti);
     
154.        
     
155.         if ( _model == MS5837_02BA ) {
     
156.                 P = (((D1*SENS2)/2097152l-OFF2)/32768l);
     
157.         } else {
     
158.                 P = (((D1*SENS2)/2097152l-OFF2)/8192l);
     
159.         }
     
160. }
     
161. 
     
162. float MS5837::pressure(float conversion) {
     
163.     if ( _model == MS5837_02BA ) {
     
164.         return P*conversion/100.0f;
     
165.     }
     
166.     else {
     
167.         return P*conversion/10.0f;
     
168.     }
     
169. }
     
170. 
     
171. float MS5837::temperature() {
     
172.         return TEMP/100.0f;
     
173. }
     
174. 
     
175. float MS5837::depth() {
     
176.         return (pressure(MS5837::Pa)-101300)/(fluidDensity*9.80665);
     
177. }
     
178. 
     
179. float MS5837::altitude() {
     
180.         return (1-pow((pressure()/1013.25),.190284))*145366.45*.3048;
     
181. }
     
182. 
     
183. 
     
184. uint8_t MS5837::crc4(uint16_t n_prom[]) {
     
185.         uint16_t n_rem = 0;
     
186. 
     
187.         n_prom[0] = ((n_prom[0]) & 0x0FFF);
     
188.         n_prom[7] = 0;
     
189. 
     
190.         for ( uint8_t i = 0 ; i < 16; i++ ) {
     
191.                 if ( i%2 == 1 ) {
     
192.                         n_rem ^= (uint16_t)((n_prom[i>>1]) & 0x00FF);
     
193.                 } else {
     
194.                         n_rem ^= (uint16_t)(n_prom[i>>1] >> 8);
     
195.                 }
     
196.                 for ( uint8_t n_bit = 8 ; n_bit > 0 ; n_bit-- ) {
     
197.                         if ( n_rem & 0x8000 ) {
     
198.                                 n_rem = (n_rem << 1) ^ 0x3000;
     
199.                         } else {
     
200.                                 n_rem = (n_rem << 1);
     
201.                         }
     
202.                 }
     
203.         }
     
204.        
     
205.         n_rem = ((n_rem >> 12) & 0x000F);
     
206. 
     
207.         return n_rem ^ 0x00;
     
208. }
     

复制代码

全部资料51hei下载地址：
MS5837资料.rar (1.63 MB, 下载次数: 20)

2020-4-10 20:54 上传

点击文件名下载附件