Diff: sps30.cpp
- Revision:
- 0:9221dac25d3b
- Child:
- 2:549bee9a4cd0
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/sps30.cpp Mon Mar 04 05:58:42 2019 +0000
@@ -0,0 +1,327 @@
+#include "mbed.h"
+#include "sps30.h"
+
+//-----------------------------------------------------------------------------
+// Constructor
+
+sps30::sps30(PinName sda, PinName scl, int i2cFrequency) : _i2c(sda, scl) {
+ _i2c.frequency(i2cFrequency);
+}
+
+//-----------------------------------------------------------------------------
+// Destructor
+
+sps30::~sps30() {
+}
+
+//-----------------------------------------------------------------------------
+// start auto-measurement with barometer reading (in mB)
+//
+
+uint8_t sps30::startMeasurement() // done
+{
+ i2cBuff[0] = SPS30_CMMD_STRT_MEAS >> 8;
+ i2cBuff[1] = SPS30_CMMD_STRT_MEAS & 255;
+ i2cBuff[2] = 0x03;
+ i2cBuff[3] = 0x00;
+ i2cBuff[4] = sps30::calcCrc2b(0x0300);
+ int res = _i2c.write(SPS30_I2C_ADDR, i2cBuff, 5, false);
+ if(res) return SPSnoAckERROR;
+ return SPSnoERROR;
+}
+
+//-----------------------------------------------------------------------------
+// Stop auto-measurement
+
+uint8_t sps30::stopMeasurement() // done
+{
+ i2cBuff[0] = SPS30_CMMD_STOP_MEAS >> 8;
+ i2cBuff[1] = SPS30_CMMD_STOP_MEAS & 255;
+ int res = _i2c.write(SPS30_I2C_ADDR, i2cBuff, 2, false);
+ if(res) return SPSnoAckERROR;
+ return SPSnoERROR;
+}
+
+//-----------------------------------------------------------------------------
+// Get ready status value
+
+uint8_t sps30::getReadyStatus() // done
+{
+ i2cBuff[0] = SPS30_CMMD_GET_READY_STAT >> 8;
+ i2cBuff[1] = SPS30_CMMD_GET_READY_STAT & 255;
+ int res = _i2c.write(SPS30_I2C_ADDR, i2cBuff, 2, false);
+ if(res) return SPSnoAckERROR;
+
+ _i2c.read(SPS30_I2C_ADDR | 1, i2cBuff, 3, false);
+ uint16_t stat = (i2cBuff[0] << 8) | i2cBuff[1];
+ ready = stat;
+ uint8_t dat = sps30::checkCrc2b(stat, i2cBuff[2]);
+
+ if(dat == SPScrcERROR) return SPScrcERROR;
+ if(dat == SPSisReady) return SPSisReady;
+ return SPSnoERROR;
+}
+
+//-----------------------------------------------------------------------------
+// Get all the measurement values, stick them into the array
+
+uint8_t sps30::readMeasurement() // editing
+{
+ i2cBuff[0] = SPS30_CMMD_READ_MEAS >> 8;
+ i2cBuff[1] = SPS30_CMMD_READ_MEAS & 255;
+ int res = _i2c.write(SPS30_I2C_ADDR, i2cBuff, 2, false);
+ if(res) return SPSnoAckERROR;
+
+ _i2c.read(SPS30_I2C_ADDR | 1, i2cBuff, 60, false);
+
+ /* TO DO: update the members used in the class */
+ uint16_t stat = (i2cBuff[0] << 8) | i2cBuff[1];
+ mass_1p0_m = stat;
+ uint8_t dat = sps30::checkCrc2b(stat, i2cBuff[2]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[3] << 8) | i2cBuff[4];
+ mass_1p0_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[5]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+
+
+ stat = (i2cBuff[6] << 8) | i2cBuff[7];
+ mass_2p5_m = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[8]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[9] << 8) | i2cBuff[10];
+ mass_2p5_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[11]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+
+
+ stat = (i2cBuff[12] << 8) | i2cBuff[13];
+ mass_4p0_m = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[14]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[15] << 8) | i2cBuff[16];
+ mass_4p0_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[17]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+
+
+ stat = (i2cBuff[18] << 8) | i2cBuff[19];
+ mass_10p0_m = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[20]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[21] << 8) | i2cBuff[22];
+ mass_10p0_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[23]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+
+
+ stat = (i2cBuff[24] << 8) | i2cBuff[25];
+ num_0p5_m = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[26]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[27] << 8) | i2cBuff[28];
+ num_0p5_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[29]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+
+ stat = (i2cBuff[30] << 8) | i2cBuff[31];
+ num_1p0_m = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[32]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[33] << 8) | i2cBuff[34];
+ num_1p0_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[35]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+
+
+ stat = (i2cBuff[36] << 8) | i2cBuff[37];
+ num_2p5_m = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[38]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[39] << 8) | i2cBuff[40];
+ num_2p5_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[41]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+
+
+ stat = (i2cBuff[42] << 8) | i2cBuff[43];
+ num_4p0_m = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[44]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[45] << 8) | i2cBuff[46];
+ num_4p0_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[47]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+
+ stat = (i2cBuff[48] << 8) | i2cBuff[49];
+ num_10p0_m = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[50]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[51] << 8) | i2cBuff[52];
+ num_10p0_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[53]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+
+ stat = (i2cBuff[54] << 8) | i2cBuff[55];
+ typ_pm_size_m = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[56]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ stat = (i2cBuff[57] << 8) | i2cBuff[58];
+ typ_pm_size_l = stat;
+ dat = sps30::checkCrc2b(stat, i2cBuff[59]);
+ if(dat == SPScrcERROR) return SPScrcERROR;
+
+ mass_1p0_i = (mass_1p0_m << 16) | mass_1p0_l;
+ mass_2p5_i = (mass_2p5_m << 16) | mass_2p5_l;
+ mass_4p0_i = (mass_4p0_m << 16) | mass_4p0_l;
+ mass_10p0_i = (mass_10p0_m << 16) | mass_10p0_l;
+
+ num_0p5_i = (num_0p5_m << 16) | num_0p5_l;
+ num_1p0_i = (num_1p0_m << 16) | num_1p0_l;
+ num_2p5_i = (num_2p5_m << 16) | num_2p5_l;
+ num_4p0_i = (num_4p0_m << 16) | num_4p0_l;
+ num_10p0_i = (num_10p0_m << 16) | num_10p0_l;
+
+ typ_pm_size_i = (typ_pm_size_m << 16) | typ_pm_size_l;
+
+ mass_1p0_f = *(float*)&mass_1p0_i;
+ mass_2p5_f = *(float*)&mass_2p5_i;
+ mass_4p0_f = *(float*)&mass_4p0_i;
+ mass_10p0_f = *(float*)&mass_10p0_i;
+
+ num_0p5_f = *(float*)&num_0p5_i;
+ num_1p0_f = *(float*)&num_1p0_i;
+ num_2p5_f = *(float*)&num_2p5_i;
+ num_4p0_f = *(float*)&num_4p0_i;
+ num_10p0_f = *(float*)&num_10p0_i;
+
+ typ_pm_size_f = *(float*)&typ_pm_size_i;
+
+ return SPSnoERROR;
+}
+
+//-----------------------------------------------------------------------------
+// Calculate the CRC of a 2 byte value using the SPS30 CRC polynomial
+
+uint8_t sps30::calcCrc2b(uint16_t seed)
+{
+ uint8_t bit; // bit mask
+ uint8_t crc = SPS30_CRC_INIT; // calculated checksum
+
+ // calculates 8-Bit checksum with given polynomial
+
+ crc ^= (seed >> 8) & 255;
+ for(bit = 8; bit > 0; --bit)
+ {
+ if(crc & 0x80) crc = (crc << 1) ^ SPS30_POLYNOMIAL;
+ else crc = (crc << 1);
+ }
+
+ crc ^= seed & 255;
+ for(bit = 8; bit > 0; --bit)
+ {
+ if(crc & 0x80) crc = (crc << 1) ^ SPS30_POLYNOMIAL;
+ else crc = (crc << 1);
+ }
+
+ return crc;
+}
+
+//-----------------------------------------------------------------------------
+// Compare the CRC values
+
+uint8_t sps30::checkCrc2b(uint16_t seed, uint8_t crcIn)
+{
+ uint8_t crcCalc = sps30::calcCrc2b(seed);
+ if(crcCalc != crcIn) return SPScrcERROR;
+ return SPSnoERROR;
+}
+
+//-----------------------------------------------------------------------------
+// Get article code
+
+uint8_t sps30::getArticleCode()
+{
+ i2cBuff[0] = SPS30_CMMD_READ_ARTICLECODE >> 8;
+ i2cBuff[1] = SPS30_CMMD_READ_ARTICLECODE & 255;
+ int res = _i2c.write(SPS30_I2C_ADDR, i2cBuff, 2, false);
+ if(res) return SPSnoAckERROR;
+
+ int i = 0;
+ for(i = 0; i < sizeof(acode); i++) acode[i] = 0;
+ for(i = 0; i < sizeof(i2cBuff); i++) i2cBuff[i] = 0;
+
+ _i2c.read(SPS30_I2C_ADDR | 1, i2cBuff, SPS30_ACODE_SIZE, false);
+ int t = 0;
+ for(i = 0; i < SPS30_ACODE_SIZE; i +=3) {
+ uint16_t stat = (i2cBuff[i] << 8) | i2cBuff[i + 1];
+ acode[i - t] = stat >> 8;
+ acode[i - t + 1] = stat & 255;
+ uint8_t dat = sps30::checkCrc2b(stat, i2cBuff[i + 2]);
+ t++;
+ if(dat == SPScrcERROR) return SPScrcERROR;
+ if(stat == 0) break;
+ }
+
+ return SPSnoERROR;
+}
+
+//-----------------------------------------------------------------------------
+// Get sps30 serial number
+
+uint8_t sps30::getSerialNumber()
+{
+ i2cBuff[0] = SPS30_CMMD_READ_SERIALNBR >> 8;
+ i2cBuff[1] = SPS30_CMMD_READ_SERIALNBR & 255;
+ int res = _i2c.write(SPS30_I2C_ADDR, i2cBuff, 2, false);
+ if(res) return SPSnoAckERROR;
+
+ int i = 0;
+ for(i = 0; i < sizeof(sn); i++) sn[i] = 0;
+ for(i = 0; i < sizeof(i2cBuff); i++) i2cBuff[i] = 0;
+
+ _i2c.read(SPS30_I2C_ADDR | 1, i2cBuff, SPS30_SN_SIZE, false);
+ int t = 0;
+ for(i = 0; i < SPS30_SN_SIZE; i +=3) {
+ uint16_t stat = (i2cBuff[i] << 8) | i2cBuff[i + 1];
+ sn[i - t] = stat >> 8;
+ sn[i - t + 1] = stat & 255;
+ uint8_t dat = sps30::checkCrc2b(stat, i2cBuff[i + 2]);
+ t++;
+ if(dat == SPScrcERROR) return SPScrcERROR;
+ if(stat == 0) break;
+ }
+
+ return SPSnoERROR;
+}
+
+//-----------------------------------------------------------------------------
+// Perform a soft reset on the SPS30
+
+uint8_t sps30::softReset()
+{
+ i2cBuff[0] = SPS30_CMMD_SOFT_RESET >> 8;
+ i2cBuff[1] = SPS30_CMMD_SOFT_RESET & 255;
+ int res = _i2c.write(SPS30_I2C_ADDR, i2cBuff, 2, false);
+ if(res) return SPSnoAckERROR;
+ return SPSnoERROR;
+}
\ No newline at end of file