#include "MCU_Core_Protocol.h"
#include <string.h>
#include <stdlib.h>
#include <stdio.h>
#include "Protocol_User.h"
#include "gatts_table_creat_demo.h"

#include "app_Ble_User.h"

void Uart_ID10_process(void)
{
    if(1)
    {
        uint8_t ID10[2] = {0x00,0x01};
        Protocol_Send(0x21,ID10,2);
    }
    else
    {
        uint8_t ID10[2] = {0x00,0x01};
        Protocol_Send(0x10,ID10,2);
    }
}


void Uart_ID01_process(void)
{
        uint8_t ID01[6] = {0x00,0x00,0x00,0x00,0x00,0x00};

        if(Ble_Sts_Ctrl.Navi_Updat)
        {   
            ID01[0] = Ble_Navi_Data.Navi_Sts;
            ID01[1] = Ble_Navi_Data.Navi_Turn;//赋值为蓝牙收到的转向编码值
            ID01[2] = Ble_Navi_Data.Navi_Dte[0];
            ID01[3] = Ble_Navi_Data.Navi_Dte[1];
            ID01[4] = Ble_Navi_Data.Navi_Dte[2];
            ID01[5] = Ble_Navi_Data.Navi_Dte[3];

        }
        
        Protocol_Send(0x01,ID01,6);
}


void Uart_ID12_process(void)
{
    uint8_t ID12[2] = {0x00,0x00};
    ID12[1] =  Ble_Sts_Ctrl.Ble_Sts;
    Protocol_Send(0x12,ID12,2);
}

void Uart_ID20_process(void)
{
    //开始正式通信
    
}

unsigned char ID21_num = 0;
void Uart_ID21_process(void)//底板给ESP32发
{
    if (1)
    {
        ID21_num++;
    }
    printf("ID21 IS %d!!!\r\n",ID21_num);

}



void MCU_T_32(void)
{
    // printf("MCU_T_32!!\r\n");
    Protocol_Service();
    if(ID21_num >= 5)
    {
        ID21_num = 0;
        //ESP32需要升级
        
    }

}