diff options
Diffstat (limited to 'Projects/STM32WB5MM-DK/Applications/Thread/Thread_Coap_Generic/STM32_WPAN/App/app_thread.c')
-rw-r--r-- | Projects/STM32WB5MM-DK/Applications/Thread/Thread_Coap_Generic/STM32_WPAN/App/app_thread.c | 1168 |
1 files changed, 1168 insertions, 0 deletions
diff --git a/Projects/STM32WB5MM-DK/Applications/Thread/Thread_Coap_Generic/STM32_WPAN/App/app_thread.c b/Projects/STM32WB5MM-DK/Applications/Thread/Thread_Coap_Generic/STM32_WPAN/App/app_thread.c new file mode 100644 index 000000000..a8be7c42d --- /dev/null +++ b/Projects/STM32WB5MM-DK/Applications/Thread/Thread_Coap_Generic/STM32_WPAN/App/app_thread.c @@ -0,0 +1,1168 @@ +/* USER CODE BEGIN Header */ +/** + ****************************************************************************** + * File Name : App/app_thread.c + * Description : Thread Application. + ****************************************************************************** + * @attention + * + * <h2><center>© Copyright (c) 2019 STMicroelectronics. + * All rights reserved.</center></h2> + * + * This software component is licensed by ST under Ultimate Liberty license + * SLA0044, the "License"; You may not use this file except in compliance with + * the License. You may obtain a copy of the License at: + * www.st.com/SLA0044 + * + ****************************************************************************** + */ +/* USER CODE END Header */ + +/* Includes ------------------------------------------------------------------*/ +#include "app_common.h" +#include "utilities_common.h" +#include "app_entry.h" +#include "dbg_trace.h" +#include "app_thread.h" +#include "stm32wbxx_core_interface_def.h" +#include "openthread_api_wb.h" +#include "shci.h" +#include "stm_logging.h" +#include "app_conf.h" +#include "stm32_lpm.h" +#include "stm32_seq.h" +#if (CFG_USB_INTERFACE_ENABLE != 0) +#include "vcp.h" +#include "vcp_conf.h" +#endif /* (CFG_USB_INTERFACE_ENABLE != 0) */ + +/* Private includes -----------------------------------------------------------*/ +/* USER CODE BEGIN Includes */ + +/* USER CODE END Includes */ + +/* Private typedef -----------------------------------------------------------*/ +/* USER CODE BEGIN PTD */ + +/* USER CODE END PTD */ + +/* Private defines -----------------------------------------------------------*/ +#define C_SIZE_CMD_STRING 256U +#define C_PANID 0x1111U +#define C_CHANNEL_NB 14U +#define C_STRING_CIRCLE "O" + +/* USER CODE BEGIN PD */ +#define C_RESSOURCE "light" +#define COAP_PAYLOAD_LENGTH 2 +#define WAIT_TIMEOUT (5*1000*1000/CFG_TS_TICK_VAL) /**< 5s */ +/* USER CODE END PD */ + +/* Private macros ------------------------------------------------------------*/ +/* USER CODE BEGIN PM */ + +/* USER CODE END PM */ + +/* Private function prototypes -----------------------------------------------*/ +static void APP_THREAD_CheckWirelessFirmwareInfo(void); +static void APP_THREAD_DeviceConfig(void); +static void APP_THREAD_StateNotif(uint32_t NotifFlags, void *pContext); +static void APP_THREAD_TraceError(const char * pMess, uint32_t ErrCode); +#if (CFG_FULL_LOW_POWER == 0) +static void Send_CLI_To_M0(void); +#endif /* (CFG_FULL_LOW_POWER == 0) */ +static void Send_CLI_Ack_For_OT(void); +static void HostTxCb( void ); +static void Wait_Getting_Ack_From_M0(void); +static void Receive_Ack_From_M0(void); +static void Receive_Notification_From_M0(void); +#if (CFG_HW_LPUART1_ENABLED == 1) +extern void MX_LPUART1_UART_Init(void); +#endif +#if (CFG_HW_USART1_ENABLED == 1) +extern void MX_USART1_UART_Init(void); +#endif +#if (CFG_USB_INTERFACE_ENABLE != 0) +static uint32_t ProcessCmdString(uint8_t* buf , uint32_t len); +#else +#if (CFG_FULL_LOW_POWER == 0) +static void RxCpltCallback(void); +#endif /* (CFG_FULL_LOW_POWER == 0) */ +#endif /* (CFG_USB_INTERFACE_ENABLE != 0) */ + +/* USER CODE BEGIN PFP */ +static void APP_THREAD_CoapSendRequest(otCoapResource* aCoapRessource, + otCoapType aCoapType, + otCoapCode aCoapCode, + const char *aStringAddress, + const otIp6Address* aPeerAddress, + uint8_t* aPayload, + uint16_t Size, + otCoapResponseHandler aHandler, + void *aContext); + +static void APP_THREAD_CoapRequestHandler(void * pContext, + otMessage * pMessage, + const otMessageInfo * pMessageInfo); +static void APP_THREAD_CoapSendDataResponse(otMessage * pMessage, + const otMessageInfo * pMessageInfo); +static void APP_THREAD_CoapDataRespHandler( + void * aContext, + otMessage * pMessage, + const otMessageInfo * pMessageInfo, + otError result); + +static void APP_THREAD_InitPayloadWrite(void); +static void APP_THREAD_SendCoapMsg(void); +static void APP_THREAD_TimingElapsed(void); +static bool APP_THREAD_CheckMsgValidity(void); +/* USER CODE END PFP */ + +/* Private variables -----------------------------------------------*/ +#if (CFG_USB_INTERFACE_ENABLE != 0) +static uint8_t TmpString[C_SIZE_CMD_STRING]; +static uint8_t VcpRxBuffer[sizeof(TL_CmdSerial_t)]; /* Received Data over USB are stored in this buffer */ +static uint8_t VcpTxBuffer[sizeof(TL_EvtPacket_t) + 254U]; /* Transmit buffer over USB */ +#else +#if (CFG_FULL_LOW_POWER == 0) +static uint8_t aRxBuffer[C_SIZE_CMD_STRING]; +#endif /* (CFG_FULL_LOW_POWER == 0) */ +#endif /* (CFG_USB_INTERFACE_ENABLE != 0) */ + +#if (CFG_FULL_LOW_POWER == 0) +static uint8_t CommandString[C_SIZE_CMD_STRING]; +#endif /* (CFG_FULL_LOW_POWER == 0) */ +static __IO uint16_t indexReceiveChar = 0; +static __IO uint16_t CptReceiveCmdFromUser = 0; + +static TL_CmdPacket_t *p_thread_otcmdbuffer; +static TL_EvtPacket_t *p_thread_notif_M0_to_M4; +static __IO uint32_t CptReceiveMsgFromM0 = 0; +PLACE_IN_SECTION("MB_MEM1") ALIGN(4) static TL_TH_Config_t ThreadConfigBuffer; +PLACE_IN_SECTION("MB_MEM2") ALIGN(4) static TL_CmdPacket_t ThreadOtCmdBuffer; +PLACE_IN_SECTION("MB_MEM2") ALIGN(4) static uint8_t ThreadNotifRspEvtBuffer[sizeof(TL_PacketHeader_t) + TL_EVT_HDR_SIZE + 255U]; +PLACE_IN_SECTION("MB_MEM2") ALIGN(4) static TL_CmdPacket_t ThreadCliCmdBuffer; +extern uint8_t g_ot_notification_allowed; + +/* USER CODE BEGIN PV */ +static otCoapResource OT_Ressource = {C_RESSOURCE, APP_THREAD_CoapRequestHandler,"MyOwnContext", NULL}; +static otMessageInfo OT_MessageInfo = {0}; +static otMessage* pOT_Message = NULL; +static otMessage* pOT_MessageResponse = NULL; + +static uint8_t PayloadWrite[COAP_PAYLOAD_LENGTH]= {0}; +static uint8_t PayloadRead[COAP_PAYLOAD_LENGTH]= {0}; +static uint8_t TimerID; +/* USER CODE END PV */ + +/* Functions Definition ------------------------------------------------------*/ + +void APP_THREAD_Init( void ) +{ + /* USER CODE BEGIN APP_THREAD_INIT_1 */ + + /* USER CODE END APP_THREAD_INIT_1 */ + + SHCI_CmdStatus_t ThreadInitStatus; + + /* Check the compatibility with the Coprocessor Wireless Firmware loaded */ + APP_THREAD_CheckWirelessFirmwareInfo(); + +#if (CFG_USB_INTERFACE_ENABLE != 0) + VCP_Init(&VcpTxBuffer[0], &VcpRxBuffer[0]); +#endif /* (CFG_USB_INTERFACE_ENABLE != 0) */ + + /* Register cmdbuffer */ + APP_THREAD_RegisterCmdBuffer(&ThreadOtCmdBuffer); + + /** + * Do not allow standby in the application + */ + UTIL_LPM_SetOffMode(1 << CFG_LPM_APP_THREAD, UTIL_LPM_DISABLE); + + /* Init config buffer and call TL_THREAD_Init */ + APP_THREAD_TL_THREAD_INIT(); + + /* Configure UART for sending CLI command from M4 */ + APP_THREAD_Init_UART_CLI(); + + /* Send Thread start system cmd to M0 */ + ThreadInitStatus = SHCI_C2_THREAD_Init(); + + /* Prevent unused argument(s) compilation warning */ + UNUSED(ThreadInitStatus); + + /* Register task */ + /* Create the different tasks */ + UTIL_SEQ_RegTask( 1<<(uint32_t)CFG_TASK_MSG_FROM_M0_TO_M4, UTIL_SEQ_RFU, APP_THREAD_ProcessMsgM0ToM4); + + /* USER CODE BEGIN INIT TASKS */ + UTIL_SEQ_RegTask( 1<<(uint32_t)CFG_TASK_COAP_MSG_BUTTON, UTIL_SEQ_RFU, APP_THREAD_SendCoapMsg); + /* USER CODE END INIT TASKS */ + + /* Initialize and configure the Thread device*/ + APP_THREAD_DeviceConfig(); + + /* USER CODE BEGIN APP_THREAD_INIT_2 */ + HW_TS_Create(CFG_TIM_PROC_ID_ISR, &TimerID, hw_ts_SingleShot, APP_THREAD_TimingElapsed); + + APP_THREAD_InitPayloadWrite(); + /* USER CODE END APP_THREAD_INIT_2 */ +} + +/** + * @brief Trace the error or the warning reported. + * @param ErrId : + * @param ErrCode + * @retval None + */ +void APP_THREAD_Error(uint32_t ErrId, uint32_t ErrCode) +{ + /* USER CODE BEGIN APP_THREAD_Error_1 */ + + /* USER CODE END APP_THREAD_Error_1 */ + switch(ErrId) + { + case ERR_REC_MULTI_MSG_FROM_M0 : + APP_THREAD_TraceError("ERROR : ERR_REC_MULTI_MSG_FROM_M0 ", ErrCode); + break; + case ERR_THREAD_SET_STATE_CB : + APP_THREAD_TraceError("ERROR : ERR_THREAD_SET_STATE_CB ",ErrCode); + break; + case ERR_THREAD_SET_CHANNEL : + APP_THREAD_TraceError("ERROR : ERR_THREAD_SET_CHANNEL ",ErrCode); + break; + case ERR_THREAD_SET_PANID : + APP_THREAD_TraceError("ERROR : ERR_THREAD_SET_PANID ",ErrCode); + break; + case ERR_THREAD_IPV6_ENABLE : + APP_THREAD_TraceError("ERROR : ERR_THREAD_IPV6_ENABLE ",ErrCode); + break; + case ERR_THREAD_START : + APP_THREAD_TraceError("ERROR: ERR_THREAD_START ", ErrCode); + break; + case ERR_THREAD_ERASE_PERSISTENT_INFO : + APP_THREAD_TraceError("ERROR : ERR_THREAD_ERASE_PERSISTENT_INFO ",ErrCode); + break; + case ERR_THREAD_CHECK_WIRELESS : + APP_THREAD_TraceError("ERROR : ERR_THREAD_CHECK_WIRELESS ",ErrCode); + break; + /* USER CODE BEGIN APP_THREAD_Error_2 */ + case ERR_THREAD_COAP_START : + APP_THREAD_TraceError("ERROR : ERR_THREAD_COAP_START ",ErrCode); + break; + case ERR_THREAD_COAP_ADD_RESSOURCE : + APP_THREAD_TraceError("ERROR : ERR_THREAD_COAP_ADD_RESSOURCE ",ErrCode); + break; + case ERR_THREAD_MESSAGE_READ : + APP_THREAD_TraceError("ERROR : ERR_THREAD_MESSAGE_READ ",ErrCode); + break; + case ERR_THREAD_COAP_SEND_RESPONSE : + APP_THREAD_TraceError("ERROR : ERR_THREAD_COAP_SEND_RESPONSE ",ErrCode); + break; + case ERR_THREAD_COAP_APPEND : + APP_THREAD_TraceError("ERROR : ERR_THREAD_COAP_APPEND ",ErrCode); + break; + case ERR_THREAD_COAP_SEND_REQUEST : + APP_THREAD_TraceError("ERROR : ERR_THREAD_COAP_SEND_REQUEST ",ErrCode); + break; + case ERR_THREAD_MSG_COMPARE_FAILED: + APP_THREAD_TraceError("ERROR : ERR_THREAD_MSG_COMPARE_FAILED ",ErrCode); + break; + /* USER CODE END APP_THREAD_Error_2 */ + default : + APP_THREAD_TraceError("ERROR Unknown ", 0); + break; + } +} + +/** + * @brief Thread LCD initialisation + * @param None + * @retval None + */ +void APP_THREAD_LCD_DisplayInit(void) +{ + BSP_LCD_Init(0, LCD_ORIENTATION_LANDSCAPE); + /* Set LCD Foreground Layer */ + UTIL_LCD_SetFuncDriver(&LCD_Driver); /* SetFunc before setting device */ + UTIL_LCD_SetDevice(0); /* SetDevice after funcDriver is set */ + BSP_LCD_Clear(0,SSD1315_COLOR_BLACK); + BSP_LCD_DisplayOn(0); + BSP_LCD_Refresh(0); + UTIL_LCD_SetFont(&Font12); + /* Set the LCD Text Color */ + UTIL_LCD_SetTextColor(SSD1315_COLOR_WHITE); + UTIL_LCD_SetBackColor(SSD1315_COLOR_BLACK); + BSP_LCD_Clear(0,SSD1315_COLOR_BLACK); + BSP_LCD_Refresh(0); + UTIL_LCD_DisplayStringAt(0, LINE(0), (uint8_t *)"THREAD COAP APP", CENTER_MODE); + BSP_LCD_Refresh(0); +} +/************************************************************* + * + * LOCAL FUNCTIONS + * + *************************************************************/ + +/** + * @brief Thread initialization. + * @param None + * @retval None + */ +static void APP_THREAD_DeviceConfig(void) +{ + otError error; + error = otInstanceErasePersistentInfo(NULL); + if (error != OT_ERROR_NONE) + { + APP_THREAD_Error(ERR_THREAD_ERASE_PERSISTENT_INFO,error); + } + otInstanceFinalize(NULL); + otInstanceInitSingle(); + error = otSetStateChangedCallback(NULL, APP_THREAD_StateNotif, NULL); + if (error != OT_ERROR_NONE) + { + APP_THREAD_Error(ERR_THREAD_SET_STATE_CB,error); + } + error = otLinkSetChannel(NULL, C_CHANNEL_NB); + if (error != OT_ERROR_NONE) + { + APP_THREAD_Error(ERR_THREAD_SET_CHANNEL,error); + } + error = otLinkSetPanId(NULL, C_PANID); + if (error != OT_ERROR_NONE) + { + APP_THREAD_Error(ERR_THREAD_SET_PANID,error); + } + error = otIp6SetEnabled(NULL, true); + if (error != OT_ERROR_NONE) + { + APP_THREAD_Error(ERR_THREAD_IPV6_ENABLE,error); + } + error = otThreadSetEnabled(NULL, true); + if (error != OT_ERROR_NONE) + { + APP_THREAD_Error(ERR_THREAD_START,error); + } + + /* USER CODE BEGIN DEVICECONFIG */ + /* Start the COAP server */ + error = otCoapStart(NULL, OT_DEFAULT_COAP_PORT); + if (error != OT_ERROR_NONE) + { + APP_THREAD_Error(ERR_THREAD_COAP_START,error); + } + /* Add COAP resources */ + error = otCoapAddResource(NULL, &OT_Ressource); + if (error != OT_ERROR_NONE) + { + APP_THREAD_Error(ERR_THREAD_COAP_ADD_RESSOURCE,error); + } + /* USER CODE END DEVICECONFIG */ +} + +/** + * @brief Thread notification when the state changes. + * @param aFlags : Define the item that has been modified + * aContext: Context + * + * @retval None + */ +static void APP_THREAD_StateNotif(uint32_t NotifFlags, void *pContext) +{ + /* Prevent unused argument(s) compilation warning */ + UNUSED(pContext); + + /* USER CODE BEGIN APP_THREAD_STATENOTIF */ + + /* USER CODE END APP_THREAD_STATENOTIF */ + + if ((NotifFlags & (uint32_t)OT_CHANGED_THREAD_ROLE) == (uint32_t)OT_CHANGED_THREAD_ROLE) + { + switch (otThreadGetDeviceRole(NULL)) + { + case OT_DEVICE_ROLE_DISABLED: + /* USER CODE BEGIN OT_DEVICE_ROLE_DISABLED */ + UTIL_LCD_ClearStringLine(2); + UTIL_LCD_DisplayStringAt(0, LINE(2), (uint8_t *)"DISABLED", CENTER_MODE); + BSP_LCD_Refresh(0); + break; + case OT_DEVICE_ROLE_DETACHED: + /* USER CODE BEGIN OT_DEVICE_ROLE_DETACHED */ + UTIL_LCD_ClearStringLine(2); + UTIL_LCD_DisplayStringAt(0, LINE(2), (uint8_t *)"DETACHED", CENTER_MODE); + BSP_LCD_Refresh(0); + break; + case OT_DEVICE_ROLE_CHILD: + /* USER CODE BEGIN OT_DEVICE_ROLE_CHILD */ + UTIL_LCD_ClearStringLine(2); + UTIL_LCD_DisplayStringAt(0, LINE(2), (uint8_t *)"CHILD", CENTER_MODE); + BSP_LCD_Refresh(0); + break; + case OT_DEVICE_ROLE_ROUTER : + /* USER CODE BEGIN OT_DEVICE_ROLE_ROUTER */ + UTIL_LCD_ClearStringLine(2); + UTIL_LCD_DisplayStringAt(0, LINE(2), (uint8_t *)"ROUTER", CENTER_MODE); + BSP_LCD_Refresh(0); + break; + case OT_DEVICE_ROLE_LEADER : + /* USER CODE BEGIN OT_DEVICE_ROLE_LEADER */ + UTIL_LCD_ClearStringLine(2); + UTIL_LCD_DisplayStringAt(0,LINE(2), (uint8_t *)"LEADER ", CENTER_MODE); + BSP_LCD_Refresh(0); + break; + default: + /* USER CODE BEGIN DEFAULT */ + UTIL_LCD_ClearStringLine(2); + UTIL_LCD_DisplayStringAt(0, LINE(2), (uint8_t *)"Unknown ", CENTER_MODE); + BSP_LCD_Refresh(0); + /* USER CODE END DEFAULT */ + break; + } + } +} + +/** + * @brief Warn the user that an error has occurred.In this case, + * the LEDs on the Board will start blinking. + * + * @param pMess : Message associated to the error. + * @param ErrCode: Error code associated to the module (OpenThread or other module if any) + * @retval None + */ +static void APP_THREAD_TraceError(const char * pMess, uint32_t ErrCode) +{ + /* USER CODE BEGIN TRACE_ERROR */ + APP_DBG("**** Fatal error = %s (Err = %d)", pMess, ErrCode); + while(1U == 1U) + { + UTIL_LCD_DisplayStringAt(40,LINE(4), (uint8_t *) "Fatal Error",CENTER_MODE); + } + /* USER CODE END TRACE_ERROR */ +} + +/** + * @brief Check if the Coprocessor Wireless Firmware loaded supports Thread + * and display associated information + * @param None + * @retval None + */ +static void APP_THREAD_CheckWirelessFirmwareInfo(void) +{ + WirelessFwInfo_t wireless_info_instance; + WirelessFwInfo_t* p_wireless_info = &wireless_info_instance; + + if (SHCI_GetWirelessFwInfo(p_wireless_info) != SHCI_Success) + { + APP_THREAD_Error((uint32_t)ERR_THREAD_CHECK_WIRELESS, (uint32_t)ERR_INTERFACE_FATAL); + } + else + { + APP_DBG("**********************************************************"); + APP_DBG("WIRELESS COPROCESSOR FW:"); + /* Print version */ + APP_DBG("VERSION ID = %d.%d.%d", p_wireless_info->VersionMajor, p_wireless_info->VersionMinor, p_wireless_info->VersionSub); + + switch(p_wireless_info->StackType) + { + case INFO_STACK_TYPE_THREAD_FTD : + APP_DBG("FW Type : Thread FTD"); + break; + case INFO_STACK_TYPE_THREAD_MTD : + APP_DBG("FW Type : Thread MTD"); + break; + case INFO_STACK_TYPE_BLE_THREAD_FTD_STATIC : + APP_DBG("FW Type : Static Concurrent Mode BLE/Thread"); + break; + default : + /* No Thread device supported ! */ + APP_THREAD_Error((uint32_t)ERR_THREAD_CHECK_WIRELESS, (uint32_t)ERR_INTERFACE_FATAL); + break; + } + APP_DBG("**********************************************************"); + } +} +/* USER CODE BEGIN FD_LOCAL_FUNCTIONS */ +/** + * @brief Send a CoAP request with defined parameters. + * + * @param[in] aCoapRessource A pointer to a otCoapResource. + * @param[in] aCoapType otCoapType. + * @param[in] aCoapCode otCoapCode. + * @param[in] aStringAddress A pointer to a NULL-terminated string representing the address. Example: "FF03::1" for Multicast. + * @param[in] aPeerAddress A pointer to otIp6Address Peer Address. + * @param[in] aPayload A pointer to payload. + * @param[in] aHandler A pointer to CoAP response handler. + * @param[in] aContext A pointer to application specific context. + * + * @retval none. + */ +static void APP_THREAD_CoapSendRequest(otCoapResource* aCoapRessource, + otCoapType aCoapType, + otCoapCode aCoapCode, + const char *aStringAddress, + const otIp6Address* aPeerAddress, + uint8_t* aPayload, + uint16_t Size, + otCoapResponseHandler aHandler, + void* aContext) +{ + otError error = OT_ERROR_NONE; + + do{ + pOT_Message = otCoapNewMessage(NULL, NULL); + if (pOT_Message == NULL) + { + APP_THREAD_Error(ERR_THREAD_COAP_NEW_MSG,error); + break; + } + + otCoapMessageInit(pOT_Message, aCoapType, aCoapCode); + otCoapMessageAppendUriPathOptions(pOT_Message, aCoapRessource->mUriPath); + otCoapMessageSetPayloadMarker(pOT_Message); + + if((aPayload != NULL) && (Size > 0)) + { + error = otMessageAppend(pOT_Message, aPayload, Size); + if (error != OT_ERROR_NONE) + { + APP_THREAD_Error(ERR_THREAD_COAP_APPEND,error); + break; + } + } + else + { + APP_DBG("APP_THREAD_CoapSendRequest: No payload passed"); + } + + memset(&OT_MessageInfo, 0, sizeof(OT_MessageInfo)); + OT_MessageInfo.mPeerPort = OT_DEFAULT_COAP_PORT; + + if((aPeerAddress == NULL) && (aStringAddress != NULL)) + { + APP_DBG("Use String Address : %s ", aStringAddress); + otIp6AddressFromString(aStringAddress, &OT_MessageInfo.mPeerAddr); + } + else + if (aPeerAddress != NULL) + { + APP_DBG("Use Peer Address"); + memcpy(&OT_MessageInfo.mPeerAddr, aPeerAddress, sizeof(OT_MessageInfo.mPeerAddr)); + } + else + { + APP_DBG("ERROR: Address string and Peer Address not defined"); + APP_THREAD_Error(ERR_THREAD_COAP_ADDRESS_NOT_DEFINED, 0); + } + + if(aCoapType == OT_COAP_TYPE_NON_CONFIRMABLE) + { + APP_DBG("aCoapType == OT_COAP_TYPE_NON_CONFIRMABLE"); + error = otCoapSendRequest(NULL, + pOT_Message, + &OT_MessageInfo, + NULL, + NULL); + } + if(aCoapType == OT_COAP_TYPE_CONFIRMABLE) + { + APP_DBG("aCoapType == OT_COAP_TYPE_CONFIRMABLE"); + error = otCoapSendRequest(NULL, + pOT_Message, + &OT_MessageInfo, + aHandler, + aContext); + } + }while(false); + if (error != OT_ERROR_NONE && pOT_Message != NULL) + { + otMessageFree(pOT_Message); + APP_THREAD_Error(ERR_THREAD_COAP_SEND_REQUEST,error); + } +} + +/** + * @brief Handler called when the server receives a COAP request. + * + * @param pContext : Context + * @param pHeader : Header + * @param pMessage : Message + * @param pMessageInfo : Message information + * @retval None + */ +static void APP_THREAD_CoapRequestHandler(void * pContext, + otMessage * pMessage, + const otMessageInfo * pMessageInfo) + +{ + static uint8_t flagToggle = FALSE; + + APP_DBG(" Received CoAP request (context = %s)",pContext); + /* USER CODE BEGIN APP_THREAD_CoapRequestHandler */ + if (otMessageRead(pMessage, otMessageGetOffset(pMessage), &PayloadRead, sizeof(PayloadRead)) != sizeof(PayloadRead)) + { + APP_THREAD_Error(ERR_THREAD_MESSAGE_READ, 0); + } + + if (APP_THREAD_CheckMsgValidity() == true) + { + if (flagToggle == FALSE) + { + UTIL_LCD_ClearStringLine(4); + UTIL_LCD_DisplayStringAt(40,LINE(4), (uint8_t *) C_STRING_CIRCLE,LEFT_MODE); + BSP_LCD_Refresh(0); + flagToggle = TRUE; + } + else + { + UTIL_LCD_ClearStringLine(4); + UTIL_LCD_DisplayStringAt(80,LINE(4), (uint8_t *) C_STRING_CIRCLE,LEFT_MODE); + BSP_LCD_Refresh(0); + flagToggle = FALSE; + } + } + /* USER CODE END APP_THREAD_CoapRequestHandler */ + + /* If Message is Confirmable, send response */ + if (otCoapMessageGetType(pMessage) == OT_COAP_TYPE_CONFIRMABLE) + { + APP_THREAD_CoapSendDataResponse(pMessage, pMessageInfo); + } +} + +/** + * @brief This function acknowledges the data reception by sending an ACK + * back to the sender. + * @param pMessage coap message + * @param pMessageInfo message info pointer + * @retval None + */ +static void APP_THREAD_CoapSendDataResponse(otMessage * pMessage, + const otMessageInfo * pMessageInfo) +{ + otError error = OT_ERROR_NONE; + + do{ + APP_DBG(" ********* APP_THREAD_CoapSendDataResponse ********* "); + + pOT_MessageResponse = otCoapNewMessage(NULL, NULL); + if (pOT_MessageResponse == NULL) + { + APP_DBG("WARNING : pOT_MessageResponse = NULL ! -> exit now"); + break; + } + + otCoapMessageInitResponse(pOT_MessageResponse, + pMessage, + OT_COAP_TYPE_ACKNOWLEDGMENT, + OT_COAP_CODE_VALID); + + error = otCoapSendResponse(NULL, pOT_MessageResponse, pMessageInfo); + if (error != OT_ERROR_NONE && pOT_MessageResponse != NULL) + { + otMessageFree(pOT_MessageResponse); + APP_THREAD_Error(ERR_THREAD_COAP_DATA_RESPONSE,error); + } + }while(false); +} + +/** + * @brief This function manages the data response handler. + * + * @param pHeader context + * @param pMessage message pointer + * @param pMessageInfo message info pointer + * @param result error code + * @retval None + */ +static void APP_THREAD_CoapDataRespHandler( + void * pContext, + otMessage * pMessage, + const otMessageInfo * pMessageInfo, + otError result) +{ + /* Prevent unused argument(s) compilation warning */ + UNUSED(pMessage); + UNUSED(pMessageInfo); + + if (result == OT_ERROR_NONE) + { + APP_DBG("APP_THREAD_CoapDataRespHandler : NO ERROR"); + } + else + { + APP_DBG("APP_THREAD_CoapDataRespHandler : WARNING Result = %d",result); + } +} + +/** + * @brief Initialize CoAP write buffer. + * @param None + * @retval None + */ +static void APP_THREAD_InitPayloadWrite(void) +{ + uint8_t i; + for(i = 0; i < COAP_PAYLOAD_LENGTH; i++) + { + PayloadWrite[i] = 0xFF; + } +} + +/** + * @brief Task associated to the push button. + * @param None + * @retval None + */ +static void APP_THREAD_SendCoapMsg(void) +{ + APP_DBG("********* STEP 1: Send a CoAP NON-CONFIRMABLE PUT Request *********"); + /* Send a NON-CONFIRMABLE PUT Request */ + APP_THREAD_CoapSendRequest(&OT_Ressource, + OT_COAP_TYPE_NON_CONFIRMABLE, + OT_COAP_CODE_PUT, + MULICAST_FTD_MED, + NULL, + PayloadWrite, + sizeof(PayloadWrite), + NULL, + NULL); + + /* Insert Delay here using Hw timer server */ + /* Start the timer */ + HW_TS_Start(TimerID, (uint32_t)WAIT_TIMEOUT); + UTIL_SEQ_WaitEvt(EVENT_TIMER); + + APP_DBG("********* STEP 2: Send a CoAP CONFIRMABLE PUT Request *********"); + /* Send a CONFIRMABLE PUT Request */ + APP_THREAD_CoapSendRequest(&OT_Ressource, + OT_COAP_TYPE_CONFIRMABLE, + OT_COAP_CODE_PUT, + MULICAST_FTD_MED, + NULL, + PayloadWrite, + sizeof(PayloadWrite), + APP_THREAD_CoapDataRespHandler, + NULL); +} + +static void APP_THREAD_TimingElapsed(void) +{ + APP_DBG("--- APP_THREAD_TimingElapsed ---"); + UTIL_SEQ_SetEvt(EVENT_TIMER); +} + +/** + * @brief Compare the message received versus the original message. + * @param None + * @retval None + */ +static bool APP_THREAD_CheckMsgValidity(void) +{ + bool valid = true; + uint32_t i; + + for(i = 0; i < COAP_PAYLOAD_LENGTH; i++) + { + if(PayloadRead[i] != PayloadWrite[i]) + { + valid = false; + } + } + + if(valid == true) + { + APP_DBG("PAYLOAD Comparison OK!"); + }else + { + APP_THREAD_Error(ERR_THREAD_MSG_COMPARE_FAILED, 0); + } + return valid; +} +/* USER CODE END FD_LOCAL_FUNCTIONS */ + +/************************************************************* + * + * WRAP FUNCTIONS + * + *************************************************************/ + +void APP_THREAD_RegisterCmdBuffer(TL_CmdPacket_t* p_buffer) +{ + p_thread_otcmdbuffer = p_buffer; +} + +Thread_OT_Cmd_Request_t* THREAD_Get_OTCmdPayloadBuffer(void) +{ + return (Thread_OT_Cmd_Request_t*)p_thread_otcmdbuffer->cmdserial.cmd.payload; +} + +Thread_OT_Cmd_Request_t* THREAD_Get_OTCmdRspPayloadBuffer(void) +{ + return (Thread_OT_Cmd_Request_t*)((TL_EvtPacket_t *)p_thread_otcmdbuffer)->evtserial.evt.payload; +} + +Thread_OT_Cmd_Request_t* THREAD_Get_NotificationPayloadBuffer(void) +{ + return (Thread_OT_Cmd_Request_t*)(p_thread_notif_M0_to_M4)->evtserial.evt.payload; +} + +static void Ot_Cmd_Transfer_Common(void) +{ + /* OpenThread OT command cmdcode range 0x280 .. 0x3DF = 352 */ + p_thread_otcmdbuffer->cmdserial.cmd.cmdcode = 0x280U; + /* Size = otCmdBuffer->Size (Number of OT cmd arguments : 1 arg = 32bits so multiply by 4 to get size in bytes) + * + ID (4 bytes) + Size (4 bytes) */ + uint32_t l_size = ((Thread_OT_Cmd_Request_t*)(p_thread_otcmdbuffer->cmdserial.cmd.payload))->Size * 4U + 8U; + p_thread_otcmdbuffer->cmdserial.cmd.plen = l_size; + + TL_OT_SendCmd(); + + /* Wait completion of cmd */ + Wait_Getting_Ack_From_M0(); +} + +/** + * @brief This function is used to transfer the Ot commands from the + * M4 to the M0. + * + * @param None + * @return None + */ +void Ot_Cmd_Transfer(void) +{ + Ot_Cmd_Transfer_Common(); +} + +/** + * @brief This function is used to transfer the Ot commands from the + * M4 to the M0 with Notification M0 to M4 allowed. + * + * @param None + * @return None + */ +void Ot_Cmd_TransferWithNotif(void) +{ + /* Flag to specify to UTIL_SEQ_EvtIdle that M0 to M4 notifications are allowed */ + g_ot_notification_allowed = 1U; + + Ot_Cmd_Transfer_Common(); +} + +/** + * @brief This function is called when acknowledge from OT command is received from the M0+. + * + * @param Otbuffer : a pointer to TL_EvtPacket_t + * @return None + */ +void TL_OT_CmdEvtReceived( TL_EvtPacket_t * Otbuffer ) +{ + /* Prevent unused argument(s) compilation warning */ + UNUSED(Otbuffer); + + Receive_Ack_From_M0(); + + /* Does not allow OpenThread M0 to M4 notification */ + g_ot_notification_allowed = 0U; +} + +/** + * @brief This function is called when notification from M0+ is received. + * + * @param Notbuffer : a pointer to TL_EvtPacket_t + * @return None + */ +void TL_THREAD_NotReceived( TL_EvtPacket_t * Notbuffer ) +{ + p_thread_notif_M0_to_M4 = Notbuffer; + + Receive_Notification_From_M0(); +} + +/** + * @brief This function is called before sending any ot command to the M0 + * core. The purpose of this function is to be able to check if + * there are no notifications coming from the M0 core which are + * pending before sending a new ot command. + * @param None + * @retval None + */ +void Pre_OtCmdProcessing(void) +{ + UTIL_SEQ_WaitEvt(EVENT_SYNCHRO_BYPASS_IDLE); +} + +/** + * @brief This function waits for getting an acknowledgment from the M0. + * + * @param None + * @retval None + */ +static void Wait_Getting_Ack_From_M0(void) +{ + UTIL_SEQ_WaitEvt(EVENT_ACK_FROM_M0_EVT); +} + +/** + * @brief Receive an acknowledgment from the M0+ core. + * Each command send by the M4 to the M0 are acknowledged. + * This function is called under interrupt. + * @param None + * @retval None + */ +static void Receive_Ack_From_M0(void) +{ + UTIL_SEQ_SetEvt(EVENT_ACK_FROM_M0_EVT); +} + +/** + * @brief Receive a notification from the M0+ through the IPCC. + * This function is called under interrupt. + * @param None + * @retval None + */ +static void Receive_Notification_From_M0(void) +{ + CptReceiveMsgFromM0++; + UTIL_SEQ_SetTask(TASK_MSG_FROM_M0_TO_M4,CFG_SCH_PRIO_0); +} + +#if (CFG_USB_INTERFACE_ENABLE != 0) +#else +#if (CFG_FULL_LOW_POWER == 0) +static void RxCpltCallback(void) +{ + /* Filling buffer and wait for '\r' char */ + if (indexReceiveChar < C_SIZE_CMD_STRING) + { + CommandString[indexReceiveChar++] = aRxBuffer[0]; + if (aRxBuffer[0] == '\r') + { + CptReceiveCmdFromUser = 1U; + + /* UART task scheduling*/ + UTIL_SEQ_SetTask(1U << CFG_TASK_SEND_CLI_TO_M0, CFG_SCH_PRIO_0); + } + } + + /* Once a character has been sent, put back the device in reception mode */ + HW_UART_Receive_IT(CFG_CLI_UART, aRxBuffer, 1U, RxCpltCallback); +} +#endif /* (CFG_FULL_LOW_POWER == 0) */ +#endif /* (CFG_USB_INTERFACE_ENABLE != 0) */ + +#if (CFG_USB_INTERFACE_ENABLE != 0) +/** + * @brief Process the command strings. + * As soon as a complete command string has been received, the task + * in charge of sending the command to the M0 is scheduled + * @param None + * @retval None + */ +static uint32_t ProcessCmdString( uint8_t* buf , uint32_t len ) +{ + uint32_t i,j,tmp_start; + tmp_start = 0; + uint32_t res = 0; + + i= 0; + while ((buf[i] != '\r') && (i < len)) + { + i++; + } + + if (i != len) + { + memcpy(CommandString, buf,(i+1)); + indexReceiveChar = i + 1U; /* Length of the buffer containing the command string */ + UTIL_SEQ_SetTask(1U << CFG_TASK_SEND_CLI_TO_M0, CFG_SCH_PRIO_0); + tmp_start = i; + for (j = 0; j < (len - tmp_start - 1U) ; j++) + { + buf[j] = buf[tmp_start + j + 1U]; + } + res = len - tmp_start - 1U; + } + else + { + res = len; + } + return res; /* Remaining characters in the temporary buffer */ +} +#endif/* (CFG_USB_INTERFACE_ENABLE != 0) */ + +#if (CFG_FULL_LOW_POWER == 0) +/** + * @brief Process sends receive CLI command to M0. + * @param None + * @retval None + */ +static void Send_CLI_To_M0(void) +{ + memset(ThreadCliCmdBuffer.cmdserial.cmd.payload, 0x0U, 255U); + memcpy(ThreadCliCmdBuffer.cmdserial.cmd.payload, CommandString, indexReceiveChar); + ThreadCliCmdBuffer.cmdserial.cmd.plen = indexReceiveChar; + ThreadCliCmdBuffer.cmdserial.cmd.cmdcode = 0x0; + + /* Clear receive buffer, character counter and command complete */ + CptReceiveCmdFromUser = 0; + indexReceiveChar = 0; + memset(CommandString, 0, C_SIZE_CMD_STRING); + + TL_CLI_SendCmd(); +} +#endif /* (CFG_FULL_LOW_POWER == 0) */ + +/** + * @brief Send notification for CLI TL Channel. + * @param None + * @retval None + */ +static void Send_CLI_Ack_For_OT(void) +{ + + /* Notify M0 that characters have been sent to UART */ + TL_THREAD_CliSendAck(); +} + +/** + * @brief Perform initialization of CLI UART interface. + * @param None + * @retval None + */ +void APP_THREAD_Init_UART_CLI(void) +{ +#if (CFG_FULL_LOW_POWER == 0) + UTIL_SEQ_RegTask( 1<<CFG_TASK_SEND_CLI_TO_M0, UTIL_SEQ_RFU,Send_CLI_To_M0); +#endif /* (CFG_FULL_LOW_POWER == 0) */ + +#if (CFG_USB_INTERFACE_ENABLE != 0) +#else +#if (CFG_FULL_LOW_POWER == 0) + MX_LPUART1_UART_Init(); + HW_UART_Receive_IT(CFG_CLI_UART, aRxBuffer, 1, RxCpltCallback); +#endif /* (CFG_FULL_LOW_POWER == 0) */ +#endif /* (CFG_USB_INTERFACE_ENABLE != 0) */ +} + +/** + * @brief Perform initialization of TL for THREAD. + * @param None + * @retval None + */ +void APP_THREAD_TL_THREAD_INIT(void) +{ + ThreadConfigBuffer.p_ThreadOtCmdRspBuffer = (uint8_t*)&ThreadOtCmdBuffer; + ThreadConfigBuffer.p_ThreadNotAckBuffer = (uint8_t*)ThreadNotifRspEvtBuffer; + ThreadConfigBuffer.p_ThreadCliRspBuffer = (uint8_t*)&ThreadCliCmdBuffer; + + TL_THREAD_Init( &ThreadConfigBuffer ); +} + +/** + * @brief This function is called when notification on CLI TL Channel from M0+ is received. + * + * @param Notbuffer : a pointer to TL_EvtPacket_t + * @return None + */ +void TL_THREAD_CliNotReceived( TL_EvtPacket_t * Notbuffer ) +{ + TL_CmdPacket_t* l_CliBuffer = (TL_CmdPacket_t*)Notbuffer; + uint8_t l_size = l_CliBuffer->cmdserial.cmd.plen; + + /* WORKAROUND: if string to output is "> " then respond directly to M0 and do not output it */ + if (strcmp((const char *)l_CliBuffer->cmdserial.cmd.payload, "> ") != 0) + { + /* Write to CLI UART */ +#if (CFG_USB_INTERFACE_ENABLE != 0) + VCP_SendData( l_CliBuffer->cmdserial.cmd.payload, l_size, HostTxCb); +#else + HW_UART_Transmit_IT(CFG_CLI_UART, l_CliBuffer->cmdserial.cmd.payload, l_size, HostTxCb); +#endif /*USAGE_OF_VCP */ + } + else + { + Send_CLI_Ack_For_OT(); + } +} + +/** + * @brief End of transfer callback for CLI UART sending. + * + * @param Notbuffer : a pointer to TL_EvtPacket_t + * @return None + */ +void HostTxCb(void) +{ + Send_CLI_Ack_For_OT(); +} + +/** + * @brief Process the messages coming from the M0. + * @param None + * @retval None + */ +void APP_THREAD_ProcessMsgM0ToM4(void) +{ + if (CptReceiveMsgFromM0 != 0) + { + /* If CptReceiveMsgFromM0 is > 1. it means that we did not serve all the events from the radio */ + if (CptReceiveMsgFromM0 > 1U) + { + APP_THREAD_Error(ERR_REC_MULTI_MSG_FROM_M0, 0); + } + else + { + OpenThread_CallBack_Processing(); + } + /* Reset counter */ + CptReceiveMsgFromM0 = 0; + } +} + +#if (CFG_USB_INTERFACE_ENABLE != 0) +/** + * @brief This function is called when thereare some data coming + * from the Hyperterminal via the USB port + * Data received over USB OUT endpoint are sent over CDC interface + * through this function. + * @param Buf: Buffer of data received + * @param Len: Number of data received (in bytes) + * @retval Number of characters remaining in the buffer and not yet processed + */ +void VCP_DataReceived(uint8_t* Buf , uint32_t *Len) +{ + uint32_t i,flag_continue_checking = TRUE; + uint32_t char_remaining = 0; + static uint32_t len_total = 0; + + /* Copy the characters in the temporary buffer */ + for (i = 0; i < *Len; i++) + { + TmpString[len_total++] = Buf[i]; + } + + /* Process the buffer commands one by one */ + /* A command is limited by a \r caracaters */ + while (flag_continue_checking == TRUE) + { + char_remaining = ProcessCmdString(TmpString,len_total); + /* If char_remaining is equal to len_total, it means that the command string is not yet + * completed. + * If char_remaining is equal to 0, it means that the command string has + * been entirely processed. + */ + if ((char_remaining == 0) || (char_remaining == len_total)) + { + flag_continue_checking = FALSE; + } + len_total = char_remaining; + } +} +#endif /* (CFG_USB_INTERFACE_ENABLE != 0) */ + +/* USER CODE BEGIN FD_WRAP_FUNCTIONS */ + +/* USER CODE END FD_WRAP_FUNCTIONS */ +/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ |