dtu_4g/applications/VK_Client.c

#include "VK_Client.h"

#include <stdint.h>

#include "VK_Com.h"
#include "drv_ec800k.h"
#include "VK_Log.h"
#include "rtdef.h"
#include "rtthread.h"
#include "rttypes.h"
#include "VKFly/mavlink.h"
#include "mavlink_helpers.h"

#define DBG_TAG "LINK_LOG"
#define DBG_LVL DBG_INFO
#include "rtdbg.h"


char cmd_cmd[100] = {0};
char cmd_str[100] = {0};

no_carrier_match_t _no_carrier_t = {0};

/*关闭TCP连接*/
void client_tcp_close(Cclient_t *client) {
  rt_sprintf(cmd_str, AT_QICLOSE, client->connect_ID);
  BSP_LTE_SendCmd(cmd_str, DEFAULT_EXPECT, DEFAULT_ERROR, LTE_CMD_WAIT_NORMAL);
  // client->connect_sta = false;
  // client->error_cnt = 0;
}

static int no_carrier_char_parser(uint8_t ch){
  int ret = 0;
  switch(_no_carrier_t.match_stage){
    case 0:
      if(ch == 0x4E){
        _no_carrier_t.match_stage++;
      }else {
        _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
    case 1:
      if(ch == 0x4F){
        _no_carrier_t.match_stage++;
      }else{
        _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
    case 2:
      if(ch == 0x20){
        _no_carrier_t.match_stage++;
      }else{
         _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
    case 3:
      if(ch == 0x43){
        _no_carrier_t.match_stage++;
      }else{
         _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
    case 4:
      if(ch == 0x41){
        _no_carrier_t.match_stage++;
      }else{
        _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
    case 5:
      if(ch == 0x52){
        _no_carrier_t.match_stage++;
      }else{
        _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
    case 6:
      if(ch == 0x52){
        _no_carrier_t.match_stage++;
      }else{
        _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
    case 7:
      if(ch == 0x49){
        _no_carrier_t.match_stage++;
      }else{
        _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
    case 8:
      if(ch == 0x45){
        _no_carrier_t.match_stage++;
      }else{
        _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
    case 9:
      if(ch == 0x52){
        ret = 1;
        _no_carrier_t.match_stage = 0;
      }else{
        _no_carrier_t.match_stage = 0;
        ret = -1;
      }
    break;
  }
  return ret;
}

static void no_carrier_match(uint8_t * at_buf,rt_size_t len){
  uint8_t buff[256] = {0};
  rt_memcpy(buff, at_buf, len);
  for(int i = 0;i < len;i++){
    if(no_carrier_char_parser(buff[i]) == 1){
      _no_carrier_t.match_flag = COMPLETE_MATCH;
    }
  }
}


/*将EC800K软件复位*/
int16_t EC800K_Reset(void) {
  int16_t rst = -1;

  lte_dev.config_sta = false;
  lte_dev.reset_flag = DTU_CF_NEED_RESET;
  lte_dev.client1->connect_sta = false;
  //lte_dev.client2->connect_sta = false;

  rt_thread_mdelay(3000);
  BSP_LTE_SendData((uint8_t *)"+++", 3);
  rt_thread_mdelay(2000);
  BSP_LTE_SendData((uint8_t *)"+++", 3);
  rt_thread_mdelay(2000);

  uint8_t try_count = 5;

  do {
    rt_thread_mdelay(1000);

    rst = BSP_LTE_SendCmd(SOFT_RESET, DEFAULT_EXPECT, DEFAULT_ERROR,
                          LTE_CMD_WAIT_LONG);
    if (0 == rst) return 0;

    try_count--;
  } while (try_count > 0);

  return rst;
}

/*将EC800K为透传模式*/
// int16_t Set_Tansparent_Mode(Cclient_t *pClient)
//{
//    int AT_QISWTMD_error_count = 0;
//    /*如果socket成功打开，则将它设置为透传模式*/
//    if(pClient->connect_sta == true)
//    {
//       /*打开透传模式*/
//       memset(cmd_cmd, 0, sizeof(cmd_cmd));
//       sprintf(cmd_cmd, AT_QISWTMD, pClient->connect_ID, 2);
//       while(0 != BSP_LTE_SendCmd( cmd_cmd, CONNECTE_OK, DEFAULT_ERROR,
//       LTE_CMD_WAIT_LONG ))
//       {
//          //rt_thread_mdelay(1000);
//
//          if(AT_QISWTMD_error_count++ > 5)
//          {
//             EC800K_Reset();
//
//             rt_thread_mdelay(3000);
//
//             break;
//          }
//       }
//    }
//
//    return 0;
// }

int16_t client_tcp_connect(Cclient_t *client) {
  int16_t rtn = 0;

  if (lte_dev.config_sta == false)
    return rtn;
  if (client->connect_sta == true)
    return rtn;

  if (lte_dev.reset_flag == DTU_CF_NEED_RESET) {
    /*查询PDP场景*/
    if (0 != BSP_LTE_SendCmd(AT_QIACT, "+QIACT: 1,1,1,", DEFAULT_ERROR,
                             LTE_CMD_WAIT_LLONG)) {
      /*如果查询PDP场景未设置成功，则激活PDP场景模式*/
      if (0 != BSP_LTE_SendCmd(AT_QIACT1, DEFAULT_EXPECT, DEFAULT_ERROR,
                               LTE_CMD_WAIT_LLONG)) {
        BSP_LTE_SendCmd(AT_QIDEACT, NETCLOSE_SUCCESS, NETCLOSE_FAILURE,
                        LTE_CMD_WAIT_LLONG);
        // client->error_cnt++;
        return -1;
      }
    }

    //
    BSP_LTE_SendCmd(AT_CFG_TRANS_SIZE, DEFAULT_EXPECT, DEFAULT_ERROR,
                    LTE_CMD_WAIT_LLONG);
    BSP_LTE_SendCmd(AT_CFG_TRANS_WAITTM, DEFAULT_EXPECT, DEFAULT_ERROR,
                    LTE_CMD_WAIT_LLONG);
    //
  }
  // 1. 检查网络信号
  lte_dev.csq = BSP_LTE_GetCSQ();
  
  // 2, 打开链接
  memset(cmd_cmd, 0, sizeof(cmd_cmd));
  memset(cmd_str, 0, sizeof(cmd_str));
  rt_sprintf(cmd_cmd, AT_QIOPEN_TRANS /*AT_QIOPEN_FORW*/, client->connect_ID,
          client->mode, client->ip, client->port);
  rt_sprintf(cmd_str, "+QIOPEN: %d,0", client->connect_ID);

  /*打开socket, 这个模块他不返回+QIOPEN:字符串*/
  while (0 != BSP_LTE_SendCmd(cmd_cmd, CONNECTE_OK, DEFAULT_ERROR,
                              LTE_CMD_WAIT_LLONG) &&
         0 != BSP_LTE_SendCmd(cmd_cmd, cmd_str, DEFAULT_ERROR,
                              LTE_CMD_WAIT_LLONG)) {
    client_tcp_close(client);
    client->error_cnt++;
    if (client->error_cnt > 5) {
      EC800K_Reset();
      client->error_cnt = 0;
      return 0;
    }
  }
  client->connect_sta = true;
  client->error_cnt = 0;
  lte_dev.reset_flag = DTU_CF_NO_NEED_RESET;

#ifdef TRANSPARENT_MODE
// Set_Tansparent_Mode(client);
#endif

#ifdef EDU_TRAINING
  mavlink_message_t msg = {0};
  uint8_t mav_buf[MAVLINK_MAX_PACKET_LEN] = {0};
  uint16_t mav_len = 0;
  mavlink_dtu_status_t _status_t = {0};
  _status_t.csq = lte_dev.csq;
  rt_memcpy(_status_t.sn, lte_dev.iccid, sizeof(_status_t.sn));
  rt_memcpy(_status_t.imei,lte_dev.imei,sizeof(_status_t.imei));
  mavlink_msg_dtu_status_encode(1, MAV_COMP_ID_TELEMETRY_RADIO, &msg,
                                &_status_t);
  mav_len = mavlink_msg_to_send_buffer(mav_buf, &msg);

  for (int i = 0; i < 3; i++) {
    rt_device_write(lte_dev.com_dev, 0, mav_buf, mav_len);
  }
  rt_device_t fmu_com = fmu_com_get();
  if (fmu_com != RT_NULL) {
    rt_device_write(fmu_com, 0, mav_buf, mav_len);
  }
#else
  char buf[128] = {0};
  rt_sprintf(buf, "{\"sn\":\"%s\",\"client_id\":\"%s\",\"csq\":\"%d\"}\r\n",
             lte_dev.iccid, lte_dev.imei, lte_dev.csq);

  rt_device_write(lte_dev.com_dev, 0, buf, sizeof(buf));

  rt_device_write(lte_dev.com_dev, 0, buf, sizeof(buf));

  rt_device_write(lte_dev.com_dev, 0, buf, sizeof(buf));

 //hw_printf(buf);
#endif

  return rtn;
}

static rt_tick_t last_rx_tick = 0;
int16_t client_yield(CLte_dev_t *pLte_dev) {
  int16_t rtn = 0;

  while (1) {
    if (pLte_dev->client1->connect_sta == true) {
      rt_err_t ret = rt_sem_take(pLte_dev->com_dev_rx_sem, 1000);
#ifdef EDU_TRAINING     
      if (rt_tick_get() - last_rx_tick > RT_TICK_PER_SECOND * 6) {
        LOG_I("timeout!!! reconnect.\n");
        pLte_dev->client1->connect_sta = false;
      }
#endif
      if (RT_EOK == ret) {
        rt_ssize_t len = 0;
        while (1) {
          rt_memset(pLte_dev->at_buf, 0, sizeof(pLte_dev->at_buf));
          len = rt_device_read(pLte_dev->com_dev, 0, pLte_dev->at_buf,
                               sizeof(pLte_dev->at_buf));
          if (len > 0) {
            /*收到TCP关闭的消息*/
            if (strstr((const char *)pLte_dev->at_buf, CLOSED)) {
              memset(cmd_str, 0, sizeof(cmd_str));
              rt_sprintf(cmd_str, "\"closed\",%d", pLte_dev->client1->connect_ID);
              if (NULL != strstr((char *)lte_dev.at_buf, cmd_str)) {
                EC800K_Reset();
                pLte_dev->client1->connect_sta = false;
                break;
              }
              break;
            } else if (strstr((const char *)lte_dev.at_buf, "NO CARRIER")) {
              pLte_dev->client1->connect_sta = false;
              _no_carrier_t.match_flag = NO_MATCH;
              break;
            } else if(strstr((const char *)lte_dev.at_buf, "\r\n")) {
              _no_carrier_t.match_flag = HALF_MATCH;
            }

            if (_no_carrier_t.match_flag == HALF_MATCH) {
              no_carrier_match(pLte_dev->at_buf, len);
              if (_no_carrier_t.match_flag == COMPLETE_MATCH) {
                LOG_I("disconnect!!!\n");
                pLte_dev->client1->connect_sta = false;
                _no_carrier_t.match_flag = NO_MATCH;
                break;
              }
            }

            rt_device_t fmu_com = fmu_com_get();
            if (fmu_com) {
              rt_device_write(fmu_com, 0, pLte_dev->at_buf, len);
            }
          }else{
            break;
          }
          last_rx_tick = rt_tick_get();   
        }
      }

    } else {
      if(pLte_dev->reset_flag == DTU_CF_NEED_RESET){
        BSP_LTE_Config();
      }
      client_tcp_connect(pLte_dev->client1);
      last_rx_tick = rt_tick_get();
    }
  }

  return rtn;
}

void client_task(void) {
  if (lte_dev.config_sta == false) {
  }

  client_yield(&lte_dev);
}

//------------------End of File----------------------------