您最多能選擇 25 個主題
主題必須以字母或數字為開頭，可包含連接號「-」且最長為 35 個字元。
37 行
676 B
37 行
676 B
#include "uart_driver.h"
|
|
#include "datalink.h"
|
|
|
|
// payload rx buffer
|
|
#define PAYLOAD_BUFFER_LEN (256+3)
|
|
|
|
|
|
SBMP_Endpoint *dlnk_ep;
|
|
|
|
|
|
/** func used for sending bytes by SBMP */
|
|
static void FLASH_FN u0_putc(uint8_t c)
|
|
{
|
|
UART_WriteChar(UART0, c, 0);
|
|
}
|
|
|
|
|
|
static void FLASH_FN dg_handler(SBMP_Datagram *dg)
|
|
{
|
|
dbg("[SBMP] Datagram received, type %d", dg->type);
|
|
}
|
|
|
|
/** This is called by the UART rx handler */
|
|
void datalink_receive(uint8_t byte)
|
|
{
|
|
sbmp_ep_receive(dlnk_ep, byte);
|
|
}
|
|
|
|
/** Datalink */
|
|
void FLASH_FN datalinkInit(void)
|
|
{
|
|
dlnk_ep = sbmp_ep_init(NULL, NULL, PAYLOAD_BUFFER_LEN, dg_handler, u0_putc);
|
|
|
|
sbmp_ep_enable(dlnk_ep, true);
|
|
|
|
info("SBMP started on UART0");
|
|
}
|
|
|