单片机教程网

电脑版
提示:原网页已由神马搜索转码, 内容由www.51hei.com提供.
查看:2662|回复:0

ms5837+arduino源程序

[复制链接]
ID:369562发表于 2020-4-10 20:55|显示全部楼层
  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. }
复制代码

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

手机版|小黑屋|51黑电子论坛|51黑电子论坛6群QQ管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网