MBIC Header 추가 부분 추가

Src/MBIC_Bootloader.c

@@ -126,6 +126,52 @@ BootLoaderDataCheck_st MBIC_FileDataCheck(uint8_t* data){
 }
 
 
+uint8_t* MBIC_HeaderMergeFunction(uint8_t* data, uint32_t CrcIndex)
+{
+    byte[] ret = new byte[data.Length + 22 + 3];
+    UInt16 CRCData = CRC16_Generate(data,data.Length);
+
+    ret[(int)MBICProt_st.MBIC_PAYLOADSTART + CrcIndex + 0] = Convert.ToByte((CRCData & 0xFF00) >> 8);
+    ret[(int)MBICProt_st.MBIC_PAYLOADSTART + CrcIndex + 1] = Convert.ToByte((CRCData & 0x00FF));
+    ret[(int)MBICProt_st.MBIC_PAYLOADSTART + CrcIndex + 2] = 0x03;
+
+    ret[(int)MBICProt_st.MBIC_PREAMBLE_0] = MBIC_PREAMBLE0;
+    ret[(int)MBICProt_st.MBIC_PREAMBLE_1] = MBIC_PREAMBLE1;
+    ret[(int)MBICProt_st.MBIC_PREAMBLE_2] = MBIC_PREAMBLE2;
+    ret[(int)MBICProt_st.MBIC_PREAMBLE_3] = MBIC_PREAMBLE3;
+
+    ret[(int)MBICProt_st.MBIC_SUBUID_0] = MBIC_SUBUID0;
+    ret[(int)MBICProt_st.MBIC_SUBUID_1] = MBIC_SUBUID1;
+
+    ret[(int)MBICProt_st.MBIC_RCODE_0] = 0;
+
+    ret[(int)MBICProt_st.MBIC_TRID_0] = 0;
+    ret[(int)MBICProt_st.MBIC_TRID_1] = 0;
+
+    ret[(int)MBICProt_st.MBIC_SEQSUM_0] = 0;
+
+    ret[(int)MBICProt_st.MBIC_TTL_0] = 0;
+
+    ret[(int)MBICProt_st.MBIC_TIME_0] = 0;
+    ret[(int)MBICProt_st.MBIC_TIME_1] = 0;
+    ret[(int)MBICProt_st.MBIC_TIME_2] = 0;
+    ret[(int)MBICProt_st.MBIC_TIME_3] = 0;
+    ret[(int)MBICProt_st.MBIC_TIME_4] = 0;
+    ret[(int)MBICProt_st.MBIC_TIME_5] = 0;
+    ret[(int)MBICProt_st.MBIC_ERRRESPONSE_0] = MBIC_ERRRESPONSE;
+
+    ret[(int)MBICProt_st.MBIC_CMD_0] = MBIC_ERRRESPONSE;
+
+    ret[(int)MBICProt_st.MBIC_LENGTH_0] = MBIC_ERRRESPONSE;
+    ret[(int)MBICProt_st.MBIC_LENGTH_1] = MBIC_ERRRESPONSE;
+
+    ret[(int)MBICProt_st.MBIC_HEADERCHECKSUM_0] = Chksum_Create(ret);
+
+    for(int i = 0; i < data.Length; i ++)
+        ret[(int)MBICProt_st.MBIC_PAYLOADSTART + i] = data[i];
+
+    return ret;
+}
 
 void MBIC_Bootloader_FirmwareUpdate(uint8_t* data){
     uint8_t datatype = data[MBIC_PAYLOADSTART];
@@ -143,11 +189,11 @@ void MBIC_Bootloader_FirmwareUpdate(uint8_t* data){
         0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
         0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
     };
-    MBIC_FileDataCheck(dataTest);
     
 #endif // PYJ.2020.06.04_END -- 
+    MBIC_FileDataCheck(&data[MBIC_PAYLOADSTART]);
 
-
+    
 //    printf("RX");
 //    for(int i = 0; i < 128; i++)
 //        printf("%c",*data++);