ble-light/components/libraries/console/phy_console.c

/**************************************************************************************************
 
  Phyplus Microelectronics Limited confidential and proprietary. 
  All rights reserved.

  IMPORTANT: All rights of this software belong to Phyplus Microelectronics 
  Limited ("Phyplus"). Your use of this Software is limited to those 
  specific rights granted under  the terms of the business contract, the 
  confidential agreement, the non-disclosure agreement and any other forms 
  of agreements as a customer or a partner of Phyplus. You may not use this 
  Software unless you agree to abide by the terms of these agreements. 
  You acknowledge that the Software may not be modified, copied, 
  distributed or disclosed unless embedded on a Phyplus Bluetooth Low Energy 
  (BLE) integrated circuit, either as a product or is integrated into your 
  products.  Other than for the aforementioned purposes, you may not use, 
  reproduce, copy, prepare derivative works of, modify, distribute, perform, 
  display or sell this Software and/or its documentation for any purposes.

  YOU FURTHER ACKNOWLEDGE AND AGREE THAT THE SOFTWARE AND DOCUMENTATION ARE
  PROVIDED AS IS WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESS OR IMPLIED,
  INCLUDING WITHOUT LIMITATION, ANY WARRANTY OF MERCHANTABILITY, TITLE,
  NON-INFRINGEMENT AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT SHALL
  PHYPLUS OR ITS SUBSIDIARIES BE LIABLE OR OBLIGATED UNDER CONTRACT,
  NEGLIGENCE, STRICT LIABILITY, CONTRIBUTION, BREACH OF WARRANTY, OR OTHER
  LEGAL EQUITABLE THEORY ANY DIRECT OR INDIRECT DAMAGES OR EXPENSES
  INCLUDING BUT NOT LIMITED TO ANY INCIDENTAL, SPECIAL, INDIRECT, PUNITIVE
  OR CONSEQUENTIAL DAMAGES, LOST PROFITS OR LOST DATA, COST OF PROCUREMENT
  OF SUBSTITUTE GOODS, TECHNOLOGY, SERVICES, OR ANY CLAIMS BY THIRD PARTIES
  (INCLUDING BUT NOT LIMITED TO ANY DEFENSE THEREOF), OR OTHER SIMILAR COSTS.
  
**************************************************************************************************/


#include "phy_console.h"
#include "uart.h"
#include "error.h"
#include "OSAL.h"
#include "string.h"
#include "pwrmgr.h"
#include "log.h"


typedef enum{
  CONS_ST_IDLE,
  CONS_ST_RX,
  CONS_ST_CMD
}cons_state_t;

typedef struct{
  cons_state_t  state;
  uint16_t      rx_cnt;
  uint8_t       rx_buf[CONS_CMD_RXBUF_MAX];
  const cons_cmd_t*   cmd_list;
  cons_callback_t callback;
}cons_ctx_t;

cons_ctx_t s_cons_ctx;


void console_parse_cmd(void)
{
  uint16_t i,j;
  uint16_t cmd_id = 0;
  char* param_table[CONS_PARAM_NUM_MAX];
  cons_ctx_t* pctx = &s_cons_ctx;
  const cons_cmd_t*   cmd_list = pctx->cmd_list;
  uint8_t* prx = s_cons_ctx.rx_buf;
  char* pcmd = NULL;
  char* pparam = NULL;
  uint8_t param_num = 0;

  //LOG("\n");
  //for(i = 0; i< pctx->rx_cnt; i++)
  //  LOG("%x ",prx[i]);
  //  LOG("\n");

  //parse "at"
  for(i = 1; i< pctx->rx_cnt; i++){
    if(prx[i-1] == 'a' && prx[i] == 't'){
      i++;
      break;
    }
  }
  if(i == pctx->rx_cnt){
    LOG("Parse filed, did not found \"at\"\n");
    return;
  }

  //parse cmd
  {
    pcmd = (char*)prx+i;
    for(; i< pctx->rx_cnt; i++){
        if(prx[i] == ' ' || prx[i] == '\0' ){
          prx[i] = '\0';
          break;
        }
        if(prx[i] < 0x20 || prx[i] > 0x7d){
          LOG("Parse failed, cmd has illegal character\n");
          return;
        }
    }
    if(osal_strlen(pcmd) == 0){
      LOG("Parse failed, cmd is empty\n");
      return;
    }
    for(j = 0; j<CONS_CMD_NUM_MAX; j++){
      if(cmd_list[j].cmd_id == 0 || cmd_list[j].cmd_name == NULL ){
        LOG("Parse failed, cmd is not match cmdlist\n");
        return;
      }
      if(strcmp(pcmd, cmd_list[j].cmd_name) == 0){
        //match
        cmd_id = cmd_list[j].cmd_id;
        break;
      }
    }
    if(cmd_id == 0){
      LOG("Parse failed, cmd is not match cmdlist_1\n");
      return;
    }
  }
  i++;
  //parse parameter
  pparam = (char*)prx+i;
  for(; i< pctx->rx_cnt; i++){
    if(prx[i] == ' '){
      prx[i] = '\0';
      if(osal_strlen(pparam) == 0){
        break;
      }
      param_table[param_num] = pparam;
      param_num++;
      if(param_num >= CONS_PARAM_NUM_MAX)
        break;
      pparam = (char*)prx+i+1;
			continue;
    }
		if(prx[i] == '\0'){
      if(osal_strlen(pparam) == 0){
        break;
      }
      param_table[param_num] = pparam;
      param_num++;
			break;
		}
    if(prx[i] < 0x20 || prx[i] > 0x7d){
      LOG("Parse failed, parameter has illegal character\n");
      return;
    }
  }

  pctx->callback(cmd_id, param_num, param_table);
  
}


void console_sleep_handler(void)
{
  hal_gpio_fmux(P10, Bit_DISABLE);      //enable fullmux fuction; enable or disable 
  hal_gpio_wakeup_set(P10, NEGEDGE);
}

void console_wakeup_handler(void)
{
  int i;
  hal_gpio_write(P14, 0);
  hal_gpio_write(P14, 1);
  hal_gpio_write(P14, 0);
  for(i = 0; i< 20; i++){
    if(hal_gpio_read(P10)==0)
    {
      hal_pwrmgr_lock(MOD_CONSOLE);
      break;
    }
  }
  hal_gpio_write(P14, 0);
  hal_gpio_write(P14, 1);
  hal_gpio_write(P14, 0);
  s_cons_ctx.state = CONS_ST_IDLE;
}

void console_rx_handler(uart_Evt_t* pev)
{
  cons_ctx_t* pctx = &s_cons_ctx;
  uint8_t* prx = s_cons_ctx.rx_buf;
  
  switch(pev->type){
  case UART_EVT_TYPE_RX_DATA:
  case UART_EVT_TYPE_RX_DATA_TO:
  {
    uint8_t i;
    uint8_t* prx_msg = pev->data;
    //for(i = 0; i< pev->len; i++)
    //  LOG("%x ",pev->data[i]);
    //LOG("\n");
    if(pctx->state == CONS_ST_IDLE){
      hal_pwrmgr_lock(MOD_CONSOLE);
      pctx->state = CONS_ST_RX;
    }
    if(pctx->state == CONS_ST_RX){
      for(i = 0; i< pev->len; i++){
        if(prx_msg[i] == '\r' ||prx_msg[i] == '\n'){
          prx[pctx->rx_cnt] = 0;
					pctx->rx_cnt++;
          pctx->state = CONS_ST_CMD;
          console_parse_cmd();
					pctx->state = CONS_ST_IDLE;
					pctx->rx_cnt = 0;
          hal_pwrmgr_unlock(MOD_CONSOLE);
          break;
        }
        prx[pctx->rx_cnt] = prx_msg[i];
        pctx->rx_cnt++;
      }
    }
    else
    {
      hal_pwrmgr_unlock(MOD_CONSOLE);
    }
    break;
  }
  default:
    break;
  }
}

int console_init(const cons_cmd_t* cmdlist, cons_callback_t callback)
{
  uart_Cfg_t cfg = {
  .tx_pin = P9,
  .rx_pin = P10,
  .rts_pin = GPIO_DUMMY,
  .cts_pin = GPIO_DUMMY,
  .baudrate = 115200,
  .use_fifo = TRUE,
  .hw_fwctrl = FALSE,
  .use_tx_buf = FALSE,
  .parity     = FALSE,
  .evt_handler = console_rx_handler,
  };

  if(callback == NULL)
    return PPlus_ERR_INVALID_PARAM;
    
  hal_pwrmgr_register(MOD_CONSOLE, console_sleep_handler, console_wakeup_handler);
  
  hal_uart_init(cfg);//uart init

  
  s_cons_ctx.cmd_list = cmdlist;
  s_cons_ctx.state = CONS_ST_IDLE;
  s_cons_ctx.rx_cnt = 0;
  s_cons_ctx.callback = callback;

  return PPlus_SUCCESS;
}