標(biāo)題: ms5837+arduino源程序 [打印本頁]
作者: blue_sea    時(shí)間: 2020-4-10 20:55
標(biāo)題: ms5837+arduino源程序
  1. #include "MS5837.h"
  2. #include <Wire.h>

  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

  11. const float MS5837::Pa = 100.0f;
  12. const float MS5837::bar = 0.001f;
  13. const float MS5837::mbar = 1.0f;

  15. const uint8_t MS5837::MS5837_30BA = 0;
  16. const uint8_t MS5837::MS5837_02BA = 1;

  18. MS5837::MS5837() {
  19.         fluidDensity = 1029;
  20. }

  22. bool MS5837::init() {
  23.         // Reset the MS5837, per datasheet
  24.         Wire.beginTransmission(MS5837_ADDR);
  25.         Wire.write(MS5837_RESET);
  26.         Wire.endTransmission();

  28.         // Wait for reset to complete
  29.         delay(10);

  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();

  37.                 Wire.requestFrom(MS5837_ADDR,2);
  38.                 C[i] = (Wire.read() << 8) | Wire.read();
  39.         }

  41.         // Verify that data is correct with CRC
  42.         uint8_t crcRead = C[0] >> 12;
  43.         uint8_t crcCalculated = crc4(C);

  45.         if ( crcCalculated == crcRead ) {
  46.                 return true; // Initialization success
  47.         }

  49.         return false; // CRC fail
  50. }

  52. void MS5837::setModel(uint8_t model) {
  53.         _model = model;
  54. }

  56. void MS5837::setFluidDensity(float density) {
  57.         fluidDensity = density;
  58. }

  60. void MS5837::read() {
  61.         // Request D1 conversion
  62.         Wire.beginTransmission(MS5837_ADDR);
  63.         Wire.write(MS5837_CONVERT_D1_8192);
  64.         Wire.endTransmission();

  66.         delay(20); // Max conversion time per datasheet
  67.        
  68.         Wire.beginTransmission(MS5837_ADDR);
  69.         Wire.write(MS5837_ADC_READ);
  70.         Wire.endTransmission();

  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();

  83.         delay(20); // Max conversion time per datasheet
  84.        
  85.         Wire.beginTransmission(MS5837_ADDR);
  86.         Wire.write(MS5837_ADC_READ);
  87.         Wire.endTransmission();

  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();

  95.         calculate();
  96. }

  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. }

  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. }

  171. float MS5837::temperature() {
  172.         return TEMP/100.0f;
  173. }

  175. float MS5837::depth() {
  176.         return (pressure(MS5837::Pa)-101300)/(fluidDensity*9.80665);
  177. }

  179. float MS5837::altitude() {
  180.         return (1-pow((pressure()/1013.25),.190284))*145366.45*.3048;
  181. }


  184. uint8_t MS5837::crc4(uint16_t n_prom[]) {
  185.         uint16_t n_rem = 0;

  187.         n_prom[0] = ((n_prom[0]) & 0x0FFF);
  188.         n_prom[7] = 0;

  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);

  207.         return n_rem ^ 0x00;
  208. }
復(fù)制代碼

全部資料51hei下載地址：
MS5837資料.rar (1.63 MB, 下載次數(shù): 20)




歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1