You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
108 lines
2.5 KiB
108 lines
2.5 KiB
#include "VK_Com.h"
|
|
#include "VK_Client.h"
|
|
#include "drv_ec800k.h"
|
|
#include "rtdef.h"
|
|
#include "rtthread.h"
|
|
|
|
#define ENABLE_MEMORY_USAGE_LOG 0
|
|
|
|
#if ENABLE_MEMORY_USAGE_LOG
|
|
#define DBG_TAG "MEM_LOG"
|
|
#define DBG_LVL DBG_INFO
|
|
#include <rtdbg.h>
|
|
#endif
|
|
|
|
rt_device_t fmu_com = RT_NULL;
|
|
rt_sem_t fmu_com_rx_sem = RT_NULL;
|
|
|
|
#if ENABLE_MEMORY_USAGE_LOG
|
|
static rt_size_t thread_stack_used(rt_thread_t thread) {
|
|
rt_uint8_t *stack;
|
|
rt_size_t unused = 0;
|
|
|
|
if (thread == RT_NULL || thread->stack_addr == RT_NULL) {
|
|
return 0;
|
|
}
|
|
|
|
stack = (rt_uint8_t *)thread->stack_addr;
|
|
while (unused < thread->stack_size && stack[unused] == '#') {
|
|
unused++;
|
|
}
|
|
|
|
return thread->stack_size - unused;
|
|
}
|
|
|
|
static void log_memory_usage(void) {
|
|
rt_size_t total = 0;
|
|
rt_size_t used = 0;
|
|
rt_size_t max_used = 0;
|
|
rt_thread_t lte_thread;
|
|
|
|
rt_memory_info(&total, &used, &max_used);
|
|
LOG_I("heap used=%u total=%u free=%u max=%u", used, total, total - used,
|
|
max_used);
|
|
|
|
lte_thread = rt_thread_find("lte");
|
|
if (lte_thread != RT_NULL) {
|
|
rt_size_t stack_used = thread_stack_used(lte_thread);
|
|
LOG_I("lte stack used=%u total=%u free=%u", stack_used,
|
|
lte_thread->stack_size, lte_thread->stack_size - stack_used);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
static rt_err_t fmu_com_rx_cb(rt_device_t dev, rt_size_t size) {
|
|
if (fmu_com_rx_sem != RT_NULL) {
|
|
rt_sem_release(fmu_com_rx_sem);
|
|
}
|
|
return RT_EOK;
|
|
}
|
|
|
|
rt_device_t fmu_com_get(void) { return fmu_com; }
|
|
|
|
int fmu_com_register(rt_device_t com_dev) {
|
|
fmu_com = com_dev;
|
|
|
|
if (fmu_com_rx_sem == RT_NULL) {
|
|
fmu_com_rx_sem = rt_sem_create("fmuComRx", 0, RT_IPC_FLAG_PRIO);
|
|
}
|
|
|
|
rt_device_set_rx_indicate(fmu_com, fmu_com_rx_cb);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*接收到串口的数据，并将数据转发到网络端*/
|
|
void com_task(void) {
|
|
static uint8_t buff[128];
|
|
|
|
uint32_t len = 0;
|
|
#if ENABLE_MEMORY_USAGE_LOG
|
|
rt_tick_t memory_log_start = rt_tick_get();
|
|
#endif
|
|
|
|
while (1) {
|
|
if (rt_sem_take(fmu_com_rx_sem, 1000) == RT_EOK) {
|
|
while (1) {
|
|
len = rt_device_read(fmu_com, 0, buff, sizeof(buff));
|
|
if (len > 0) {
|
|
lte_diag_fmu_rx(len);
|
|
if (lte_dev.client1->connect_sta == true &&
|
|
lte_dev.data_tx_paused == false) {
|
|
/* 仅在客户端2连接时转发 */
|
|
BSP_LTE_SendData(buff, len);
|
|
}
|
|
} else {
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
#if ENABLE_MEMORY_USAGE_LOG
|
|
if (rt_tick_get() - memory_log_start >= RT_TICK_PER_SECOND * 5) {
|
|
memory_log_start = rt_tick_get();
|
|
log_memory_usage();
|
|
}
|
|
#endif
|
|
}
|
|
}
|
|
|