/*
 * WESPION_BLE.c
 *
 *  Created on: 2023. 6. 29.
 *      Author: JuHyung
 */

#include "WESPION.h"

uint8_t ATcommd=0;
uint16_t MainCnt=0;
//uint8_t uart3_RxBuf[MAX_RXBUFFER_SIZE_UART3];
uint8_t uart3_RxBufSize=0;
uint8_t uart3_MsgMode=0;

void MyBLErun(void)
{
//  if(!UART_Available(&huart3)){
//  }
//    else{
//      uint8_t BufC=0;
//      while(BufC!=64){
//      uart3_RxBuf[BufC++] = 0;
//    }
//    uart3_RxBufSize = UART_SumData(&huart3, uart3_RxBuf);
//
//    MyBLEFunc(uart3_RxBuf, uart3_RxBufSize);
//  }
//
//  HAL_Delay(10);
}


void MyBLEFunc(uint8_t *pData, uint8_t pSize)
{
//  uint8_t str0[] = "WP+";
//  uint8_t str1[] = "Speed";
//  uint8_t str1_1[] = "Send";
//  uint8_t str1_2[] = "Stop";
//
//  uint8_t str99[] = "OK!";
//  uint8_t str99_1[] = "Go!";
//  uint8_t str99_2[] = "Stop...";
//  uint8_t str100[] = "ERROR!";
//  uint8_t str100_1[] = "Error Commend";
//  uint8_t str100_2[] = "Error Mode";
//
//  //    UART_printf("f:%dHz, p:%d%%\n\r",fre,duty);
//
//  uint8_t* ptr0 = strstr(pData, str0);
//  if(ptr0 != NULL)  // "WP+"
//  {
//    if(pSize!=5)
//    {
//      uint8_t* ptr1 = strstr(pData, str1);
//      if(ptr1 != NULL)    //"Speed"
//      {
//        uint8_t* ptr1_1 = strstr(pData, str1_1);
//        uint8_t* ptr1_2 = strstr(pData, str1_2);
//        if(ptr1_1 != NULL)    //"Send"
//        {
//          UART3_printf("%s\r\n", str99_1);  //"Go!"
//          uart3_MsgMode = 1;
//        }
//        else if(ptr1_2 != NULL) //"Stop"
//        {
//          UART3_printf("%s\r\n", str99_2);  //"Stop..."
//          uart3_MsgMode = 2;
//        }
//        else
//        {
//          if(uart3_MsgMode==1){
//            UART3_printf("Mode=Send\r\n");
//          }
//          else if(uart3_MsgMode==2){
//            UART3_printf("Mode=Stop\r\n");
//          }
//          else{
//            UART3_printf("Mode=Error\r\n");
//          }
//        }
//      }
//      else{
//        UART3_printf("%s\r\n", str100_1); //"Error Commend"
//      }
//    }
//    else
//    {
//      UART3_printf("%s\r\n", str99);  //"OK!"
//    }
//  }
//  else{
//    UART3_printf("%s\r\n", str100); //"ERROR!"
//  }
//
////  strncpy(ptr, "idiot", 5);
////
////  printf("strstr example : %s\n", str1);

}

uint16_t tickNew=0, tickOld=0;
uint32_t tickDelta=0;
void MyBLEFuncEnc(void) // Run in 100ms Task
{
//    switch(uart3_MsgMode)
//    {
//      case 1:
//
////        UART_printf("%d\n\r",diff);
////        UART_printf(&huart3, "%d\r\n", cnt2);
//
////        uart3_MsgMode=0;
//        tickNew = (uint16_t)HAL_GetTick();
//        tickDelta = ((tickNew-tickOld)<<16)>>16;
//        tickOld = tickNew;
//
////        UART_printf(&huart3, "%d tick=%d\r\n", MainCnt, tickDelta);
//        UART3_printf("%.1f, %.1f, tick=%dms\r\n", AngleMech, AngleMechAll, tickDelta);
//        break;
//      case 2:
//        UART3_printf("%d\r\n", MainCnt);
//        uart3_MsgMode=0;
//        break;
//      default:
//
//        break;
//    }
}