refactor(hfp msbc decode):improve PLC and fix no sound issue when connect with win10 in hfp mode

@@ -688,8 +688,8 @@ void xa_msbc_dec_init (void)
 
 
   /* End second part */
   /* End second part */
 } /* end xa_param_file_process */
 } /* end xa_param_file_process */
-void xa_msbc_dec_frame(U8 *pInBuf, U16 inLen, U8 **pOutBuf, U32 *pOutDataLen) __attribute__ ((section (".internal_ram_1_text")));
-void xa_msbc_dec_frame(U8 *pInBuf, U16 inLen, U8 **pOutBuf, U32 *pOutDataLen)
+void xa_msbc_dec_frame(U8 *pInBuf, U16 inLen, U8 **pOutBuf, U32 *pOutDataLen, U8 loss_flag) __attribute__ ((section (".internal_ram_1_text")));
+void xa_msbc_dec_frame(U8 *pInBuf, U16 inLen, U8 **pOutBuf, U32 *pOutDataLen, U8 loss_flag)
 {
 {
   /* Error code */
   /* Error code */
   XA_ERRORCODE err_code = XA_NO_ERROR;
   XA_ERRORCODE err_code = XA_NO_ERROR;
@@ -709,8 +709,7 @@ void xa_msbc_dec_frame(U8 *pInBuf, U16 inLen, U8 **pOutBuf, U32 *pOutDataLen)
   p_xa_process_api = xa_msbc_dec;
   p_xa_process_api = xa_msbc_dec;
   p_proc_err_info = &xa_msbc_dec_error_info;
   p_proc_err_info = &xa_msbc_dec_error_info;
 
 
-
-    if (pInBuf[0] == 0xAD)
+    if (!loss_flag)
     {
     {
       //*pOutDataLen = 0;
       //*pOutDataLen = 0;
       //*pOutBuf = 0;
       //*pOutBuf = 0;

@@ -736,6 +736,9 @@ extern FIFO *hfp_upstream_fifo;
 #define HFP_PCM_FRAME_SIZE (120*2*3*2)
 #define HFP_PCM_FRAME_SIZE (120*2*3*2)
 #define HFP_mSBC_READ_SIZE 60
 #define HFP_mSBC_READ_SIZE 60
 
 
+U8 msbc_data_size;
+U8 last_sepuence;
+
 U8 *pmsbc;
 U8 *pmsbc;
 U8 *p48kpcm;
 U8 *p48kpcm;
 
 
@@ -753,6 +756,11 @@ void hfp_dec_init(void)
 
 
 	DBG_Printf("hfp dec init\n\r");
 	DBG_Printf("hfp dec init\n\r");
 
 
+
+	msbc_data_size = 0;
+
+	last_sepuence = 0xff;
+
 	app_main_data.audio_src_bit = AUDIO_SRC_16BIT;
 	app_main_data.audio_src_bit = AUDIO_SRC_16BIT;
 
 
 	app_main_data.playing_stream_chans = 2;
 	app_main_data.playing_stream_chans = 2;
@@ -844,6 +852,7 @@ int hfp_dec_decode(U8 **pout,U16 *plen)
 
 
 	if (hfp_get_codec() == 2)
 	if (hfp_get_codec() == 2)
 	{
 	{
+		/**********upstream part start*************/
 		fifo_put_data_by_dma (&AdcInFifo,DMA_2_DEST);
 		fifo_put_data_by_dma (&AdcInFifo,DMA_2_DEST);
 		
 		
 		dlen = fifo_get_fifo_data_len(&AdcInFifo);		
 		dlen = fifo_get_fifo_data_len(&AdcInFifo);		
@@ -892,12 +901,109 @@ int hfp_dec_decode(U8 **pout,U16 *plen)
 
 
 		fifo_put_data (hfp_upstream_fifo, pOutBuf,size);
 		fifo_put_data (hfp_upstream_fifo, pOutBuf,size);
 
 
+		/**********upstream part end*************/
+
+
+		/**********downstream part start*************/
+				
+		U8 sepuence;
+
 		dlen = AUDIO_FIFO_STREAM_DATA_LEN();
 		dlen = AUDIO_FIFO_STREAM_DATA_LEN();
 
 
 		if (dlen >= HFP_mSBC_READ_SIZE)
 		if (dlen >= HFP_mSBC_READ_SIZE)
 		{
 		{
-			dlen = AUDIO_FIFO_STREAM_GET_DATA(pmsbc, HFP_mSBC_READ_SIZE);
-			xa_msbc_dec_frame(pmsbc+2,57,&pOut,&outputsize);
+			dlen = AUDIO_FIFO_STREAM_GET_DATA(pmsbc + msbc_data_size, HFP_mSBC_READ_SIZE - msbc_data_size);
+			
+			sepuence = (pmsbc[1]&0xf0);
+
+			switch (sepuence)
+			{
+				case 0x0:
+					//sepuence = 0;
+					break;
+				case 0x30:
+					sepuence = 1;
+					break;
+				case 0xc0:
+					sepuence = 2;
+					break;
+				case 0xf0:
+					sepuence = 3;
+					break;
+				default :
+					sepuence = 0xff;
+					break;
+			}
+
+			if (last_sepuence == 0xff)
+				last_sepuence = sepuence;
+			else
+			{
+				last_sepuence++;
+				last_sepuence %= 4;
+			}
+
+			if (pmsbc[2] == 0xAD)
+			{
+				if (last_sepuence == sepuence)
+				{
+					msbc_data_size = 0;
+					xa_msbc_dec_frame(pmsbc+2,57,&pOut,&outputsize,FALSE);
+				}					
+				else
+				{
+					DBG_printf("sepuence number is discontinuous,should be %d, curr is %d\r\n",last_sepuence,sepuence);	
+					if (sepuence == 0xff)
+					{
+						//wrong sepuence number 
+						msbc_data_size = 0;
+						xa_msbc_dec_frame(pmsbc+2,57,&pOut,&outputsize,TRUE);					
+					}
+					else
+					{
+						msbc_data_size = 60;
+						xa_msbc_dec_frame(pmsbc+2,57,&pOut,&outputsize,TRUE);
+					}
+				}
+			}
+			else
+			{
+				//msbc sync data is wrong
+				xa_msbc_dec_frame(pmsbc+2,57,&pOut,&outputsize,TRUE);
+
+				for (i=0; i<(HFP_mSBC_READ_SIZE-2); i++) 
+				{ 			
+					if (pmsbc[i] == 1 && pmsbc[i+2] == 0xAD)
+					{
+						break;
+					}
+				}
+
+				if (i != (HFP_mSBC_READ_SIZE-2))
+				{
+					U8 start_p = i;
+
+					msbc_data_size = HFP_mSBC_READ_SIZE - i;
+					for (i=0; i<msbc_data_size; i++) 
+					{ 			
+						pmsbc[i] = pmsbc[i+start_p];
+					}
+
+				}
+				else
+				{
+					msbc_data_size = 0;	
+				}
+
+				//DBG_printf("msbc sync data is wrong\r\n");
+			}
+
+			if (outputsize != 240)
+			{
+				//outputsize not right,maybe is decode err
+				xa_msbc_dec_frame(pmsbc+2,57,&pOut,&outputsize,TRUE);
+				DBG_printf("decode err:%d\r\n",outputsize);
+			}
 		}
 		}
 		else
 		else
 		{
 		{
@@ -923,12 +1029,12 @@ int hfp_dec_decode(U8 **pout,U16 *plen)
 		}
 		}
 		else
 		else
 		{
 		{
-			DBG_Printf("msbc dec err\r\n");
 			memset(p48kpcm,0,HFP_PCM_FRAME_SIZE);
 			memset(p48kpcm,0,HFP_PCM_FRAME_SIZE);
 		}
 		}
-		//dec_direct_out(p48kpcm,HFP_PCM_FRAME_SIZE);
+
 		*pout = p48kpcm;
 		*pout = p48kpcm;
 		*plen = HFP_PCM_FRAME_SIZE;
 		*plen = HFP_PCM_FRAME_SIZE;
+		/**********downstream part end*************/
 
 
 		return DECODE_SUCCESS;		
 		return DECODE_SUCCESS;		
 	}
 	}

@@ -2336,7 +2336,7 @@ U32 app_dec_hfp_stream_write(U8 *ptr, U32 len)
 		//codec err, dead???
 		//codec err, dead???
 
 
 		//codec err, dead???
 		//codec err, dead???
-		//ukMsgSend(app_nav_codec_reinit);
+		ukMsgSend(app_nav_bt_codec_reinit);
 		//return;
 		//return;
 	}
 	}