New_SAF40

DFRobot_SFA40.cpp

@@ -25,9 +25,23 @@ void DFRobot_SFA40::stopMeasurement(void){
 }
 
 uint8_t * DFRobot_SFA40::getSerialNumber(void){
-  memset(_buf,0,15);
-  readReg(SAF40_COMMAND_ID,_buf,15);
-  memcpy(serialNumber,_buf,10);
+  memset(_buf,0,9);
+  readReg(SAF40_COMMAND_ID,_buf,9);
+  uint8_t crcResult = 0;
+	uint8_t index = 0;  
+	for(int i = 0;i < 9;i+=3)
+	{
+		crcResult =  calcCrc(_buf+i,2);
+		if(crcResult == _buf[i+2])
+		{
+			serialNumber[index++] = _buf[i];
+			serialNumber[index++] = _buf[i+1];
+		}
+    else
+    {
+       return NULL;
+    }
+	}
   return serialNumber;
 }
 

DFRobot_SFA40.h

@@ -27,7 +27,7 @@
 #define SAF40_COMMAND_START      0x00AC 
 #define SAF40_COMMAND_READ       0xE06D 
 #define SAF40_COMMAND_STOP       0x50D2 
-#define SAF40_COMMAND_ID         0x0559 
+#define SAF40_COMMAND_ID         0x02CE
 #define SAF40_CRC_INITIAL_VALUE  0xFF
 #define SAF40_CRC_POLYNOMIAL     0x31
 #define SAF40_IIC_ADDRESS        0x5D

examples/getSensorData/getSensorData.ino

@@ -19,16 +19,24 @@ void setup() {
     Serial.print("failed,Not found SFA40!");
   }
   Serial.println("successed");
+  SFA40.stopMeasurement();
+  uint8_t* id = SFA40.getSerialNumber();
+  Serial.print("SerialNumber:");
+  if(id == NULL)
+  {
+    Serial.println("failed,getSerialNumber error!");
+  }
+  else
+  {
+    for(uint8_t i=0;i<6;i++)
+    {
+      Serial.print(id[i],HEX);
+      Serial.print(" ");
+    }
+  }
+  Serial.println();
   SFA40.startMeasurement();
-  //uint8_t* id = SFA40.getSerialNumber();
-  // Serial.print("SerialNumber:");
-  // for(uint8_t i=0;i<10;i++){
-  //   Serial.print(id[i]);
-  //   Serial.print(" ");
-  // }
-  // Serial.println();
-
-}
+  }
 
 void loop() {
   uint8_t status = SFA40.readMeasurementData();