初始提交
This commit is contained in:
238
cli/host_interface/iot_cli_ul_buf.c
Normal file
238
cli/host_interface/iot_cli_ul_buf.c
Normal file
@@ -0,0 +1,238 @@
|
||||
/****************************************************************************
|
||||
|
||||
Copyright(c) 2019 by Aerospace C.Power (Chongqing) Microelectronics. ALL RIGHTS RESERVED.
|
||||
|
||||
This Information is proprietary to Aerospace C.Power (Chongqing) Microelectronics and MAY NOT
|
||||
be copied by any method or incorporated into another program without
|
||||
the express written consent of Aerospace C.Power. This Information or any portion
|
||||
thereof remains the property of Aerospace C.Power. The Information contained herein
|
||||
is believed to be accurate and Aerospace C.Power assumes no responsibility or
|
||||
liability for its use in any way and conveys no license or title under
|
||||
any patent or copyright and makes no representation or warranty that this
|
||||
Information is free from patent or copyright infringement.
|
||||
|
||||
****************************************************************************/
|
||||
|
||||
#include "iot_io_api.h"
|
||||
|
||||
#include "iot_cli_module_config.h"
|
||||
#include "iot_cli_tx_rx.h"
|
||||
#include "iot_cli_host_interface.h"
|
||||
#include "iot_cli_ul_buf.h"
|
||||
|
||||
#ifdef HOST_APP_FEATURE_ENABLE
|
||||
|
||||
iot_cli_ul_buf *cli_ul_buf = NULL;
|
||||
|
||||
extern iot_cli_t cli;
|
||||
|
||||
/* add ul buf entry */
|
||||
uint16_t cli_ul_buf_add_entry(uint32_t msgid, uint8_t *data, uint32_t len)
|
||||
{
|
||||
if (cli_ul_buf) {
|
||||
iot_pkt_t *pkt = NULL;
|
||||
if (!cli_ul_buf->active) {
|
||||
iot_printf("ul ack handler %lu\n", cli_ul_buf->active);
|
||||
} else {
|
||||
pkt = iot_pkt_alloc(len, IOT_CLI_MID);
|
||||
if (pkt) {
|
||||
os_mem_cpy(iot_pkt_data(pkt), data, len);
|
||||
iot_pkt_put(pkt, len);
|
||||
iot_printf("ul buf add data\n");
|
||||
return cli_ul_buf_add_pkt_entry(msgid, pkt);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return CLI_UL_BUF_IVALID_SN;
|
||||
}
|
||||
|
||||
/* add new pkt entry */
|
||||
uint16_t cli_ul_buf_add_pkt_entry(uint32_t msgid, iot_pkt_t *data)
|
||||
{
|
||||
if (cli_ul_buf && data) {
|
||||
uint16_t idx = 0;
|
||||
os_acquire_mutex(cli_ul_buf->ul_buf_mutex);
|
||||
for (; idx < CLI_UL_BUF_SIZE; idx++) {
|
||||
if (cli_ul_buf->ul_buf[idx].acked ||
|
||||
cli_ul_buf->ul_buf[idx].timeout) {
|
||||
cli_ul_buf->ul_buf[idx].acked = 0;
|
||||
cli_ul_buf->ul_buf[idx].msgid = msgid;
|
||||
if (cli_ul_buf->ul_buf[idx].data) {
|
||||
iot_pkt_free(cli_ul_buf->ul_buf[idx].data);
|
||||
cli_ul_buf->ul_buf[idx].data = NULL;
|
||||
}
|
||||
cli_ul_buf->ul_buf[idx].data = data;
|
||||
cli_ul_buf->ul_buf[idx].age = 0;
|
||||
cli_ul_buf->ul_buf[idx].timeout = 0;
|
||||
cli_ul_buf->ul_buf[idx].send_cnt = 0;
|
||||
cli_ul_buf->ul_buf[idx].sn = cli_ul_buf->sn;
|
||||
cli_ul_buf->sn++;
|
||||
iot_printf("ul buf add pkt entry, idx %lu sn %lu\n",
|
||||
idx, cli_ul_buf->ul_buf[idx].sn);
|
||||
break;
|
||||
}
|
||||
}
|
||||
os_release_mutex(cli_ul_buf->ul_buf_mutex);
|
||||
|
||||
if (idx == CLI_UL_BUF_SIZE) {
|
||||
iot_pkt_free(data);
|
||||
iot_printf("add to ul buf failed since of buf full\n");
|
||||
} else {
|
||||
return cli_ul_buf->ul_buf[idx].sn;
|
||||
}
|
||||
}
|
||||
|
||||
return CLI_UL_BUF_IVALID_SN;
|
||||
}
|
||||
|
||||
/* ul buf timer msg */
|
||||
void iot_cli_handle_ul_buf_timer_msg()
|
||||
{
|
||||
if (cli_ul_buf) {
|
||||
os_acquire_mutex(cli_ul_buf->ul_buf_mutex);
|
||||
for (uint16_t idx = 0; idx < CLI_UL_BUF_SIZE; idx++) {
|
||||
if (cli_ul_buf->ul_buf[idx].acked) {
|
||||
if (cli_ul_buf->ul_buf[idx].data) {
|
||||
iot_printf("ul buf timer free acked data, sn %lu\n",
|
||||
cli_ul_buf->ul_buf[idx].sn);
|
||||
iot_pkt_free(cli_ul_buf->ul_buf[idx].data);
|
||||
cli_ul_buf->ul_buf[idx].data = NULL;
|
||||
}
|
||||
} else if (!cli_ul_buf->ul_buf[idx].timeout) {
|
||||
cli_ul_buf->ul_buf[idx].age++;
|
||||
// time out
|
||||
if (cli_ul_buf->ul_buf[idx].age ==
|
||||
CLI_UL_BUF_MAX_AGE) {
|
||||
cli_ul_buf->ul_buf[idx].timeout = 1;
|
||||
if (cli_ul_buf->ul_buf[idx].data) {
|
||||
iot_printf("ul buf timer free timeout data, sn %lu\n",
|
||||
cli_ul_buf->ul_buf[idx].sn);
|
||||
iot_pkt_free(cli_ul_buf->ul_buf[idx].data);
|
||||
cli_ul_buf->ul_buf[idx].data = NULL;
|
||||
}
|
||||
} else if (!(cli_ul_buf->ul_buf[idx].age %
|
||||
CLI_UL_BUF_ACK_TIMEOUT)) {
|
||||
// send one more time
|
||||
iot_printf("ul buf timer retry sending msg, sn %lu\n",
|
||||
cli_ul_buf->ul_buf[idx].sn);
|
||||
iot_cli_send_to_host_with_sn(
|
||||
cli_ul_buf->ul_buf[idx].msgid,
|
||||
iot_pkt_data(cli_ul_buf->ul_buf[idx].data),
|
||||
iot_pkt_data_len(cli_ul_buf->ul_buf[idx].data),
|
||||
cli_ul_buf->ul_buf[idx].sn,
|
||||
NULL);
|
||||
}
|
||||
}
|
||||
}
|
||||
os_release_mutex(cli_ul_buf->ul_buf_mutex);
|
||||
}
|
||||
}
|
||||
|
||||
static void cli_ul_buf_clean_all_entry()
|
||||
{
|
||||
uint16_t idx = 0;
|
||||
|
||||
if (!cli_ul_buf) {
|
||||
return;
|
||||
}
|
||||
|
||||
os_acquire_mutex(cli_ul_buf->ul_buf_mutex);
|
||||
for (; idx < CLI_UL_BUF_SIZE; idx++) {
|
||||
if (cli_ul_buf->ul_buf[idx].data) {
|
||||
iot_pkt_free(cli_ul_buf->ul_buf[idx].data);
|
||||
cli_ul_buf->ul_buf[idx].data = NULL;
|
||||
}
|
||||
cli_ul_buf->ul_buf[idx].acked = 0;
|
||||
cli_ul_buf->ul_buf[idx].msgid = 0;
|
||||
cli_ul_buf->ul_buf[idx].data = NULL;
|
||||
cli_ul_buf->ul_buf[idx].age = 0;
|
||||
cli_ul_buf->ul_buf[idx].timeout = 1;
|
||||
cli_ul_buf->ul_buf[idx].send_cnt = 0;
|
||||
}
|
||||
os_release_mutex(cli_ul_buf->ul_buf_mutex);
|
||||
}
|
||||
|
||||
/* timer alive */
|
||||
static void iot_cli_ul_buf_timer(timer_id_t timer_id, void *arg)
|
||||
{
|
||||
(void)timer_id;
|
||||
(void)arg;
|
||||
|
||||
iot_task_msg_t *msg;
|
||||
|
||||
msg = iot_cli_create_cli_msg(IOT_CLI_UL_BUF_TIMER, NULL);
|
||||
|
||||
if (msg) {
|
||||
iot_task_queue_msg(cli.cli_task_h, msg, IOT_CLI_QUEUE_TIMER);
|
||||
}
|
||||
}
|
||||
|
||||
/* ul ack handler */
|
||||
void cli_ul_ack_handler(uint8_t *buffer, uint32_t bufferlen, uint8_t *src_mac)
|
||||
{
|
||||
(void)src_mac;
|
||||
cli_ul_ack *ack =
|
||||
(cli_ul_ack*)buffer;
|
||||
|
||||
if ((!ack) || (bufferlen < sizeof(*ack))) {
|
||||
return;
|
||||
}
|
||||
|
||||
iot_printf("ul ack handler %lu sn %lu\n",
|
||||
cli_ul_buf->active, ack->sn);
|
||||
if (!cli_ul_buf->active) {
|
||||
return;
|
||||
}
|
||||
|
||||
if (cli_ul_buf) {
|
||||
os_acquire_mutex(cli_ul_buf->ul_buf_mutex);
|
||||
for (uint16_t idx = 0; idx < CLI_UL_BUF_SIZE; idx++) {
|
||||
if ((!cli_ul_buf->ul_buf[idx].acked) &&
|
||||
(!cli_ul_buf->ul_buf[idx].timeout) &&
|
||||
(cli_ul_buf->ul_buf[idx].sn == ack->sn)) {
|
||||
iot_printf("ul entry acked idx %lu sn %lu\n",
|
||||
idx, ack->sn);
|
||||
cli_ul_buf->ul_buf[idx].acked = 1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
os_release_mutex(cli_ul_buf->ul_buf_mutex);
|
||||
}
|
||||
}
|
||||
|
||||
/* set ul buf timer active */
|
||||
void cli_set_ul_buf_active(uint8_t active)
|
||||
{
|
||||
if (cli_ul_buf) {
|
||||
cli_ul_buf->active = active;
|
||||
if (cli_ul_buf->active &&
|
||||
(!os_is_timer_active(cli_ul_buf->timer))) {
|
||||
os_start_timer(cli_ul_buf->timer, CLI_UL_BUF_TIMER);
|
||||
} else if ((!cli_ul_buf->active) &&
|
||||
os_is_timer_active(cli_ul_buf->timer)) {
|
||||
cli_ul_buf_clean_all_entry();
|
||||
os_stop_timer(cli_ul_buf->timer);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* init ul buf */
|
||||
void iot_cli_ul_buf_init()
|
||||
{
|
||||
cli_ul_buf = (iot_cli_ul_buf *)
|
||||
os_mem_malloc(IOT_CLI_MID, sizeof(iot_cli_ul_buf));
|
||||
|
||||
if (cli_ul_buf) {
|
||||
os_mem_set(cli_ul_buf, 0, sizeof(cli_ul_buf));
|
||||
cli_ul_buf->sn = 1;
|
||||
cli_ul_buf->ul_buf_mutex = os_create_mutex(IOT_CLI_MID);
|
||||
for (uint16_t idx = 0; idx < CLI_UL_BUF_SIZE; idx++) {
|
||||
cli_ul_buf->ul_buf[idx].timeout = 1;
|
||||
}
|
||||
cli_ul_buf->timer = os_create_timer(IOT_CLI_MID, 1,
|
||||
iot_cli_ul_buf_timer, NULL);
|
||||
}
|
||||
}
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user