|
@@ -0,0 +1,1192 @@
|
|
|
+/*
|
|
|
+ * Copyright (c) 2006-2021, RT-Thread Development Team
|
|
|
+ *
|
|
|
+ * SPDX-License-Identifier: Apache-2.0
|
|
|
+ *
|
|
|
+ * Change Logs:
|
|
|
+ * Date Author Notes
|
|
|
+ * 2021-02-02 xiangxistu the first version
|
|
|
+ * 2021-03-19 Sherman Optimize the transfer process
|
|
|
+ * 2021-04-20 Sherman Optimize memory footprint
|
|
|
+ * 2021-05-10 Sherman Add rtlink_status MSH command; Optimize transmission timer Settings; Fix known bugs
|
|
|
+ */
|
|
|
+
|
|
|
+#include <rtthread.h>
|
|
|
+#include <rtdevice.h>
|
|
|
+#include <board.h>
|
|
|
+#include <rthw.h>
|
|
|
+
|
|
|
+#include <rtlink.h>
|
|
|
+#include <rtlink_hw.h>
|
|
|
+#include <rtlink_utils.h>
|
|
|
+
|
|
|
+#define DBG_ENABLE
|
|
|
+#ifdef USING_RT_LINK_DEBUG
|
|
|
+ #define DBG_LVL DBG_LOG
|
|
|
+#else
|
|
|
+ #define DBG_LVL DBG_INFO
|
|
|
+#endif
|
|
|
+#define DBG_TAG "rtlink"
|
|
|
+#define DBG_COLOR
|
|
|
+#include <rtdbg.h>
|
|
|
+
|
|
|
+#ifdef RT_LINK_USING_SPI
|
|
|
+ #define RT_LINK_LONG_FRAME_TIMEOUT 50
|
|
|
+ #define RT_LINK_SENT_FRAME_TIMEOUT 100
|
|
|
+#else
|
|
|
+ #define RT_LINK_LONG_FRAME_TIMEOUT 100
|
|
|
+ #define RT_LINK_SENT_FRAME_TIMEOUT 200
|
|
|
+#endif /* RT_LINK_USING_SPI */
|
|
|
+
|
|
|
+#define RT_LINK_RECV_DATA_SEQUENCE 0
|
|
|
+#define RT_LINK_INIT_FRAME_SEQENCE 129
|
|
|
+
|
|
|
+#define RT_LINK_THREAD_NAME "rtlink"
|
|
|
+#define RT_LINK_THREAD_TICK 20
|
|
|
+#define RT_LINK_THREAD_PRIORITY 15
|
|
|
+#define RT_LINK_THREAD_STACK_SIZE 832 /* 32 bytes aligned */
|
|
|
+
|
|
|
+typedef enum
|
|
|
+{
|
|
|
+ FIND_FRAME_HEAD = 0,
|
|
|
+ PARSE_FRAME_HEAD,
|
|
|
+ PARSE_FRAME_EXTEND,
|
|
|
+ PARSE_FRAME_SEQ,
|
|
|
+ CHECK_FRAME_CRC,
|
|
|
+ HEADLE_FRAME_DATA,
|
|
|
+} rt_link_frame_parse_t;
|
|
|
+
|
|
|
+/* rtlink SCB(Session control block) */
|
|
|
+static struct rt_link_session *rt_link_scb = RT_NULL;
|
|
|
+struct rt_link_session *rt_link_get_scb(void)
|
|
|
+{
|
|
|
+ return rt_link_scb;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_int16_t rt_link_check_seq(rt_uint8_t new, rt_uint8_t used)
|
|
|
+{
|
|
|
+ rt_int16_t compare_seq = 0;
|
|
|
+ compare_seq = new - used;
|
|
|
+ if (compare_seq < 0)
|
|
|
+ {
|
|
|
+ compare_seq = compare_seq + 256;
|
|
|
+ }
|
|
|
+ return compare_seq;
|
|
|
+}
|
|
|
+
|
|
|
+static int rt_link_frame_init(struct rt_link_frame *frame, rt_uint8_t config)
|
|
|
+{
|
|
|
+ if (frame == RT_NULL)
|
|
|
+ {
|
|
|
+ return -RT_ERROR;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* set frame control information */
|
|
|
+ rt_memset(&frame->head, 0, sizeof(struct rt_link_frame_head));
|
|
|
+ if (config & FRAME_CRC)
|
|
|
+ {
|
|
|
+ frame->head.crc = 1;
|
|
|
+ }
|
|
|
+ if (config & FRAME_ACK)
|
|
|
+ {
|
|
|
+ frame->head.ack = 1;
|
|
|
+ }
|
|
|
+
|
|
|
+ frame->head.magicid = RT_LINK_FRAME_HEAD;
|
|
|
+ /* frame data information */
|
|
|
+ rt_memset(&frame->extend, 0, sizeof(struct rt_link_extend));
|
|
|
+ frame->crc = 0;
|
|
|
+ frame->real_data = RT_NULL;
|
|
|
+ frame->data_len = 0;
|
|
|
+ frame->index = 0;
|
|
|
+ frame->total = 0;
|
|
|
+ frame->attribute = RT_LINK_RESERVE_FRAME;
|
|
|
+
|
|
|
+ rt_slist_init(&frame->slist);
|
|
|
+
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_link_frame_free(struct rt_link_frame *frame)
|
|
|
+{
|
|
|
+ if (frame == RT_NULL)
|
|
|
+ {
|
|
|
+ return -RT_ERROR;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (frame->real_data != RT_NULL)
|
|
|
+ {
|
|
|
+ rt_free(frame->real_data);
|
|
|
+ frame->real_data = RT_NULL;
|
|
|
+ }
|
|
|
+ rt_memset(frame, 0, sizeof(struct rt_link_frame));
|
|
|
+ rt_free(frame);
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+/* performs data transmission */
|
|
|
+static rt_err_t rt_link_frame_send(rt_slist_t *slist)
|
|
|
+{
|
|
|
+ struct rt_link_frame *frame = RT_NULL;
|
|
|
+ rt_uint8_t *origin_data = RT_NULL;
|
|
|
+ rt_uint8_t *data = RT_NULL;
|
|
|
+ rt_size_t length = 0;
|
|
|
+ rt_uint8_t send_max = RT_LINK_ACK_MAX; /* The number of '1' in the binary number */
|
|
|
+
|
|
|
+ /* if slist is tx_data_slist, we should send all data on the slist*/
|
|
|
+ if (slist == &rt_link_scb->tx_data_slist)
|
|
|
+ {
|
|
|
+ slist = rt_slist_next(&rt_link_scb->tx_data_slist);
|
|
|
+ }
|
|
|
+ if (slist == RT_NULL)
|
|
|
+ {
|
|
|
+ LOG_W("tx_data_slist NULL");
|
|
|
+ return -RT_ERROR;
|
|
|
+ }
|
|
|
+ data = rt_malloc(RT_LINK_MAX_FRAME_LENGTH);
|
|
|
+ if (data == RT_NULL)
|
|
|
+ {
|
|
|
+ LOG_E("rt link alloc memory(%d B) failed, send frame failed.", RT_LINK_MAX_FRAME_LENGTH);
|
|
|
+ return -RT_ENOMEM;
|
|
|
+ }
|
|
|
+ origin_data = data;
|
|
|
+
|
|
|
+ do
|
|
|
+ {
|
|
|
+ /* get frame for send */
|
|
|
+ frame = rt_container_of(slist, struct rt_link_frame, slist);
|
|
|
+ slist = rt_slist_next(slist);
|
|
|
+
|
|
|
+ length = RT_LINK_HEAD_LENGTH;
|
|
|
+ if (frame->head.crc)
|
|
|
+ {
|
|
|
+ length += RT_LINK_CRC_LENGTH;
|
|
|
+ }
|
|
|
+ if (frame->head.extend)
|
|
|
+ {
|
|
|
+ length += RT_LINK_MAX_EXTEND_LENGTH;
|
|
|
+ }
|
|
|
+
|
|
|
+ length += frame->data_len;
|
|
|
+ frame->head.length = frame->data_len;
|
|
|
+ rt_memcpy(data, &frame->head, RT_LINK_HEAD_LENGTH);
|
|
|
+ data = data + RT_LINK_HEAD_LENGTH;
|
|
|
+ if (frame->head.extend)
|
|
|
+ {
|
|
|
+ rt_memcpy(data, &frame->extend, RT_LINK_MAX_EXTEND_LENGTH);
|
|
|
+ data = data + RT_LINK_MAX_EXTEND_LENGTH;
|
|
|
+ }
|
|
|
+ if (frame->attribute == RT_LINK_SHORT_DATA_FRAME || frame->attribute == RT_LINK_LONG_DATA_FRAME)
|
|
|
+ {
|
|
|
+ rt_memcpy(data, frame->real_data, frame->data_len);
|
|
|
+ data = data + frame->data_len;
|
|
|
+ }
|
|
|
+ if (frame->head.crc)
|
|
|
+ {
|
|
|
+ frame->crc = rt_link_scb->calculate_crc(RT_FALSE, origin_data, length - RT_LINK_CRC_LENGTH);
|
|
|
+ rt_memcpy(data, &frame->crc, RT_LINK_CRC_LENGTH);
|
|
|
+ }
|
|
|
+
|
|
|
+ LOG_D("frame send(%d) len(%d) attr:(%d), crc:(0x%08x).", frame->head.sequence, length, frame->attribute, frame->crc);
|
|
|
+ rt_link_hw_send(origin_data, length);
|
|
|
+
|
|
|
+ data = origin_data;
|
|
|
+ if (slist == RT_NULL)
|
|
|
+ {
|
|
|
+ send_max = 0;
|
|
|
+ }
|
|
|
+ send_max >>= 1;
|
|
|
+ }while (send_max);
|
|
|
+ rt_free(origin_data);
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static void _stop_recv_long(void)
|
|
|
+{
|
|
|
+ rt_timer_stop(&rt_link_scb->longframetimer);
|
|
|
+ if (rt_link_scb->rx_record.dataspace != RT_NULL)
|
|
|
+ {
|
|
|
+ rt_free(rt_link_scb->rx_record.dataspace);
|
|
|
+ rt_link_scb->rx_record.dataspace = RT_NULL;
|
|
|
+ }
|
|
|
+ rt_link_scb->rx_record.long_count = 0;
|
|
|
+ rt_link_scb->rx_record.total = 0;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_link_frame_stop_receive(struct rt_link_frame *frame)
|
|
|
+{
|
|
|
+ rt_memset(frame, 0, sizeof(struct rt_link_frame));
|
|
|
+ rt_link_hw_buffer_point_shift(&rt_link_scb->rx_buffer->read_point, rt_link_hw_recv_len(rt_link_scb->rx_buffer));
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+/* Configure the extended field of the frame */
|
|
|
+static rt_err_t rt_link_frame_extend_config(struct rt_link_frame *frame, rt_link_frame_attribute_t attribute, rt_uint16_t parameter)
|
|
|
+{
|
|
|
+ frame->head.extend = 1;
|
|
|
+ frame->extend.attribute = attribute;
|
|
|
+ frame->extend.parameter = parameter;
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static int rt_link_command_frame_send(rt_uint8_t sequence, rt_link_frame_attribute_t attribute, rt_uint16_t parameter)
|
|
|
+{
|
|
|
+ struct rt_link_frame command_frame = {0};
|
|
|
+ rt_uint8_t extend_flag = RT_FALSE;
|
|
|
+
|
|
|
+ /* command frame don't need crc and ack ability */
|
|
|
+ rt_link_frame_init(&command_frame, RT_NULL);
|
|
|
+ command_frame.head.sequence = sequence;
|
|
|
+ command_frame.head.length = RT_LINK_MAX_EXTEND_LENGTH;
|
|
|
+ command_frame.attribute = attribute;
|
|
|
+ switch (attribute)
|
|
|
+ {
|
|
|
+ case RT_LINK_RESEND_FRAME:
|
|
|
+ extend_flag = RT_TRUE;
|
|
|
+ LOG_D("send RESEND_FRAME(%d).", command_frame.head.sequence);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case RT_LINK_HANDSHAKE_FRAME:
|
|
|
+ extend_flag = RT_TRUE;
|
|
|
+ LOG_D("send HANDSHAKE_FRAME(%d).", command_frame.head.sequence);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case RT_LINK_CONFIRM_FRAME:
|
|
|
+ LOG_D("send CONFIRM_FRAME(%d).", command_frame.head.sequence);
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (extend_flag)
|
|
|
+ {
|
|
|
+ rt_link_frame_extend_config(&command_frame, attribute, parameter);
|
|
|
+ }
|
|
|
+ rt_link_frame_send(&command_frame.slist);
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_link_resend_handle(struct rt_link_frame *receive_frame)
|
|
|
+{
|
|
|
+ struct rt_link_frame *find_frame = RT_NULL;
|
|
|
+ rt_slist_t *tem_list = RT_NULL;
|
|
|
+
|
|
|
+ tem_list = rt_slist_first(&rt_link_scb->tx_data_slist);
|
|
|
+ while (tem_list != RT_NULL)
|
|
|
+ {
|
|
|
+ find_frame = rt_container_of(tem_list, struct rt_link_frame, slist);
|
|
|
+ if (find_frame->head.sequence == receive_frame->head.sequence)
|
|
|
+ {
|
|
|
+ LOG_D("resend frame(%d)", find_frame->head.sequence);
|
|
|
+ rt_link_frame_send(&find_frame->slist);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ tem_list = tem_list->next;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (tem_list == RT_NULL)
|
|
|
+ {
|
|
|
+ LOG_D("frame resent failed, can't find(%d).", receive_frame->head.sequence);
|
|
|
+ rt_link_command_frame_send(receive_frame->head.sequence, RT_LINK_SESSION_END, RT_NULL);
|
|
|
+ }
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_link_confirm_handle(struct rt_link_frame *receive_frame)
|
|
|
+{
|
|
|
+ static struct rt_link_frame *send_frame = RT_NULL;
|
|
|
+ struct rt_link_frame *find_frame = RT_NULL;
|
|
|
+ rt_slist_t *tem_list = RT_NULL;
|
|
|
+ rt_uint16_t seq_offset = 0;
|
|
|
+
|
|
|
+ LOG_D("confirm seq(%d) frame", receive_frame->head.sequence);
|
|
|
+ if (rt_link_scb->link_status == RT_LINK_NO_RESPONSE)
|
|
|
+ {
|
|
|
+ /* The handshake success and resends the data frame */
|
|
|
+ LOG_D("link_status RT_LINK_CONNECT_DONE, resend data");
|
|
|
+ rt_link_scb->link_status = RT_LINK_CONNECT_DONE;
|
|
|
+ if (rt_slist_first(&rt_link_scb->tx_data_slist))
|
|
|
+ {
|
|
|
+ rt_event_send(&rt_link_scb->event, RT_LINK_SEND_READY_EVENT);
|
|
|
+ }
|
|
|
+ return RT_EOK;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Check to see if the frame is send for confirm */
|
|
|
+ tem_list = rt_slist_first(&rt_link_scb->tx_data_slist);
|
|
|
+ if (tem_list == RT_NULL)
|
|
|
+ {
|
|
|
+ return -RT_ERROR;
|
|
|
+ }
|
|
|
+
|
|
|
+ send_frame = rt_container_of(tem_list, struct rt_link_frame, slist);
|
|
|
+ seq_offset = rt_link_check_seq(receive_frame->head.sequence,
|
|
|
+ rt_link_scb->tx_seq);
|
|
|
+ if (seq_offset <= send_frame->total)
|
|
|
+ {
|
|
|
+ LOG_D("confirm frame (%d)", receive_frame->head.sequence);
|
|
|
+ for (int i = 0; i < seq_offset; i++)
|
|
|
+ {
|
|
|
+ find_frame = rt_container_of(tem_list, struct rt_link_frame, slist);
|
|
|
+ LOG_D("confirm(%d), remove(%d)", receive_frame->head.sequence, find_frame->head.sequence);
|
|
|
+
|
|
|
+ rt_enter_critical();
|
|
|
+ rt_slist_remove(&rt_link_scb->tx_data_slist, &find_frame->slist);
|
|
|
+ rt_exit_critical();
|
|
|
+ find_frame->real_data = RT_NULL;
|
|
|
+ rt_link_frame_free(find_frame);
|
|
|
+
|
|
|
+ tem_list = rt_slist_first(&rt_link_scb->tx_data_slist);
|
|
|
+ if (tem_list == RT_NULL)
|
|
|
+ {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ rt_link_scb->tx_seq = receive_frame->head.sequence;
|
|
|
+ rt_link_scb->link_status = RT_LINK_CONNECT_DONE;
|
|
|
+ if (tem_list == RT_NULL)
|
|
|
+ {
|
|
|
+ LOG_D("SEND_OK");
|
|
|
+ rt_event_send(&rt_link_scb->event, RT_LINK_SEND_OK_EVENT);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ LOG_D("Continue sending");
|
|
|
+ rt_event_send(&rt_link_scb->event, RT_LINK_SEND_READY_EVENT);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_link_short_handle(struct rt_link_frame *receive_frame)
|
|
|
+{
|
|
|
+ LOG_D("Seq(%d) short data", receive_frame->head.sequence);
|
|
|
+ rt_link_scb->rx_record.dataspace = rt_malloc(receive_frame->data_len);
|
|
|
+ if (rt_link_scb->rx_record.dataspace != RT_NULL)
|
|
|
+ {
|
|
|
+ rt_link_command_frame_send(receive_frame->head.sequence, RT_LINK_CONFIRM_FRAME, RT_NULL);
|
|
|
+ rt_link_scb->rx_record.rx_seq = receive_frame->head.sequence;
|
|
|
+
|
|
|
+ if (rt_link_scb->channel[receive_frame->head.channel].upload_callback == RT_NULL)
|
|
|
+ {
|
|
|
+ rt_free(rt_link_scb->rx_record.dataspace);
|
|
|
+ LOG_E("Channel %d has not been registered", receive_frame->head.channel);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ rt_enter_critical();
|
|
|
+ rt_link_hw_copy(rt_link_scb->rx_record.dataspace, receive_frame->real_data, receive_frame->data_len);
|
|
|
+ rt_exit_critical();
|
|
|
+ rt_link_scb->channel[receive_frame->head.channel].upload_callback(rt_link_scb->rx_record.dataspace, receive_frame->data_len);
|
|
|
+ }
|
|
|
+ rt_link_scb->rx_record.dataspace = RT_NULL;
|
|
|
+ rt_link_frame_stop_receive(receive_frame);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ LOG_W("short data %dB alloc failed", receive_frame->data_len);
|
|
|
+ }
|
|
|
+ receive_frame->real_data = RT_NULL;
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static void _long_handle_first(struct rt_link_frame *receive_frame, rt_uint8_t *count_mask)
|
|
|
+{
|
|
|
+ if (receive_frame->extend.parameter % RT_LINK_MAX_DATA_LENGTH == 0)
|
|
|
+ {
|
|
|
+ receive_frame->total = receive_frame->extend.parameter / RT_LINK_MAX_DATA_LENGTH;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ receive_frame->total = receive_frame->extend.parameter / RT_LINK_MAX_DATA_LENGTH + 1;
|
|
|
+ }
|
|
|
+
|
|
|
+ rt_link_scb->rx_record.total = receive_frame->total;
|
|
|
+ rt_link_scb->rx_record.dataspace = rt_malloc(receive_frame->extend.parameter);
|
|
|
+ if (rt_link_scb->rx_record.dataspace == RT_NULL)
|
|
|
+ {
|
|
|
+ LOG_W("long data %dB alloc failed.", receive_frame->extend.parameter);
|
|
|
+ }
|
|
|
+
|
|
|
+}
|
|
|
+
|
|
|
+static void _long_handle_second(struct rt_link_frame *receive_frame, rt_uint8_t count_mask)
|
|
|
+{
|
|
|
+ static rt_uint8_t ack_mask = RT_LINK_ACK_MAX;
|
|
|
+
|
|
|
+ void *data = RT_NULL;
|
|
|
+ rt_size_t size = 0;
|
|
|
+ rt_uint16_t serve = 0;
|
|
|
+ rt_size_t offset = 0; /* offset, count from 0 */
|
|
|
+
|
|
|
+ receive_frame->index = rt_link_check_seq(receive_frame->head.sequence, rt_link_scb->rx_record.rx_seq) - 1;
|
|
|
+ LOG_D("index= %d, count= 0x%x, seq(%d), rxseq(%d)", receive_frame->index, rt_link_scb->rx_record.long_count, receive_frame->head.sequence, rt_link_scb->rx_record.rx_seq);
|
|
|
+
|
|
|
+ if ((receive_frame->index > RT_LINK_FRAMES_MAX) || (rt_link_scb->rx_record.long_count & (0x01 << receive_frame->index)))
|
|
|
+ {
|
|
|
+ LOG_D("ERR:index %d, rx_seq %d", receive_frame->index, rt_link_scb->rx_record.rx_seq);
|
|
|
+ }
|
|
|
+ else if (rt_link_scb->rx_record.dataspace != RT_NULL)
|
|
|
+ {
|
|
|
+ LOG_D("long_count (0x%02x)index(%d)total(%d) seq(%d)", rt_link_scb->rx_record.long_count, receive_frame->index, receive_frame->total, receive_frame->head.sequence);
|
|
|
+ rt_link_scb->rx_record.long_count |= (0x01 << receive_frame->index);
|
|
|
+ offset = RT_LINK_MAX_DATA_LENGTH * receive_frame->index;
|
|
|
+
|
|
|
+ rt_enter_critical();
|
|
|
+ rt_link_hw_copy(rt_link_scb->rx_record.dataspace + offset, receive_frame->real_data, receive_frame->data_len);
|
|
|
+ rt_exit_critical();
|
|
|
+
|
|
|
+ if (rt_link_utils_num1(rt_link_scb->rx_record.long_count) == rt_link_scb->rx_record.total)
|
|
|
+ {
|
|
|
+ rt_link_command_frame_send((rt_link_scb->rx_record.rx_seq + rt_link_scb->rx_record.total), RT_LINK_CONFIRM_FRAME, RT_NULL);
|
|
|
+ }
|
|
|
+ else if ((rt_link_scb->rx_record.long_count & ack_mask) == ack_mask)
|
|
|
+ {
|
|
|
+ rt_link_command_frame_send((rt_link_scb->rx_record.rx_seq + rt_link_utils_num1(ack_mask)), RT_LINK_CONFIRM_FRAME, RT_NULL);
|
|
|
+ ack_mask |= ack_mask << rt_link_utils_num1(RT_LINK_ACK_MAX);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* receive a complete package */
|
|
|
+ if (rt_link_utils_num1(rt_link_scb->rx_record.long_count) == rt_link_scb->rx_record.total)
|
|
|
+ {
|
|
|
+ rt_timer_stop(&rt_link_scb->longframetimer);
|
|
|
+
|
|
|
+ rt_enter_critical();
|
|
|
+ data = rt_link_scb->rx_record.dataspace;
|
|
|
+ size = receive_frame->extend.parameter;
|
|
|
+ serve = receive_frame->head.channel;
|
|
|
+ /* empty rx_record */
|
|
|
+ rt_link_scb->rx_record.rx_seq += rt_link_scb->rx_record.total;
|
|
|
+ rt_link_scb->rx_record.dataspace = RT_NULL;
|
|
|
+ rt_link_scb->rx_record.long_count = 0;
|
|
|
+ rt_link_scb->rx_record.total = 0;
|
|
|
+ ack_mask = RT_LINK_ACK_MAX;
|
|
|
+ rt_link_frame_stop_receive(receive_frame);
|
|
|
+ rt_exit_critical();
|
|
|
+
|
|
|
+ if (rt_link_scb->channel[serve].upload_callback == RT_NULL)
|
|
|
+ {
|
|
|
+ rt_free(data);
|
|
|
+ LOG_E("channel %d haven't been registered.", serve);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ rt_link_scb->channel[serve].upload_callback(data, size);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if (rt_link_hw_recv_len(rt_link_scb->rx_buffer) < (receive_frame->data_len % RT_LINK_MAX_DATA_LENGTH))
|
|
|
+ {
|
|
|
+ rt_int32_t timeout = RT_LINK_LONG_FRAME_TIMEOUT;
|
|
|
+ rt_timer_control(&rt_link_scb->longframetimer, RT_TIMER_CTRL_SET_TIME, &timeout);
|
|
|
+ rt_timer_start(&rt_link_scb->longframetimer);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_link_long_handle(struct rt_link_frame *receive_frame)
|
|
|
+{
|
|
|
+ static rt_uint8_t count_mask = 0;
|
|
|
+ if (rt_link_scb->rx_record.long_count == 0)
|
|
|
+ {
|
|
|
+ /* Receive this long package for the first time:
|
|
|
+ * calculates the total number of frames,
|
|
|
+ * requests space, and turns on the receive timer */
|
|
|
+ _long_handle_first(receive_frame, &count_mask);
|
|
|
+ }
|
|
|
+ if (rt_link_scb->rx_record.total > 0)
|
|
|
+ {
|
|
|
+ /* Intermediate frame processing:
|
|
|
+ * serial number repeated check,
|
|
|
+ * receive completion check, reply to ACK */
|
|
|
+ _long_handle_second(receive_frame, count_mask);
|
|
|
+ }
|
|
|
+ receive_frame->real_data = RT_NULL;
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_link_handshake_handle(struct rt_link_frame *receive_frame)
|
|
|
+{
|
|
|
+ LOG_D("Sequence(%d) is a connect handshake frame.", receive_frame->head.sequence);
|
|
|
+ rt_link_scb->link_status = RT_LINK_CONNECT_DONE;
|
|
|
+ /* sync requester tx seq, responder rx seq = requester tx seq */
|
|
|
+ rt_link_scb->rx_record.rx_seq = receive_frame->head.sequence;
|
|
|
+ /* sync requester rx seq, responder tx seq = requester rx seq */
|
|
|
+ rt_link_scb->tx_seq = receive_frame->extend.parameter;
|
|
|
+ rt_link_command_frame_send(receive_frame->head.sequence, RT_LINK_CONFIRM_FRAME, RT_NULL);
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+/* Discriminate frame type */
|
|
|
+static rt_err_t rt_link_parse_frame(struct rt_link_frame *receive_frame)
|
|
|
+{
|
|
|
+ switch (receive_frame->attribute)
|
|
|
+ {
|
|
|
+ case RT_LINK_RESEND_FRAME:
|
|
|
+ rt_link_resend_handle(receive_frame);
|
|
|
+ break;
|
|
|
+ case RT_LINK_CONFIRM_FRAME:
|
|
|
+ rt_link_confirm_handle(receive_frame);
|
|
|
+ break;
|
|
|
+ case RT_LINK_SHORT_DATA_FRAME:
|
|
|
+ rt_link_short_handle(receive_frame);
|
|
|
+ break;
|
|
|
+ case RT_LINK_LONG_DATA_FRAME:
|
|
|
+ rt_link_long_handle(receive_frame);
|
|
|
+ break;
|
|
|
+ case RT_LINK_HANDSHAKE_FRAME:
|
|
|
+ rt_link_handshake_handle(receive_frame);
|
|
|
+ break;
|
|
|
+ case RT_LINK_SESSION_END:
|
|
|
+ rt_link_frame_stop_receive(receive_frame);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+/* Empty the sending list */
|
|
|
+static void rt_link_datalist_empty(void)
|
|
|
+{
|
|
|
+ struct rt_link_frame *find_frame = RT_NULL;
|
|
|
+ rt_slist_t *tem_list = rt_slist_first(&rt_link_scb->tx_data_slist);
|
|
|
+ while (tem_list != RT_NULL)
|
|
|
+ {
|
|
|
+ find_frame = rt_container_of(tem_list, struct rt_link_frame, slist);
|
|
|
+ tem_list = rt_slist_next(tem_list);
|
|
|
+ rt_enter_critical();
|
|
|
+ rt_slist_remove(&rt_link_scb->tx_data_slist, &find_frame->slist);
|
|
|
+ rt_exit_critical();
|
|
|
+
|
|
|
+ find_frame->real_data = RT_NULL;
|
|
|
+ rt_link_frame_free(find_frame);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/* RT_LINK_READ_CHECK_EVENT handle */
|
|
|
+static void rt_link_frame_check(void)
|
|
|
+{
|
|
|
+ static struct rt_link_frame receive_frame = {0};
|
|
|
+ static rt_link_frame_parse_t analysis_status = FIND_FRAME_HEAD;
|
|
|
+ static rt_uint8_t *data = RT_NULL;
|
|
|
+ static rt_uint16_t buff_len = RT_LINK_HEAD_LENGTH;
|
|
|
+
|
|
|
+ struct rt_link_frame *send_frame = RT_NULL;
|
|
|
+ rt_tick_t timeout = 0;
|
|
|
+ rt_uint8_t *real_data = RT_NULL;
|
|
|
+ rt_uint32_t temporary_crc = 0;
|
|
|
+
|
|
|
+ rt_uint8_t offset = 0;
|
|
|
+ rt_size_t recv_len = rt_link_hw_recv_len(rt_link_scb->rx_buffer);
|
|
|
+ while (recv_len > 0)
|
|
|
+ {
|
|
|
+ switch (analysis_status)
|
|
|
+ {
|
|
|
+ case FIND_FRAME_HEAD:
|
|
|
+ {
|
|
|
+ /* if we can't find frame head, throw that data */
|
|
|
+ if ((*rt_link_scb->rx_buffer->read_point & RT_LINK_FRAME_HEAD_MASK) == RT_LINK_FRAME_HEAD)
|
|
|
+ {
|
|
|
+ analysis_status = PARSE_FRAME_HEAD;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ rt_link_hw_buffer_point_shift(&rt_link_scb->rx_buffer->read_point, 1);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ case PARSE_FRAME_HEAD:
|
|
|
+ {
|
|
|
+ if (recv_len < buff_len)
|
|
|
+ {
|
|
|
+ LOG_D("The length is not enough,recv=%d buff=%d", recv_len, buff_len);
|
|
|
+ return ;
|
|
|
+ }
|
|
|
+ /* Data is an offset address */
|
|
|
+ data = rt_link_scb->rx_buffer->read_point;
|
|
|
+ rt_link_frame_init(&receive_frame, RT_NULL);
|
|
|
+ rt_link_hw_copy((rt_uint8_t *)&receive_frame.head, data, sizeof(struct rt_link_frame_head));
|
|
|
+ rt_link_hw_buffer_point_shift(&data, sizeof(struct rt_link_frame_head));
|
|
|
+ receive_frame.data_len = receive_frame.head.length;
|
|
|
+ LOG_D("check seq(%d) data len(%d).", receive_frame.head.sequence, receive_frame.data_len);
|
|
|
+
|
|
|
+ if (receive_frame.head.extend)
|
|
|
+ {
|
|
|
+ buff_len += RT_LINK_MAX_EXTEND_LENGTH;
|
|
|
+ analysis_status = PARSE_FRAME_EXTEND;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ analysis_status = PARSE_FRAME_SEQ;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ case PARSE_FRAME_EXTEND:
|
|
|
+ {
|
|
|
+ if (receive_frame.head.extend)
|
|
|
+ {
|
|
|
+ if (recv_len < buff_len)
|
|
|
+ {
|
|
|
+ LOG_D("PARSE_FRAME_EXTEND: actual: %d, need: %d.", recv_len, buff_len);
|
|
|
+
|
|
|
+ /* should set timer, control receive frame timeout, one shot */
|
|
|
+ timeout = 50;
|
|
|
+ rt_timer_control(&rt_link_scb->recvtimer, RT_TIMER_CTRL_SET_TIME, &timeout);
|
|
|
+ rt_timer_start(&rt_link_scb->recvtimer);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ rt_link_hw_copy((rt_uint8_t *)&receive_frame.extend, data, sizeof(struct rt_link_extend));
|
|
|
+ rt_link_hw_buffer_point_shift(&data, sizeof(struct rt_link_extend));
|
|
|
+ switch (receive_frame.extend.attribute)
|
|
|
+ {
|
|
|
+ case RT_LINK_RESEND_FRAME:
|
|
|
+ case RT_LINK_LONG_DATA_FRAME:
|
|
|
+ case RT_LINK_HANDSHAKE_FRAME:
|
|
|
+ receive_frame.attribute = receive_frame.extend.attribute;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ receive_frame.attribute = RT_LINK_RESERVE_FRAME;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (receive_frame.head.crc)
|
|
|
+ {
|
|
|
+ receive_frame.attribute = RT_LINK_SHORT_DATA_FRAME;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ receive_frame.attribute = RT_LINK_CONFIRM_FRAME;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (receive_frame.attribute == RT_LINK_RESERVE_FRAME)
|
|
|
+ {
|
|
|
+ LOG_D("quick filter error frame.");
|
|
|
+ rt_link_frame_stop_receive(&receive_frame);
|
|
|
+ buff_len = RT_LINK_HEAD_LENGTH;
|
|
|
+ analysis_status = FIND_FRAME_HEAD;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ analysis_status = PARSE_FRAME_SEQ;
|
|
|
+ }
|
|
|
+
|
|
|
+ case PARSE_FRAME_SEQ:
|
|
|
+ {
|
|
|
+ if ((receive_frame.attribute == RT_LINK_CONFIRM_FRAME) || (receive_frame.attribute == RT_LINK_RESEND_FRAME))
|
|
|
+ {
|
|
|
+ offset = rt_link_check_seq(receive_frame.head.sequence, rt_link_scb->tx_seq);
|
|
|
+ if (rt_slist_first(&rt_link_scb->tx_data_slist) != RT_NULL)
|
|
|
+ {
|
|
|
+ send_frame = rt_container_of(rt_link_scb->tx_data_slist.next, struct rt_link_frame, slist);
|
|
|
+ if (offset > send_frame->total)
|
|
|
+ {
|
|
|
+ /* exceptional frame, ignore it */
|
|
|
+ LOG_D("seq (%d) failed, tx_seq (%d).offset=(%d) total= (%d)", receive_frame.head.sequence, rt_link_scb->tx_seq, offset, send_frame->total);
|
|
|
+ rt_link_frame_stop_receive(&receive_frame);
|
|
|
+ buff_len = RT_LINK_HEAD_LENGTH;
|
|
|
+ analysis_status = FIND_FRAME_HEAD;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ offset = rt_link_check_seq(receive_frame.head.sequence, rt_link_scb->rx_record.rx_seq) - 1;
|
|
|
+ if ((offset > RT_LINK_FRAMES_MAX) && (receive_frame.attribute != RT_LINK_HANDSHAKE_FRAME))
|
|
|
+ {
|
|
|
+ /* exceptional frame, ignore it */
|
|
|
+ LOG_D("seq (%d) failed, rx_seq (%d) offset=(%d) attr= (%d) status (%d)", receive_frame.head.sequence, rt_link_scb->rx_record.rx_seq, offset, receive_frame.attribute, rt_link_scb->link_status);
|
|
|
+ rt_link_frame_stop_receive(&receive_frame);
|
|
|
+ buff_len = RT_LINK_HEAD_LENGTH;
|
|
|
+ analysis_status = FIND_FRAME_HEAD;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ buff_len += receive_frame.data_len;
|
|
|
+ if (receive_frame.head.crc)
|
|
|
+ {
|
|
|
+ buff_len += RT_LINK_CRC_LENGTH;
|
|
|
+ analysis_status = CHECK_FRAME_CRC;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ analysis_status = HEADLE_FRAME_DATA;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ case CHECK_FRAME_CRC:
|
|
|
+ {
|
|
|
+ if (receive_frame.head.crc)
|
|
|
+ {
|
|
|
+ if (recv_len < buff_len)
|
|
|
+ {
|
|
|
+ /* should set timer, control receive frame timeout, one shot */
|
|
|
+ timeout = 50;
|
|
|
+ rt_timer_control(&rt_link_scb->recvtimer, RT_TIMER_CTRL_SET_TIME, &timeout);
|
|
|
+ rt_timer_start(&rt_link_scb->recvtimer);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ real_data = data;
|
|
|
+ rt_timer_stop(&rt_link_scb->recvtimer);
|
|
|
+ rt_link_hw_buffer_point_shift(&data, receive_frame.data_len);
|
|
|
+ rt_link_hw_copy((rt_uint8_t *)&receive_frame.crc, data, RT_LINK_CRC_LENGTH);
|
|
|
+ temporary_crc = rt_link_scb->calculate_crc(RT_TRUE, rt_link_scb->rx_buffer->read_point, buff_len - RT_LINK_CRC_LENGTH);
|
|
|
+ if (receive_frame.crc != temporary_crc)
|
|
|
+ {
|
|
|
+ /* check failed. ready resent */
|
|
|
+ LOG_D("CRC: calc:(0x%08x) ,recv:(0x%08x).", temporary_crc, receive_frame.crc);
|
|
|
+ /* quick resent, when sequence is right, we can ask for reset this frame */
|
|
|
+ rt_link_command_frame_send(receive_frame.head.sequence, RT_LINK_RESEND_FRAME, RT_NULL);
|
|
|
+
|
|
|
+ /* throw the error frame */
|
|
|
+ buff_len = RT_LINK_HEAD_LENGTH;
|
|
|
+ rt_link_frame_stop_receive(&receive_frame);
|
|
|
+
|
|
|
+ /* clear the frame information */
|
|
|
+ analysis_status = FIND_FRAME_HEAD;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ /* fill real data point */
|
|
|
+ receive_frame.real_data = real_data;
|
|
|
+ }
|
|
|
+ analysis_status = HEADLE_FRAME_DATA;
|
|
|
+ }
|
|
|
+
|
|
|
+ case HEADLE_FRAME_DATA:
|
|
|
+ {
|
|
|
+ rt_link_hw_buffer_point_shift(&rt_link_scb->rx_buffer->read_point, buff_len);
|
|
|
+ rt_link_parse_frame(&receive_frame);
|
|
|
+ data = RT_NULL;
|
|
|
+ buff_len = RT_LINK_HEAD_LENGTH;
|
|
|
+ analysis_status = FIND_FRAME_HEAD;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ default:
|
|
|
+ LOG_E("analysis_status is error.");
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ recv_len = rt_link_hw_recv_len(rt_link_scb->rx_buffer);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void rt_link_send_ready(void)
|
|
|
+{
|
|
|
+ if (rt_link_scb->link_status != RT_LINK_CONNECT_DONE)
|
|
|
+ {
|
|
|
+ rt_link_scb->link_status = RT_LINK_NO_RESPONSE;
|
|
|
+ rt_link_command_frame_send(rt_link_scb->tx_seq, RT_LINK_HANDSHAKE_FRAME, rt_link_scb->rx_record.rx_seq);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (RT_EOK != rt_link_frame_send(&rt_link_scb->tx_data_slist))
|
|
|
+ {
|
|
|
+ rt_event_send(&rt_link_scb->event, RT_LINK_SEND_FAILED_EVENT);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void rt_link_frame_recv_timeout(void)
|
|
|
+{
|
|
|
+ /* The receiving frame timeout and a new receive begins */
|
|
|
+ rt_link_hw_buffer_point_shift(&rt_link_scb->rx_buffer->read_point, rt_link_hw_recv_len(rt_link_scb->rx_buffer));
|
|
|
+}
|
|
|
+
|
|
|
+static void rt_link_send_timeout(void)
|
|
|
+{
|
|
|
+ static rt_uint8_t count = 0;
|
|
|
+ if (count++ > 5)
|
|
|
+ {
|
|
|
+ LOG_W("Send timeout, please check the link status!");
|
|
|
+ count = 0;
|
|
|
+ rt_event_send(&rt_link_scb->event, RT_LINK_SEND_FAILED_EVENT);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ rt_timer_start(&rt_link_scb->sendtimer);
|
|
|
+ rt_link_command_frame_send(rt_link_scb->tx_seq, RT_LINK_HANDSHAKE_FRAME, rt_link_scb->rx_record.rx_seq);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static int rt_link_long_recv_timeout(void)
|
|
|
+{
|
|
|
+ static rt_uint8_t count = 0;
|
|
|
+ if (count++ > 5)
|
|
|
+ {
|
|
|
+ LOG_W("long package receive timeout");
|
|
|
+ count = 0;
|
|
|
+ _stop_recv_long();
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ for (rt_uint8_t total = rt_link_scb->rx_record.total; total > 0; total--)
|
|
|
+ {
|
|
|
+ if (((rt_link_scb->rx_record.long_count >> (total - 1)) & 0x01) == 0x00)
|
|
|
+ {
|
|
|
+ /* resend command */
|
|
|
+ rt_link_command_frame_send((rt_link_scb->rx_record.rx_seq + total), RT_LINK_RESEND_FRAME, RT_NULL);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+void rt_link_thread(void *parameter)
|
|
|
+{
|
|
|
+ rt_uint32_t recved = 0;
|
|
|
+ while (1)
|
|
|
+ {
|
|
|
+ rt_event_recv(&rt_link_scb->event, RT_LINK_READ_CHECK_EVENT |
|
|
|
+ RT_LINK_SEND_READY_EVENT |
|
|
|
+ RT_LINK_SEND_TIMEOUT_EVENT |
|
|
|
+ RT_LINK_RECV_TIMEOUT_FRAME_EVENT |
|
|
|
+ RT_LINK_RECV_TIMEOUT_LONG_EVENT,
|
|
|
+ RT_EVENT_FLAG_OR | RT_EVENT_FLAG_CLEAR,
|
|
|
+ RT_WAITING_FOREVER,
|
|
|
+ &recved);
|
|
|
+
|
|
|
+ if (recved & RT_LINK_READ_CHECK_EVENT)
|
|
|
+ {
|
|
|
+ rt_link_frame_check();
|
|
|
+ }
|
|
|
+
|
|
|
+ if (recved & RT_LINK_SEND_READY_EVENT)
|
|
|
+ {
|
|
|
+ rt_link_send_ready();
|
|
|
+ }
|
|
|
+
|
|
|
+ if (recved & RT_LINK_SEND_TIMEOUT_EVENT)
|
|
|
+ {
|
|
|
+ rt_link_send_timeout();
|
|
|
+ }
|
|
|
+
|
|
|
+ if (recved & RT_LINK_RECV_TIMEOUT_FRAME_EVENT)
|
|
|
+ {
|
|
|
+ rt_link_frame_recv_timeout();
|
|
|
+ }
|
|
|
+
|
|
|
+ if (recved & RT_LINK_RECV_TIMEOUT_LONG_EVENT)
|
|
|
+ {
|
|
|
+ rt_link_long_recv_timeout();
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void rt_link_sendtimer_callback(void *parameter)
|
|
|
+{
|
|
|
+ rt_event_send(&rt_link_scb->event, RT_LINK_SEND_TIMEOUT_EVENT);
|
|
|
+}
|
|
|
+
|
|
|
+static void rt_link_recvtimer_callback(void *parameter)
|
|
|
+{
|
|
|
+ rt_event_send(&rt_link_scb->event, RT_LINK_RECV_TIMEOUT_FRAME_EVENT);
|
|
|
+}
|
|
|
+
|
|
|
+static void rt_link_receive_long_frame_callback(void *parameter)
|
|
|
+{
|
|
|
+ rt_event_send(&rt_link_scb->event, RT_LINK_RECV_TIMEOUT_LONG_EVENT);
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * rtlink send data interface
|
|
|
+ * @param service Registered service channel, choose enum rt_link_service_t
|
|
|
+ * @param data send data
|
|
|
+ * @param size send data size
|
|
|
+ * @return The actual size of the data sent
|
|
|
+ * */
|
|
|
+rt_size_t rt_link_send(rt_link_service_t service, void *data, rt_size_t size)
|
|
|
+{
|
|
|
+ if ((size == 0) || (data == RT_NULL) || (service >= RT_LINK_SERVICE_MAX))
|
|
|
+ {
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+ rt_mutex_take(&rt_link_scb->tx_lock, RT_WAITING_FOREVER);
|
|
|
+
|
|
|
+ rt_uint32_t recved = 0;
|
|
|
+ rt_err_t result = RT_EOK;
|
|
|
+ rt_uint32_t timeout = 0;
|
|
|
+
|
|
|
+ rt_uint8_t total = 0; /* The total number of frames to send */
|
|
|
+ rt_uint8_t index = 0; /* The index of the split packet */
|
|
|
+ rt_size_t offset = 0; /* The offset of the send data */
|
|
|
+
|
|
|
+ struct rt_link_frame *send_frame = RT_NULL;
|
|
|
+ rt_link_frame_attribute_t attribute;
|
|
|
+ if (size % RT_LINK_MAX_DATA_LENGTH == 0)
|
|
|
+ {
|
|
|
+ total = size / RT_LINK_MAX_DATA_LENGTH;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ total = size / RT_LINK_MAX_DATA_LENGTH + 1;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (total > RT_LINK_FRAMES_MAX)
|
|
|
+ {
|
|
|
+ result = -RT_ENOMEM;
|
|
|
+ goto __exit;
|
|
|
+ }
|
|
|
+ else if (total > 1)
|
|
|
+ {
|
|
|
+ attribute = RT_LINK_LONG_DATA_FRAME;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ attribute = RT_LINK_SHORT_DATA_FRAME;
|
|
|
+ }
|
|
|
+
|
|
|
+ do
|
|
|
+ {
|
|
|
+ send_frame = rt_malloc(sizeof(struct rt_link_frame));
|
|
|
+ rt_link_frame_init(send_frame, FRAME_CRC | FRAME_ACK);
|
|
|
+ send_frame->head.sequence = rt_link_scb->tx_seq + 1 + index;
|
|
|
+ send_frame->head.channel = service;
|
|
|
+ send_frame->real_data = (rt_uint8_t *)data + offset;
|
|
|
+ send_frame->index = index;
|
|
|
+ send_frame->total = total;
|
|
|
+
|
|
|
+ if (attribute == RT_LINK_LONG_DATA_FRAME)
|
|
|
+ {
|
|
|
+ send_frame->attribute = RT_LINK_LONG_DATA_FRAME;
|
|
|
+ if (offset + RT_LINK_MAX_DATA_LENGTH > size)
|
|
|
+ {
|
|
|
+ send_frame->data_len = size - offset;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ send_frame->data_len = RT_LINK_MAX_DATA_LENGTH;
|
|
|
+ offset += RT_LINK_MAX_DATA_LENGTH;
|
|
|
+ }
|
|
|
+
|
|
|
+ rt_link_frame_extend_config(send_frame, RT_LINK_LONG_DATA_FRAME, size);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ send_frame->attribute = RT_LINK_SHORT_DATA_FRAME;
|
|
|
+ send_frame->data_len = size;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* append the frame on the tail of list */
|
|
|
+ LOG_D("new data append on the send slist, seq(%d), len(%d).", send_frame->head.sequence, send_frame->data_len);
|
|
|
+ rt_slist_append(&rt_link_scb->tx_data_slist, &send_frame->slist);
|
|
|
+
|
|
|
+ index++;
|
|
|
+ }while(total > index);
|
|
|
+
|
|
|
+ timeout = RT_LINK_SENT_FRAME_TIMEOUT * total;
|
|
|
+ rt_timer_control(&rt_link_scb->sendtimer, RT_TIMER_CTRL_SET_TIME, &timeout);
|
|
|
+ rt_timer_start(&rt_link_scb->sendtimer);
|
|
|
+ /* Notify the core thread to send packet */
|
|
|
+ rt_event_send(&rt_link_scb->event, RT_LINK_SEND_READY_EVENT);
|
|
|
+
|
|
|
+ /* Wait for the packet to be sent successfully */
|
|
|
+ rt_event_recv(&rt_link_scb->event, RT_LINK_SEND_OK_EVENT | RT_LINK_SEND_FAILED_EVENT, RT_EVENT_FLAG_OR | RT_EVENT_FLAG_CLEAR, RT_WAITING_FOREVER, &recved);
|
|
|
+
|
|
|
+ if (recved & RT_LINK_SEND_OK_EVENT)
|
|
|
+ {
|
|
|
+ result = RT_EOK;
|
|
|
+ }
|
|
|
+ else if (recved & RT_LINK_SEND_FAILED_EVENT)
|
|
|
+ {
|
|
|
+ LOG_E("the data (%dB) send failed", size);
|
|
|
+ result = -RT_ERROR;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ LOG_E("unexpected event.");
|
|
|
+ result = -RT_ERROR;
|
|
|
+ }
|
|
|
+__exit:
|
|
|
+ rt_timer_stop(&rt_link_scb->sendtimer);
|
|
|
+ /* Empty the sending list */
|
|
|
+ rt_link_datalist_empty();
|
|
|
+ rt_mutex_release(&rt_link_scb->tx_lock);
|
|
|
+ if (result == RT_EOK)
|
|
|
+ {
|
|
|
+ return size;
|
|
|
+ }
|
|
|
+ return result;
|
|
|
+}
|
|
|
+
|
|
|
+void rtlink_status(void)
|
|
|
+{
|
|
|
+ rt_kprintf("rtlink status:\n");
|
|
|
+ if (rt_link_scb != RT_NULL)
|
|
|
+ {
|
|
|
+ rt_kprintf("\tlink status=%d\n", rt_link_scb->link_status);
|
|
|
+
|
|
|
+ rt_kprintf("\trx seq=%d\n", rt_link_scb->rx_record.rx_seq);
|
|
|
+ rt_kprintf("\ttx seq=%d\n", rt_link_scb->tx_seq);
|
|
|
+ rt_kprintf("\trecv len=%d\n", rt_link_hw_recv_len(rt_link_scb->rx_buffer));
|
|
|
+
|
|
|
+ rt_tick_t state = 0;
|
|
|
+ rt_timer_control(&rt_link_scb->longframetimer, RT_TIMER_CTRL_GET_STATE, &state);
|
|
|
+ rt_kprintf("\tlong timer state=%d\n", state);
|
|
|
+ rt_timer_control(&rt_link_scb->sendtimer, RT_TIMER_CTRL_GET_STATE, &state);
|
|
|
+ rt_kprintf("\tsend timer state=%d\n", state);
|
|
|
+
|
|
|
+ rt_kprintf("\tevent set=0x%08x\n", rt_link_scb->event.set);
|
|
|
+ if (rt_link_scb->tx_data_slist.next)
|
|
|
+ {
|
|
|
+ rt_slist_t *data = RT_NULL;
|
|
|
+ rt_slist_for_each(data, &rt_link_scb->tx_data_slist)
|
|
|
+ {
|
|
|
+ rt_kprintf("\tsend data list: serv %u\t", ((struct rt_link_frame_head *)data)->channel);
|
|
|
+ rt_kprintf(" seq %u\t", ((struct rt_link_frame_head *)data)->sequence);
|
|
|
+ rt_kprintf(" len %u\n", ((struct rt_link_frame_head *)data)->length);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ rt_kprintf("\tsend data list: NULL\n");
|
|
|
+ }
|
|
|
+
|
|
|
+ rt_uint8_t serv = sizeof(rt_link_scb->channel) / sizeof(struct rt_link_service);
|
|
|
+ while (serv--)
|
|
|
+ {
|
|
|
+ rt_kprintf("\tservices [%d](0x%p)\n", serv, rt_link_scb->channel[serv]);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ rt_kprintf("status NULL, please check the initialization status!\n");
|
|
|
+ }
|
|
|
+}
|
|
|
+MSH_CMD_EXPORT(rtlink_status, Display RTLINK status);
|
|
|
+
|
|
|
+/**
|
|
|
+ * rtlink deinit the interface
|
|
|
+ * */
|
|
|
+rt_err_t rt_link_deinit(void)
|
|
|
+{
|
|
|
+ rt_enter_critical();
|
|
|
+ rt_link_hw_deinit();
|
|
|
+ if (rt_link_scb)
|
|
|
+ {
|
|
|
+ rt_timer_detach(&rt_link_scb->longframetimer);
|
|
|
+ rt_timer_detach(&rt_link_scb->sendtimer);
|
|
|
+ rt_timer_detach(&rt_link_scb->recvtimer);
|
|
|
+ rt_mutex_detach(&rt_link_scb->tx_lock);
|
|
|
+ rt_event_detach(&rt_link_scb->event);
|
|
|
+ rt_free(rt_link_scb);
|
|
|
+ rt_link_scb = RT_NULL;
|
|
|
+ }
|
|
|
+ rt_thread_t thread = rt_thread_find(RT_LINK_THREAD_NAME);
|
|
|
+ if (thread)
|
|
|
+ {
|
|
|
+ rt_thread_delete(thread);
|
|
|
+ }
|
|
|
+ rt_exit_critical();
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+MSH_CMD_EXPORT(rt_link_deinit, rt link deinit);
|
|
|
+
|
|
|
+/**
|
|
|
+ * rtlink initializes the interface, usually automatically.
|
|
|
+ * @return int Function Execution Result
|
|
|
+ * */
|
|
|
+int rt_link_init(void)
|
|
|
+{
|
|
|
+ rt_err_t result = RT_EOK;
|
|
|
+ rt_thread_t thread = RT_NULL;
|
|
|
+
|
|
|
+ if (rt_link_scb != RT_NULL)
|
|
|
+ {
|
|
|
+ goto __exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ rt_link_scb = rt_malloc(sizeof(struct rt_link_session));
|
|
|
+ if (rt_link_scb == RT_NULL)
|
|
|
+ {
|
|
|
+ result = -RT_ENOMEM;
|
|
|
+ goto __exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ rt_memset(rt_link_scb, 0, sizeof(struct rt_link_session));
|
|
|
+ rt_event_init(&rt_link_scb->event, "lny_event", RT_IPC_FLAG_FIFO);
|
|
|
+ rt_event_control(&rt_link_scb->event, RT_IPC_CMD_RESET, RT_NULL);
|
|
|
+
|
|
|
+ rt_mutex_init(&rt_link_scb->tx_lock, "tx_lock", RT_IPC_FLAG_FIFO);
|
|
|
+ rt_timer_init(&rt_link_scb->sendtimer, "tx_time", rt_link_sendtimer_callback,
|
|
|
+ RT_NULL, 0, RT_TIMER_FLAG_SOFT_TIMER | RT_TIMER_FLAG_PERIODIC);
|
|
|
+ rt_timer_init(&rt_link_scb->recvtimer, "rx_time", rt_link_recvtimer_callback,
|
|
|
+ RT_NULL, 0, RT_TIMER_FLAG_SOFT_TIMER | RT_TIMER_FLAG_ONE_SHOT);
|
|
|
+ rt_timer_init(&rt_link_scb->longframetimer, "rxl_time", rt_link_receive_long_frame_callback,
|
|
|
+ RT_NULL, 0, RT_TIMER_FLAG_SOFT_TIMER | RT_TIMER_FLAG_PERIODIC);
|
|
|
+
|
|
|
+ rt_link_scb->link_status = RT_LINK_ESTABLISHING;
|
|
|
+
|
|
|
+ rt_link_scb->rx_record.rx_seq = 255;
|
|
|
+
|
|
|
+ rt_slist_init(&rt_link_scb->tx_data_slist);
|
|
|
+ rt_link_scb->tx_seq = RT_LINK_INIT_FRAME_SEQENCE;
|
|
|
+
|
|
|
+ /* create rtlink core work thread */
|
|
|
+ thread = rt_thread_create(RT_LINK_THREAD_NAME,
|
|
|
+ rt_link_thread,
|
|
|
+ RT_NULL,
|
|
|
+ RT_LINK_THREAD_STACK_SIZE,
|
|
|
+ RT_LINK_THREAD_PRIORITY,
|
|
|
+ RT_LINK_THREAD_TICK);
|
|
|
+ if (thread == RT_NULL)
|
|
|
+ {
|
|
|
+ result = -RT_ENOMEM;
|
|
|
+ goto __exit;
|
|
|
+ }
|
|
|
+ rt_thread_startup(thread);
|
|
|
+ result = rt_link_hw_init();
|
|
|
+
|
|
|
+__exit:
|
|
|
+ if (result != RT_EOK)
|
|
|
+ {
|
|
|
+ LOG_E("rtlink init failed.");
|
|
|
+ rt_link_deinit();
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ LOG_I("rtlink init success.");
|
|
|
+ }
|
|
|
+ return result;
|
|
|
+}
|
|
|
+#ifdef RT_LINK_AUTO_INIT
|
|
|
+ INIT_ENV_EXPORT(rt_link_init);
|
|
|
+#endif
|
|
|
+MSH_CMD_EXPORT(rt_link_init, rt link init);
|
|
|
+
|
|
|
+/**
|
|
|
+ * rtlink service attach
|
|
|
+ * @param service Registered service channel, choose enum rt_link_service_t
|
|
|
+ * @param function receive callback function
|
|
|
+ * @return Function Execution Result
|
|
|
+ * */
|
|
|
+rt_err_t rt_link_service_attach(rt_link_service_t service, rt_err_t (*function)(void *data, rt_size_t size))
|
|
|
+{
|
|
|
+ if (service >= RT_LINK_SERVICE_MAX)
|
|
|
+ {
|
|
|
+ LOG_W("Invalid parameter.");
|
|
|
+ return -RT_ERROR;
|
|
|
+ }
|
|
|
+ rt_link_scb->channel[service].upload_callback = function;
|
|
|
+ LOG_I("rt link attach service[%02d].", service);
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * rtlink service detach
|
|
|
+ * @param service Registered service channel, choose enum rt_link_service_t
|
|
|
+ * @return rt_err_t Function Execution Result
|
|
|
+ * */
|
|
|
+rt_err_t rt_link_service_detach(rt_link_service_t service)
|
|
|
+{
|
|
|
+ if (service >= RT_LINK_SERVICE_MAX)
|
|
|
+ {
|
|
|
+ LOG_W("Invalid parameter.");
|
|
|
+ return -RT_ERROR;
|
|
|
+ }
|
|
|
+ rt_link_scb->channel[service].upload_callback = RT_NULL;
|
|
|
+ LOG_I("rt link detach service[%02d].", service);
|
|
|
+ return RT_EOK;
|
|
|
+}
|