CHECKSUM CREATE,CHECK 함수 추가 / MBIC/SETGET 분리작업

Bluecell_Inc/Bluecell_operate.h

@@ -80,10 +80,10 @@ typedef enum{
 	MBIC_TIME_5,
 	MBIC_ERRRESPONSE_0,
 	MBIC_CMD_0,
+	
 	MBIC_LENGTH_0, // 19INDEX
-
-    
 	MBIC_LENGTH_1, // 20
+
 	MBIC_HEADERCHECKSUM_0,
 	MBIC_PAYLOADSTART,
 	/*
@@ -224,7 +224,7 @@ ULO_Shutdown_Alarm4,
 
 
 
-
+#define MBIC_HEADER_SIZE 18
 #define MBIC_PREAMBLE0 0x16
 #define MBIC_PREAMBLE1 0x16
 #define MBIC_PREAMBLE2 0x16
@@ -236,7 +236,7 @@ ULO_Shutdown_Alarm4,
 #define MBIC_SEQNUM
 #define MBIC_TTL
 #define MBIC_TIME
-#define MBIC_ERRRESPONSE
+#define MBIC_ERRRESPONSE 0x00
 #define MBIC_CMD
 #define MBIC_LENGTH
 #define MBIC_CHECKSHUM
@@ -534,6 +534,38 @@ typedef struct{
     uint8_t bluecell_User_UL4_H;  uint8_t bluecell_User_UL4_L;
     uint8_t bluecell_User_TEMP_H;  uint8_t bluecell_User_TEMP_L;
     uint8_t bluecell_User_TEMP_OFFSET_H;  uint8_t bluecell_User_TEMP_OFFSET_L;    
+    uint8_t Temp_High_Threshold;
+    uint8_t Temp_High_Threshold_Default;
+    uint8_t Reserved_Data3;
+    uint8_t Reserved_Data4;
+    uint8_t Reserved_Data5;
+    uint8_t Reserved_Data6;
+    uint8_t Reserved_Data7;
+    uint8_t Reserved_Data8;
+    uint8_t Reserved_Data9;
+    uint8_t Reserved_Data10;
+    uint8_t Reserved_Data11;
+    uint8_t Reserved_Data12;
+    uint8_t Reserved_Data13;
+    uint8_t Reserved_Data14;
+    uint8_t Reserved_Data15;
+    uint8_t Reserved_Data16;
+    uint8_t Reserved_Data17;
+    uint8_t Reserved_Data18;
+    uint8_t Reserved_Data19;
+    uint8_t Reserved_Data20;
+    uint8_t Reserved_Data21;
+    uint8_t Reserved_Data22;
+    uint8_t Reserved_Data23;
+    uint8_t Reserved_Data24;
+    uint8_t Reserved_Data25;
+    uint8_t Reserved_Data26;
+    uint8_t Reserved_Data27;
+    uint8_t Reserved_Data28;
+    uint8_t Reserved_Data29;
+    uint8_t Reserved_Data30;
+    uint8_t Reserved_Data31;
+    uint8_t Reserved_Data32;
     uint8_t bluecell_crc;
     uint8_t bluecell_etx;
 

Bluecell_Src/Bluecell_operate.c

@@ -1455,142 +1455,299 @@ uint8_t* MBIC_HeaderDataSetting(uint8_t* data){
 	ResultData[MBIC_TIME_4] = data[MBIC_TIME_4];
 	ResultData[MBIC_TIME_5] = data[MBIC_TIME_5];
 
+    ResultData[MBIC_ERRRESPONSE_0] = MBIC_ERRRESPONSE;
+
+    ResultData[MBIC_CMD_0] = MBIC_ERRRESPONSE;
+
+    ResultData[MBIC_LENGTH_0] = MBIC_ERRRESPONSE;    
+    ResultData[MBIC_LENGTH_1] = MBIC_ERRRESPONSE;        
+
+    ResultData[MBIC_HEADERCHECKSUM_0] = Chksum_Create(ResultData,MBIC_HEADER_SIZE - 1,);    
+
 	return ResultData;
 }
 
-
+typedef enum{
+    MBIC_GET = 0,
+    MBIC_SET,        
+}BMBM_CMD;
 
 bool MBIC_Operate(uint8_t* data){
-	uint16_t datatype = 0;
-    uint8_t Length = 0;
+	uint16_t datatype = (((data[MBIC_PROT_SUB_DATA_INDEX] << 8) & 0xFF00)  // 2byte Data
+              |((data[MBIC_PROT_SUB_DATA_INDEX + 1] << 8) & 0x00FF) );
+    uint8_t Length = (data[MBIC_PROT_SUB_DATA_INDEX + 2]);
+    uint8_t cmd = 0;
     uint8_t SubData[256] = {0,};
     /*AID*/
-    datatype = ((data[MBIC_PROT_SUB_DATA_INDEX] << 8) & 0xFF00)  // 2byte Data
-              |((data[MBIC_PROT_SUB_DATA_INDEX + 1] << 8) & 0x00FF) ;
-    Length = (data[MBIC_PROT_SUB_DATA_INDEX + 2]);
     for(int i = 0; i < Length; i++){
         SubData[i] = (data[MBIC_PROT_SUB_DATA_INDEX + 3 + i]);
     }
     //    SubData     임시 데이터 변수 선언 Subdata로 데이터 전송 
-    
-	switch(datatype){
-        case  Alarm_Bit_List                          :break;
-        case  Alarm_Mask                              :break;
-        case  Alarm_Test_Mode                         :break;
-        case  Alarm_Test_Dummy                        :break;
-        case  CPU_Version                             :break;
-        case  ModuleINFORMATION_null1                 :break;
-        case  CPU_Current_Bank                        :break;
-        case  CPU_Bank_Select_Reboot_by               :break;
-        case  CPU_Bank1_Image_Version                 :break;
-        case  CPU_Bank1_Image_BuildTime               :break;
-        case  CPU_Bank1_Image_Name                    :break;
-        case  CPU_Bank2_Image_Version                 :break;
-        case  CPU_Bank2_Image_BuildTime               :break;
-        case  CPU_Bank2_Image_Name                    :break;
-        case  SW_Reset                                :break;
-        case  Factory_Set_Initialization              :break;
-        case  Temperature                     :break;
-        case  Temperature_Offset                      :break;
-        case  Temp_High_Threshold                     :break;
-        case  Temp_High_Threshold_Default             :break;
-        case  Temp_High_Alarm                         :break;
-        case  LED_TEST                                :break;
-        case  Node                                    :break;
-        case  Type                                    :break;
-        case  PCB_Version                             :break;
-        case  Serial_Number                           :break;
-        case  Manufacture                             :break;
-        case  Manufacture_Date                        :break;
-        case  ENVIRONMENT_INVENTORY_NULL0             :break;
-        case  Freq_ID                                 :break;
-        case  Carrier_ID                              :break;
-        case  Carrier_ON_OFF                          :break;
-        case  DLI_P1_Level                    :break;
-        case  DLI_P2_Level                            :break;
-        case  DLI_P3_Level                            :break;
-        case  DLI_P4_Level                            :break;
-        case  ULO_P1_Level                            :break;
-        case  ULO_P2_Level                            :break;
-        case  ULO_P3_Level                            :break;
-        case  ULO_P4_Level                            :break;
-        case  DLI_RF_Path1_ON_OFF             :break;
-        case  DLI_RF_Path2_ON_OFF                     :break;
-        case  DLI_RF_Path3_ON_OFF                     :break;
-        case  DLI_RF_Path4_ON_OFF                     :break;
-        case  DLI_Gain_Atten1                         :break;
-        case  DLI_Gain_Atten2                         :break;
-        case  DLI_Gain_Atten3                         :break;
-        case  DLI_Gain_Atten4                         :break;
-        case  DLI_Gain_Atten_Offset1                  :break;
-        case  DLI_Gain_Atten_Offset2                  :break;
-        case  DLI_Gain_Atten_Offset3                  :break;
-        case  DLI_Gain_Atten_Offset4                  :break;
-        case  DLI_Level_High_Threshold                :break;
-        case  DLI_Level_Low_Threshold                 :break;
-        case  DLI_Level_High_Low_Threshold_default    :break;
-        case  DLI_Level                               :break;
-        case  DLI_Level_High_Alarm1            :break;
-        case  DLI_Level_High_Alarm2                   :break;
-        case  DLI_Level_High_Alarm3                   :break;
-        case  DLI_Level_High_Alarm4                   :break;
-        case  DLI_Level_Low_Alarm1                    :break;
-        case  DLI_Level_Low_Alarm2                    :break;
-        case  DLI_Level_Low_Alarm3                    :break;
-        case  DLI_Level_Low_Alarm4                    :break;
-        case  DLI_AGC_ON_OFF                   :break;
-        case  DLI_AGC_Threshold                       :break;
-        case  DLI_AGC_Threshold_Default               :break;
-        case  DLI_Shutdown_ON_OFF                     :break;
-        case  DLI_Shutdown_Threshold                  :break;
-        case  DLI_Shutdown_Threshold_Default          :break;
-        case  DLI_Shutdown_Count                      :break;
-        case  DLI_AGC_Alarm1                          :break;
-        case  DLI_AGC_Alarm2                          :break;
-        case  DLI_AGC_Alarm3                          :break;
-        case  DLI_AGC_Alarm4                          :break;
-        case  DLI_Shutdown_Alarm1                     :break;
-        case  DLI_Shutdown_Alarm2                     :break;
-        case  DLI_Shutdown_Alarm3                     :break;
-        case  DLI_Shutdown_Alarm4                     :break;
-        case  ULO_RF_Path1_ON_OFF1            :break;
-        case  ULO_RF_Path2_ON_OFF2                    :break;
-        case  ULO_RF_Path3_ON_OFF3                    :break;
-        case  ULO_RF_Path4_ON_OFF4                    :break;
-        case  ULO_Gain_Atten1                         :break;
-        case  ULO_Gain_Atten2                         :break;
-        case  ULO_Gain_Atten3                         :break;
-        case  ULO_Gain_Atten4                         :break;
-        case  ULO_Gain_Atten_Offset1                  :break;
-        case  ULO_Gain_Atten_Offset2                  :break;
-        case  ULO_Gain_Atten_Offset3                  :break;
-        case  ULO_Gain_Atten_Offset4                  :break;
-        case  ULO_Level_High_Threshold                :break;
-        case  SERIAL_UL_NULL0                         :break;
-        case  ULO_Level_High_Threshold_default        :break;
-        case  ULO_Level                               :break;
-        case  ULO_Level_High_Alarm1             :break;
-        case  ULO_Level_High_Alarm2                   :break;
-        case  ULO_Level_High_Alarm3                  :break;
-        case  ULO_Level_High_Alarm4                  :break;
-        case  SERIAL_UL_NULL1                         :break;
-        case  ULO_ALC_ON_OFF                   :break;
-        case  ULO_ALC_Threshold                       :break;
-        case  ULO_ALC_Threshold_Default               :break;
-        case  ULO_Shutdown_ON_OFF                     :break;
-        case  ULO_Shutdown_Threshold                  :break;
-        case  ULO_Shutdown_Threshold_Default          :break;
-        case  ULO_Shutdown_Retry_Count                :break;
-        case  ULO_ALC_Alarm1                          :break;
-        case  ULO_ALC_Alarm2                          :break;
-        case  ULO_ALC_Alarm3                          :break;
-        case  ULO_ALC_Alarm4                          :break;
-        case  ULO_Shutdown_Alarm1                     :break;
-        case  ULO_Shutdown_Alarm2                     :break;
-        case  ULO_Shutdown_Alarm3                     :break;
-        case  ULO_Shutdown_Alarm4                     :break;
-
-	}
+    if(cmd == MBIC_GET){
+    	switch(datatype){
+                case  Alarm_Bit_List                          :
+//                    
+                    break;
+                case  Alarm_Mask                              :
+                    
+                    break;
+                case  Alarm_Test_Mode                         :
+
+                    break;
+                case  Alarm_Test_Dummy                        :
+
+                    break;
+                case  CPU_Version                             :
+
+                    break;
+                case  ModuleINFORMATION_null1                 :
+
+                    break;
+                case  CPU_Current_Bank                        :
+
+                    break;
+                case  CPU_Bank_Select_Reboot_by               :
+
+                    break;
+                case  CPU_Bank1_Image_Version                 :
+
+                    break;
+                case  CPU_Bank1_Image_BuildTime               :break;
+                case  CPU_Bank1_Image_Name                    :break;
+                case  CPU_Bank2_Image_Version                 :break;
+                case  CPU_Bank2_Image_BuildTime               :break;
+                case  CPU_Bank2_Image_Name                    :break;
+                case  SW_Reset                                :break;
+                case  Factory_Set_Initialization              :break;
+                case  Temperature                             :break;
+                case  Temperature_Offset                      :break;
+                case  Temp_High_Threshold                     :
+                    ResultData[MBIC_PAYLOADSTART] = bluecell_Currdatastatus.Temp_High_Threshold;
+                break;
+                case  Temp_High_Threshold_Default             :
+                    ResultData[MBIC_PAYLOADSTART] = bluecell_Currdatastatus.Temp_High_Threshold_Default;
+                break;
+                case  Temp_High_Alarm                         :break;
+                case  LED_TEST                                :break;
+                case  Node                                    :break;
+                case  Type                                    :break;
+                case  PCB_Version                             :break;
+                case  Serial_Number                           :break;
+                case  Manufacture                             :break;
+                case  Manufacture_Date                        :break;
+                case  ENVIRONMENT_INVENTORY_NULL0             :break;
+                case  Freq_ID                                 :break;
+                case  Carrier_ID                              :break;
+                case  Carrier_ON_OFF                          :break;
+                case  DLI_P1_Level                    :break;
+                case  DLI_P2_Level                            :break;
+                case  DLI_P3_Level                            :break;
+                case  DLI_P4_Level                            :break;
+                case  ULO_P1_Level                            :break;
+                case  ULO_P2_Level                            :break;
+                case  ULO_P3_Level                            :break;
+                case  ULO_P4_Level                            :break;
+                case  DLI_RF_Path1_ON_OFF             :break;
+                case  DLI_RF_Path2_ON_OFF                     :break;
+                case  DLI_RF_Path3_ON_OFF                     :break;
+                case  DLI_RF_Path4_ON_OFF                     :break;
+                case  DLI_Gain_Atten1                         :break;
+                case  DLI_Gain_Atten2                         :break;
+                case  DLI_Gain_Atten3                         :break;
+                case  DLI_Gain_Atten4                         :break;
+                case  DLI_Gain_Atten_Offset1                  :break;
+                case  DLI_Gain_Atten_Offset2                  :break;
+                case  DLI_Gain_Atten_Offset3                  :break;
+                case  DLI_Gain_Atten_Offset4                  :break;
+                case  DLI_Level_High_Threshold                :break;
+                case  DLI_Level_Low_Threshold                 :break;
+                case  DLI_Level_High_Low_Threshold_default    :break;
+                case  DLI_Level                               :break;
+                case  DLI_Level_High_Alarm1            :break;
+                case  DLI_Level_High_Alarm2                   :break;
+                case  DLI_Level_High_Alarm3                   :break;
+                case  DLI_Level_High_Alarm4                   :break;
+                case  DLI_Level_Low_Alarm1                    :break;
+                case  DLI_Level_Low_Alarm2                    :break;
+                case  DLI_Level_Low_Alarm3                    :break;
+                case  DLI_Level_Low_Alarm4                    :break;
+                case  DLI_AGC_ON_OFF                   :break;
+                case  DLI_AGC_Threshold                       :break;
+                case  DLI_AGC_Threshold_Default               :break;
+                case  DLI_Shutdown_ON_OFF                     :break;
+                case  DLI_Shutdown_Threshold                  :break;
+                case  DLI_Shutdown_Threshold_Default          :break;
+                case  DLI_Shutdown_Count                      :break;
+                case  DLI_AGC_Alarm1                          :break;
+                case  DLI_AGC_Alarm2                          :break;
+                case  DLI_AGC_Alarm3                          :break;
+                case  DLI_AGC_Alarm4                          :break;
+                case  DLI_Shutdown_Alarm1                     :break;
+                case  DLI_Shutdown_Alarm2                     :break;
+                case  DLI_Shutdown_Alarm3                     :break;
+                case  DLI_Shutdown_Alarm4                     :break;
+                case  ULO_RF_Path1_ON_OFF1            :break;
+                case  ULO_RF_Path2_ON_OFF2                    :break;
+                case  ULO_RF_Path3_ON_OFF3                    :break;
+                case  ULO_RF_Path4_ON_OFF4                    :break;
+                case  ULO_Gain_Atten1                         :break;
+                case  ULO_Gain_Atten2                         :break;
+                case  ULO_Gain_Atten3                         :break;
+                case  ULO_Gain_Atten4                         :break;
+                case  ULO_Gain_Atten_Offset1                  :break;
+                case  ULO_Gain_Atten_Offset2                  :break;
+                case  ULO_Gain_Atten_Offset3                  :break;
+                case  ULO_Gain_Atten_Offset4                  :break;
+                case  ULO_Level_High_Threshold                :break;
+                case  SERIAL_UL_NULL0                         :break;
+                case  ULO_Level_High_Threshold_default        :break;
+                case  ULO_Level                               :break;
+                case  ULO_Level_High_Alarm1             :break;
+                case  ULO_Level_High_Alarm2                   :break;
+                case  ULO_Level_High_Alarm3                  :break;
+                case  ULO_Level_High_Alarm4                  :break;
+                case  SERIAL_UL_NULL1                         :break;
+                case  ULO_ALC_ON_OFF                   :break;
+                case  ULO_ALC_Threshold                       :break;
+                case  ULO_ALC_Threshold_Default               :break;
+                case  ULO_Shutdown_ON_OFF                     :break;
+                case  ULO_Shutdown_Threshold                  :break;
+                case  ULO_Shutdown_Threshold_Default          :break;
+                case  ULO_Shutdown_Retry_Count                :break;
+                case  ULO_ALC_Alarm1                          :break;
+                case  ULO_ALC_Alarm2                          :break;
+                case  ULO_ALC_Alarm3                          :break;
+                case  ULO_ALC_Alarm4                          :break;
+                case  ULO_Shutdown_Alarm1                     :break;
+                case  ULO_Shutdown_Alarm2                     :break;
+                case  ULO_Shutdown_Alarm3                     :break;
+                case  ULO_Shutdown_Alarm4                     :break;
+
+    	    }
+        }
+        else if(cmd == MBIC_SET){
+            switch(datatype){
+                case  Alarm_Bit_List                          :break;
+                case  Alarm_Mask                              :break;
+                case  Alarm_Test_Mode                         :break;
+                case  Alarm_Test_Dummy                        :break;
+                case  CPU_Version                             :break;
+                case  ModuleINFORMATION_null1                 :break;
+                case  CPU_Current_Bank                        :break;
+                case  CPU_Bank_Select_Reboot_by               :break;
+                case  CPU_Bank1_Image_Version                 :break;
+                case  CPU_Bank1_Image_BuildTime               :break;
+                case  CPU_Bank1_Image_Name                    :break;
+                case  CPU_Bank2_Image_Version                 :break;
+                case  CPU_Bank2_Image_BuildTime               :break;
+                case  CPU_Bank2_Image_Name                    :break;
+                case  SW_Reset                                :break;
+                case  Factory_Set_Initialization              :break;
+                case  Temperature                     :break;
+                case  Temperature_Offset                      :break;
+                case  Temp_High_Threshold                     :break;
+                case  Temp_High_Threshold_Default             :break;
+                case  Temp_High_Alarm                         :break;
+                case  LED_TEST                                :break;
+                case  Node                                    :break;
+                case  Type                                    :break;
+                case  PCB_Version                             :break;
+                case  Serial_Number                           :break;
+                case  Manufacture                             :break;
+                case  Manufacture_Date                        :break;
+                case  ENVIRONMENT_INVENTORY_NULL0             :break;
+                case  Freq_ID                                 :break;
+                case  Carrier_ID                              :break;
+                case  Carrier_ON_OFF                          :break;
+                case  DLI_P1_Level                    :break;
+                case  DLI_P2_Level                            :break;
+                case  DLI_P3_Level                            :break;
+                case  DLI_P4_Level                            :break;
+                case  ULO_P1_Level                            :break;
+                case  ULO_P2_Level                            :break;
+                case  ULO_P3_Level                            :break;
+                case  ULO_P4_Level                            :break;
+                case  DLI_RF_Path1_ON_OFF             :break;
+                case  DLI_RF_Path2_ON_OFF                     :break;
+                case  DLI_RF_Path3_ON_OFF                     :break;
+                case  DLI_RF_Path4_ON_OFF                     :break;
+                case  DLI_Gain_Atten1                         :break;
+                case  DLI_Gain_Atten2                         :break;
+                case  DLI_Gain_Atten3                         :break;
+                case  DLI_Gain_Atten4                         :break;
+                case  DLI_Gain_Atten_Offset1                  :break;
+                case  DLI_Gain_Atten_Offset2                  :break;
+                case  DLI_Gain_Atten_Offset3                  :break;
+                case  DLI_Gain_Atten_Offset4                  :break;
+                case  DLI_Level_High_Threshold                :break;
+                case  DLI_Level_Low_Threshold                 :break;
+                case  DLI_Level_High_Low_Threshold_default    :break;
+                case  DLI_Level                               :break;
+                case  DLI_Level_High_Alarm1            :break;
+                case  DLI_Level_High_Alarm2                   :break;
+                case  DLI_Level_High_Alarm3                   :break;
+                case  DLI_Level_High_Alarm4                   :break;
+                case  DLI_Level_Low_Alarm1                    :break;
+                case  DLI_Level_Low_Alarm2                    :break;
+                case  DLI_Level_Low_Alarm3                    :break;
+                case  DLI_Level_Low_Alarm4                    :break;
+                case  DLI_AGC_ON_OFF                   :break;
+                case  DLI_AGC_Threshold                       :break;
+                case  DLI_AGC_Threshold_Default               :break;
+                case  DLI_Shutdown_ON_OFF                     :break;
+                case  DLI_Shutdown_Threshold                  :break;
+                case  DLI_Shutdown_Threshold_Default          :break;
+                case  DLI_Shutdown_Count                      :break;
+                case  DLI_AGC_Alarm1                          :break;
+                case  DLI_AGC_Alarm2                          :break;
+                case  DLI_AGC_Alarm3                          :break;
+                case  DLI_AGC_Alarm4                          :break;
+                case  DLI_Shutdown_Alarm1                     :break;
+                case  DLI_Shutdown_Alarm2                     :break;
+                case  DLI_Shutdown_Alarm3                     :break;
+                case  DLI_Shutdown_Alarm4                     :break;
+                case  ULO_RF_Path1_ON_OFF1            :break;
+                case  ULO_RF_Path2_ON_OFF2                    :break;
+                case  ULO_RF_Path3_ON_OFF3                    :break;
+                case  ULO_RF_Path4_ON_OFF4                    :break;
+                case  ULO_Gain_Atten1                         :break;
+                case  ULO_Gain_Atten2                         :break;
+                case  ULO_Gain_Atten3                         :break;
+                case  ULO_Gain_Atten4                         :break;
+                case  ULO_Gain_Atten_Offset1                  :break;
+                case  ULO_Gain_Atten_Offset2                  :break;
+                case  ULO_Gain_Atten_Offset3                  :break;
+                case  ULO_Gain_Atten_Offset4                  :break;
+                case  ULO_Level_High_Threshold                :break;
+                case  SERIAL_UL_NULL0                         :break;
+                case  ULO_Level_High_Threshold_default        :break;
+                case  ULO_Level                               :break;
+                case  ULO_Level_High_Alarm1             :break;
+                case  ULO_Level_High_Alarm2                   :break;
+                case  ULO_Level_High_Alarm3                  :break;
+                case  ULO_Level_High_Alarm4                  :break;
+                case  SERIAL_UL_NULL1                         :break;
+                case  ULO_ALC_ON_OFF                   :break;
+                case  ULO_ALC_Threshold                       :break;
+                case  ULO_ALC_Threshold_Default               :break;
+                case  ULO_Shutdown_ON_OFF                     :break;
+                case  ULO_Shutdown_Threshold                  :break;
+                case  ULO_Shutdown_Threshold_Default          :break;
+                case  ULO_Shutdown_Retry_Count                :break;
+                case  ULO_ALC_Alarm1                          :break;
+                case  ULO_ALC_Alarm2                          :break;
+                case  ULO_ALC_Alarm3                          :break;
+                case  ULO_ALC_Alarm4                          :break;
+                case  ULO_Shutdown_Alarm1                     :break;
+                case  ULO_Shutdown_Alarm2                     :break;
+                case  ULO_Shutdown_Alarm3                     :break;
+                case  ULO_Shutdown_Alarm4                     :break;
+            }
+        }
+        else{
+            /*NOP*/
+            printf("DATA ERR\r\n");
+        }
 	return true;
 }
 

Bluecell_Src/CRC.c

@@ -122,10 +122,35 @@ etError STH30_CheckCrc(uint8_t *data, uint8_t nbrOfBytes, uint8_t checksum)
 
 
 
-uint8_t chksum(uint8_t c, uint8_t v)
+
+
+bool Chksum_Check(uint8_t *data, uint32_t leng,uint8_t chkdata)
 {
-    return (uint8_t)(c + v);
+   uint8_t dataret = 0;
+   bool ret = false;
+   for(int i = 0; i < leng; i++){
+        dataret += data[i];
+   }
+   if(dataret == chkdata){
+        ret = true;
+   }
+    
+    return ret;
 }
+uint8_t Chksum_Create(uint8_t *data, uint32_t leng)
+{
+   uint8_t dataret = 0;
+   bool ret = false;
+   for(int i = 0; i < leng; i++){
+        dataret += data[i];
+   }
+   if(dataret == chkdata){
+        ret = true;
+   }
+    
+    return ret;
+}
+
 
 static
 const uint16_t crc16_tab[256] = {

Bluecell_Src/uart.c

@@ -73,7 +73,7 @@ void GetDataFromUartQueue(UART_HandleTypeDef *huart)
 //    }
     uart_buf[cnt++] = *(pQueue->Buffer + pQueue->tail); 
 //#ifdef DEBUG_PRINT
-    printf("%02x ",*(pQueue->Buffer + pQueue->tail)) ;
+//    printf("%02x ",*(pQueue->Buffer + pQueue->tail)) ;
 //#endif /* DEBUG_PRINT */
 
     pQueue->tail++;
@@ -96,7 +96,10 @@ void GetDataFromUartQueue(UART_HandleTypeDef *huart)
                    &&uart_buf[1] == MBIC_PREAMBLE1
                    &&uart_buf[2] == MBIC_PREAMBLE2
                    &&uart_buf[3] == MBIC_PREAMBLE3){
-                MBIC_Operate(uart_buf);
+               if(Chksum_Check(uart_buf,MBIC_HEADER_SIZE - 1, uart_buf[MBIC_CHECKSHUM]) == true)
+                    MBIC_Operate(uart_buf);
+               else
+                    printf("CHECK SUM ERR \r\n");
             }
         memset(uart_buf,0x00,cnt);
 //        for(int i  = 0; i < cnt; i++)

Src/main.c

@@ -681,7 +681,7 @@ static void MX_USART1_UART_Init(void)
 
   /* USER CODE END USART1_Init 1 */
   huart1.Instance = USART1;
-  huart1.Init.BaudRate = 921600;
+  huart1.Init.BaudRate = 115200;
   huart1.Init.WordLength = UART_WORDLENGTH_8B;
   huart1.Init.StopBits = UART_STOPBITS_1;
   huart1.Init.Parity = UART_PARITY_NONE;