pinebuds/services/auto_test/at_thread.cpp

/***************************************************************************
 *
 * Copyright 2015-2019 BES.
 * All rights reserved. All unpublished rights reserved.
 *
 * No part of this work may be used or reproduced in any form or by any
 * means, or stored in a database or retrieval system, without prior written
 * permission of BES.
 *
 * Use of this work is governed by a license granted by BES.
 * This work contains confidential and proprietary information of
 * BES. which is protected by copyright, trade secret,
 * trademark and other intellectual property rights.
 *
 ****************************************************************************/
#include "at_thread.h"
#include "cmsis_os.h"
#include "hal_trace.h"

static void at_thread(void const *argument);
osThreadDef(at_thread, osPriorityNormal, 1, 1024, "AT_cmd");

osMailQDef(at_mailbox, AT_MAILBOX_MAX, AT_MESSAGE);
static osMailQId at_mailbox = NULL;
static uint8_t at_mailbox_cnt = 0;
#define AT_DEBUG TRACE
static int at_mailbox_init(void) {
  AT_DEBUG("%s,%d", __func__, __LINE__);
  at_mailbox = osMailCreate(osMailQ(at_mailbox), NULL);
  if (at_mailbox == NULL) {
    AT_DEBUG("Failed to Create at_mailbox\n");
    return -1;
  }
  at_mailbox_cnt = 0;
  return 0;
}

static int at_mailbox_put(AT_MESSAGE *msg_src) {
  osStatus status;
  AT_MESSAGE *msg_p = NULL;

  AT_DEBUG("%s,%d", __func__, __LINE__);
  if (at_mailbox_cnt >= 1) {
    AT_DEBUG("%s,%d at_mailbox_cnt  = %d.", __func__, __LINE__, at_mailbox_cnt);
    return 0;
  }
  msg_p = (AT_MESSAGE *)osMailAlloc(at_mailbox, 0);
  ASSERT(msg_p, "osMailAlloc error");
  msg_p->id = msg_src->id;
  msg_p->ptr = msg_src->ptr;
  msg_p->param0 = msg_src->param0;
  msg_p->param1 = msg_src->param1;

  status = osMailPut(at_mailbox, msg_p);
  if (osOK == status)
    at_mailbox_cnt++;
  AT_DEBUG("%s,%d,at_mailbox_cnt = %d.", __func__, __LINE__, at_mailbox_cnt);
  return (int)status;
}

static int at_mailbox_free(AT_MESSAGE *msg_p) {
  osStatus status;

  AT_DEBUG("%s,%d", __func__, __LINE__);
  status = osMailFree(at_mailbox, msg_p);
  if (osOK == status)
    at_mailbox_cnt--;
  AT_DEBUG("%s,%d,at_mailbox_cnt = %d.", __func__, __LINE__, at_mailbox_cnt);
  return (int)status;
}

static int at_mailbox_get(AT_MESSAGE **msg_p) {
  osEvent evt;
  evt = osMailGet(at_mailbox, osWaitForever);
  if (evt.status == osEventMail) {
    *msg_p = (AT_MESSAGE *)evt.value.p;
    return 0;
  }
  return -1;
}

static void at_thread(void const *argument) {
  AT_FUNC_T pfunc;
  // USB_FUNC_T usb_funcp;
  AT_DEBUG("%s,%d", __func__, __LINE__);
  while (1) {
    AT_MESSAGE *msg_p = NULL;
    if (!at_mailbox_get(&msg_p)) {
      AT_DEBUG("_debug: %s,%d", __func__, __LINE__);
      AT_DEBUG("at_thread: id = 0x%x, ptr = 0x%x,param0 = 0x%x,param1 = 0x%x.",
               msg_p->id, msg_p->ptr, msg_p->param0, msg_p->param1);
      pfunc = (AT_FUNC_T)msg_p->ptr;
      pfunc(msg_p->param0, msg_p->param1);
      at_mailbox_free(msg_p);
    }
  }
}

int at_os_init(void) {
  osThreadId at_tid;

  AT_DEBUG("%s,%d", __func__, __LINE__);
  if (at_mailbox_init()) {
    AT_DEBUG("_debug: %s,%d", __func__, __LINE__);
    return -1;
  }
  at_tid = osThreadCreate(osThread(at_thread), NULL);
  if (at_tid == NULL) {
    AT_DEBUG("Failed to Create at_thread\n");
    return -2;
  }
  return 0;
}

int at_enqueue_cmd(uint32_t cmd_id, uint32_t param, uint32_t pfunc) {
  AT_MESSAGE at_msg;
  int32_t ret;

  at_msg.id = AT_MESSAGE_ID_CMD;
  at_msg.param0 = param;
  at_msg.param1 = cmd_id;
  at_msg.ptr = pfunc;
  ret = at_mailbox_put(&at_msg);
  return ret;
}