Lines Matching refs:imuHandle
246 static hal_rpmsg_handle_t HAL_RpmsgGetEndpointFromAddr(hal_imu_handle_t *imuHandle, uint32_t addr) in HAL_RpmsgGetEndpointFromAddr() argument
251 assert(NULL != imuHandle); in HAL_RpmsgGetEndpointFromAddr()
253 list_for_each(cur, &imuHandle->eptList) in HAL_RpmsgGetEndpointFromAddr()
267 hal_imu_handle_t *imuHandle; in HAL_RpmsgCreateEndpoint() local
272 imuHandle = &imuHandleCh[rpmsgHandle->imuLink]; in HAL_RpmsgCreateEndpoint()
275 if (NULL == HAL_RpmsgGetEndpointFromAddr(imuHandle, rpmsgHandle->local_addr)) in HAL_RpmsgCreateEndpoint()
277 LIST_addTail(&imuHandle->eptList, &rpmsgHandle->eptLink); in HAL_RpmsgCreateEndpoint()
288 hal_imu_handle_t *imuHandle; in HAL_RpmsgDestroyEndpoint() local
293 imuHandle = &imuHandleCh[rpmsgHandle->imuLink]; in HAL_RpmsgDestroyEndpoint()
297 rpmsgHandle = HAL_RpmsgGetEndpointFromAddr(imuHandle, rpmsgHandle->local_addr); in HAL_RpmsgDestroyEndpoint()
304 LIST_remove(&imuHandle->eptList, &rpmsgHandle->eptLink); in HAL_RpmsgDestroyEndpoint()
310 static uint8_t *HAL_ImuGetWlanTxBuf(hal_imu_handle_t *imuHandle) in HAL_ImuGetWlanTxBuf() argument
315 assert(NULL != imuHandle); in HAL_ImuGetWlanTxBuf()
316 wlanTxqCtl = &imuHandle->wlanTxqCtl; in HAL_ImuGetWlanTxBuf()
330 static hal_rpmsg_status_t HAL_ImuPutWlanTxBuf(hal_imu_handle_t *imuHandle, uint8_t *txBuf) in HAL_ImuPutWlanTxBuf() argument
335 assert(NULL != imuHandle); in HAL_ImuPutWlanTxBuf()
336 wlanTxqCtl = &imuHandle->wlanTxqCtl; in HAL_ImuPutWlanTxBuf()
351 static uint8_t *HAL_RpmsgGetTxBuf(hal_imu_handle_t *imuHandle) in HAL_RpmsgGetTxBuf() argument
357 assert(NULL != imuHandle); in HAL_RpmsgGetTxBuf()
358 rpmsgTxqCtl = &imuHandle->rpmsgTxqCtl; in HAL_RpmsgGetTxBuf()
364 if (imuHandle->imuLink == (uint8_t)kIMU_LinkCpu2Cpu3) in HAL_RpmsgGetTxBuf()
395 static hal_rpmsg_status_t HAL_RpmsgPutTxBuf(hal_imu_handle_t *imuHandle, uint8_t *txBuf) in HAL_RpmsgPutTxBuf() argument
401 assert(NULL != imuHandle); in HAL_RpmsgPutTxBuf()
402 rpmsgTxqCtl = &imuHandle->rpmsgTxqCtl; in HAL_RpmsgPutTxBuf()
406 if (imuHandle->imuLink == (uint8_t)kIMU_LinkCpu2Cpu3) in HAL_RpmsgPutTxBuf()
438 hal_imu_handle_t *imuHandle; in HAL_ImuLinkIsUp() local
441 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuLinkIsUp()
443 if ((uint8_t)IMU_INITIALIZED == imuHandle->imuSyncState) in HAL_ImuLinkIsUp()
455 hal_imu_handle_t *imuHandle = NULL; in HAL_ImuResetWlanTxq() local
457 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuResetWlanTxq()
458 imuHandle->wlanTxqCtl.writeIndex = 0; in HAL_ImuResetWlanTxq()
459 imuHandle->wlanTxqCtl.readIndex = 0; in HAL_ImuResetWlanTxq()
463 …hal_imu_handle_t *imuHandle, uint8_t type, uint8_t subtype, uint8_t *data, uint32_t length, bool l… in HAL_ImuSendMsgBlockingCommon() argument
470 assert(NULL != imuHandle); in HAL_ImuSendMsgBlockingCommon()
496 if (imuHandle->cmd_buffer_available) in HAL_ImuSendMsgBlockingCommon()
499 localImuMsg.PayloadPtr[0] = (uint32_t)imuHandle->cmd_buffer; in HAL_ImuSendMsgBlockingCommon()
511 …(void)memcpy((void *)&localImuMsg.PayloadPtr[0], imuHandle->imuMsgBuf, (imuHandle->imuMsgBufIdx) <… in HAL_ImuSendMsgBlockingCommon()
512 localImuMsg.Hdr.length = imuHandle->imuMsgBufIdx; in HAL_ImuSendMsgBlockingCommon()
513 imuHandle->imuMsgBufIdx = 0; in HAL_ImuSendMsgBlockingCommon()
525 while (IMU_TX_FIFO_ALMOST_FULL((imu_link_t)imuHandle->imuLink)) in HAL_ImuSendMsgBlockingCommon()
530 imuMsg = (IMU_Msg_t *)&((IMU_MSG_SND_Q(imuHandle->imuLink))[IMU_WR_PTR(imuHandle->imuLink)]); in HAL_ImuSendMsgBlockingCommon()
532 ret = IMU_SendMsgPtrBlocking((imu_link_t)imuHandle->imuLink, (uint32_t)imuMsg, lockTxFifo); in HAL_ImuSendMsgBlockingCommon()
546 hal_imu_handle_t *imuHandle, uint8_t type, uint8_t subtype, uint8_t *data, uint32_t length) in HAL_ImuSendMsgBlocking() argument
548 return HAL_ImuSendMsgBlockingCommon(imuHandle, type, subtype, data, length, FALSE); in HAL_ImuSendMsgBlocking()
551 static hal_rpmsg_status_t HAL_ImuSendSync(hal_imu_handle_t *imuHandle) in HAL_ImuSendSync() argument
555 assert(NULL != imuHandle); in HAL_ImuSendSync()
557 *IMU_MSG_CUR_MAGIC_P(imuHandle->imuLink) = IMU_SYNC_MAGIC_PATTERN; in HAL_ImuSendSync()
558 while (IMU_SYNC_MAGIC_PATTERN != (*IMU_MSG_CUR_MAGIC_P((imu_link_t)imuHandle->imuLink))) in HAL_ImuSendSync()
563 if (((uint8_t)IMU_UNINITIALIZED == imuHandle->imuSyncState) && in HAL_ImuSendSync()
564 (IMU_SYNC_MAGIC_PATTERN == (*IMU_MSG_PEER_MAGIC_P(imuHandle->imuLink)))) in HAL_ImuSendSync()
567 …HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, (uint8_t)IMU_MSG_CONTROL_SYNC, NULL, 0… in HAL_ImuSendSync()
569 imuHandle->imuSyncState = (uint8_t)IMU_INITIALIZING; in HAL_ImuSendSync()
582 static hal_rpmsg_status_t HAL_ImuSendRpmsgEptQuiry(hal_imu_handle_t *imuHandle, uint32_t addr) in HAL_ImuSendRpmsgEptQuiry() argument
586 assert(NULL != imuHandle); in HAL_ImuSendRpmsgEptQuiry()
588 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendRpmsgEptQuiry()
594 if (kStatus_HAL_RpmsgSuccess == HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, in HAL_ImuSendRpmsgEptQuiry()
609 static hal_rpmsg_status_t HAL_ImuSendRpmsgEptQuiryRsp(hal_imu_handle_t *imuHandle, uint32_t addr, b… in HAL_ImuSendRpmsgEptQuiryRsp() argument
615 assert(NULL != imuHandle); in HAL_ImuSendRpmsgEptQuiryRsp()
617 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendRpmsgEptQuiryRsp()
633 if (kStatus_HAL_RpmsgSuccess == HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, in HAL_ImuSendRpmsgEptQuiryRsp()
648 static hal_rpmsg_status_t HAL_ImuSendRpmsgFreeBuf(hal_imu_handle_t *imuHandle, uint8_t *buf) in HAL_ImuSendRpmsgFreeBuf() argument
652 assert(NULL != imuHandle); in HAL_ImuSendRpmsgFreeBuf()
654 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendRpmsgFreeBuf()
661 …HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, (uint8_t)IMU_MSG_CONTROL_RPMSG_BUF_FRE… in HAL_ImuSendRpmsgFreeBuf()
674 static hal_rpmsg_status_t HAL_ImuSendEventAck(hal_imu_handle_t *imuHandle, uint8_t *rxBuf, uint8_t … in HAL_ImuSendEventAck() argument
678 assert(NULL != imuHandle); in HAL_ImuSendEventAck()
680 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendEventAck()
687 …HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, (uint8_t)IMU_MSG_CONTROL_EVT_ACK, rxBu… in HAL_ImuSendEventAck()
702 hal_imu_handle_t *imuHandle; in HAL_ImuSendEventDumpAck() local
707 imuHandle = &imuHandleCh[link]; in HAL_ImuSendEventDumpAck()
709 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendEventDumpAck()
716 …HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, (uint8_t)IMU_MSG_CONTROL_EVT_DUMP, rxB… in HAL_ImuSendEventDumpAck()
730 static hal_rpmsg_status_t HAL_ImuSendCommandRspAck(hal_imu_handle_t *imuHandle, uint8_t *rxBuf, uin… in HAL_ImuSendCommandRspAck() argument
734 assert(NULL != imuHandle); in HAL_ImuSendCommandRspAck()
736 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendCommandRspAck()
742 if (kStatus_HAL_RpmsgSuccess == HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, in HAL_ImuSendCommandRspAck()
756 static hal_rpmsg_status_t HAL_ImuFreeRxBuf(hal_imu_handle_t *imuHandle, uint8_t *rxBuf, uint8_t len… in HAL_ImuFreeRxBuf() argument
760 assert(NULL != imuHandle); in HAL_ImuFreeRxBuf()
762 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuFreeRxBuf()
768 if (kStatus_HAL_RpmsgSuccess == HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, in HAL_ImuFreeRxBuf()
785 hal_imu_handle_t *imuHandle; in HAL_ImuSendCommand() local
789 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuSendCommand()
791 …if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink) || FALSE == imuHandle->cmd_buffe… in HAL_ImuSendCommand()
799 (void)HAL_IMU_MEMCPY((void *)imuHandle->cmd_buffer, cmdBuf, length); in HAL_ImuSendCommand()
807 …if (kStatus_HAL_RpmsgSuccess == HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_COMMAND, 0U, NU… in HAL_ImuSendCommand()
810 imuHandle->cmd_buffer_available = FALSE; in HAL_ImuSendCommand()
824 hal_imu_handle_t *imuHandle; in HAL_ImuSendTxData() local
829 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuSendTxData()
831 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendTxData()
836 wlan_tx_buf = HAL_ImuGetWlanTxBuf(imuHandle); in HAL_ImuSendTxData()
848 …if (kStatus_HAL_RpmsgSuccess == HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_TX_DATA, 0U, wl… in HAL_ImuSendTxData()
854 (void)HAL_ImuPutWlanTxBuf(imuHandle, wlan_tx_buf); in HAL_ImuSendTxData()
865 hal_imu_handle_t *imuHandle; in HAL_ImuAddWlanTxPacket() local
871 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuAddWlanTxPacket()
873 if (imuHandle->imuMsgBufIdx > IMU_PAYLOAD_SIZE - 1U) in HAL_ImuAddWlanTxPacket()
878 wlan_tx_buf = HAL_ImuGetWlanTxBuf(imuHandle); in HAL_ImuAddWlanTxPacket()
888 imuHandle->imuMsgBuf[imuHandle->imuMsgBufIdx] = (uint32_t)wlan_tx_buf; in HAL_ImuAddWlanTxPacket()
889 imuHandle->imuMsgBufIdx++; in HAL_ImuAddWlanTxPacket()
900 hal_imu_handle_t *imuHandle; in HAL_ImuAddWlanTxPacketExt() local
906 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuAddWlanTxPacketExt()
908 if (imuHandle->imuMsgBufIdx > IMU_PAYLOAD_SIZE - 1U) in HAL_ImuAddWlanTxPacketExt()
913 wlan_tx_buf = HAL_ImuGetWlanTxBuf(imuHandle); in HAL_ImuAddWlanTxPacketExt()
923 imuHandle->imuMsgBuf[imuHandle->imuMsgBufIdx] = (uint32_t)wlan_tx_buf; in HAL_ImuAddWlanTxPacketExt()
924 imuHandle->imuMsgBufIdx++; in HAL_ImuAddWlanTxPacketExt()
932 hal_imu_handle_t *imuHandle; in HAL_ImuSendMultiTxData() local
936 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuSendMultiTxData()
938 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendMultiTxData()
944 …if (kStatus_HAL_RpmsgSuccess == HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_MULTI_TX_DATA, … in HAL_ImuSendMultiTxData()
947 imuHandle->imuMsgBufIdx = 0; in HAL_ImuSendMultiTxData()
958 static hal_rpmsg_status_t HAL_ImuSendSyncAck(hal_imu_handle_t *imuHandle) in HAL_ImuSendSyncAck() argument
962 assert(NULL != imuHandle); in HAL_ImuSendSyncAck()
966 …HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, (uint8_t)IMU_MSG_CONTROL_SYNC_ACK, NUL… in HAL_ImuSendSyncAck()
979 static hal_rpmsg_status_t HAL_ImuSendUnlock(hal_imu_handle_t *imuHandle) in HAL_ImuSendUnlock() argument
983 assert(NULL != imuHandle); in HAL_ImuSendUnlock()
985 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendUnlock()
992 …HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, (uint8_t)IMU_MSG_CONTROL_ACK_FOR_UNLOC… in HAL_ImuSendUnlock()
1007 hal_imu_handle_t *imuHandle; in HAL_ImuReturnAllTxBuf() local
1014 imuHandle = &imuHandleCh[link]; in HAL_ImuReturnAllTxBuf()
1019 wlan_tx_buf = HAL_ImuGetWlanTxBuf(imuHandle); in HAL_ImuReturnAllTxBuf()
1025 imuHandle->imuMsgBuf[txBufCnt] = (uint32_t)wlan_tx_buf; in HAL_ImuReturnAllTxBuf()
1032 … HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, (uint8_t)IMU_MSG_CONTROL_TX_BUF_ADDR, in HAL_ImuReturnAllTxBuf()
1033 … (uint8_t *)&imuHandle->imuMsgBuf[0], (uint32_t)IMU_PAYLOAD_SIZE)) in HAL_ImuReturnAllTxBuf()
1050 if (kStatus_HAL_RpmsgSuccess != HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, in HAL_ImuReturnAllTxBuf()
1052 … (uint8_t *)&imuHandle->imuMsgBuf[0], txBufCnt)) in HAL_ImuReturnAllTxBuf()
1067 static hal_rpmsg_status_t HAL_ImuSendShutdown(hal_imu_handle_t *imuHandle) in HAL_ImuSendShutdown() argument
1071 assert(NULL != imuHandle); in HAL_ImuSendShutdown()
1073 if (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_ImuSendShutdown()
1080 …HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_CONTROL, (uint8_t)IMU_MSG_CONTROL_SHUTDOWN, NUL… in HAL_ImuSendShutdown()
1093 static hal_rpmsg_status_t HAL_ImuCtrlHandler(hal_imu_handle_t *imuHandle, IMU_Msg_t *data, uint32_t… in HAL_ImuCtrlHandler() argument
1103 assert(NULL != imuHandle); in HAL_ImuCtrlHandler()
1110 IMU_UNLOCK_TX_FIFO(imuHandle->imuLink); in HAL_ImuCtrlHandler()
1113 (void)HAL_ImuSendSyncAck(imuHandle); in HAL_ImuCtrlHandler()
1114 if ((uint8_t)kIMU_LinkCpu2Cpu3 == imuHandle->imuLink) in HAL_ImuCtrlHandler()
1116 imuHandle->imuSyncState = (uint8_t)IMU_INITIALIZED; in HAL_ImuCtrlHandler()
1118 (void)HAL_ImuSendSyncAck(imuHandle); in HAL_ImuCtrlHandler()
1119 imuHandle->imuSyncState = (uint8_t)IMU_INITIALIZED; in HAL_ImuCtrlHandler()
1122 imuHandle->imuSyncState = (uint8_t)IMU_INITIALIZED; in HAL_ImuCtrlHandler()
1125 imuHandle->cmd_buffer = (uint32_t *)pImuMsg->PayloadPtr[0]; in HAL_ImuCtrlHandler()
1126 imuHandle->cmd_buffer_available = TRUE; in HAL_ImuCtrlHandler()
1127 if ((uint8_t)IMU_INITIALIZED != imuHandle->imuSyncState) in HAL_ImuCtrlHandler()
1129 imuHandle->imuSyncState = (uint8_t)IMU_INITIALIZED; in HAL_ImuCtrlHandler()
1135 (void)HAL_ImuPutWlanTxBuf(imuHandle, (uint8_t *)pImuMsg->PayloadPtr[i]); in HAL_ImuCtrlHandler()
1141 imuHandle->imuSyncState = (uint8_t)IMU_UNINITIALIZED; in HAL_ImuCtrlHandler()
1142 …IMU_ClearPendingInterrupts((imu_link_t)imuHandle->imuLink, IMU_MSG_FIFO_CNTL_MSG_RDY_INT_CLR_MASK); in HAL_ImuCtrlHandler()
1143 … IMU_ClearPendingInterrupts((imu_link_t)imuHandle->imuLink, IMU_MSG_FIFO_CNTL_SP_AV_INT_CLR_MASK); in HAL_ImuCtrlHandler()
1144 (void)os_InterruptMaskClear(IMULINKID_TO_IRQID((imu_link_t)imuHandle->imuLink)); in HAL_ImuCtrlHandler()
1145 IMU_Deinit((imu_link_t)imuHandle->imuLink); in HAL_ImuCtrlHandler()
1146 *IMU_MSG_CUR_MAGIC_P(imuHandle->imuLink) = 0; in HAL_ImuCtrlHandler()
1147 imuHandle->wlanTxqCtl.writeIndex = 0; in HAL_ImuCtrlHandler()
1148 imuHandle->wlanTxqCtl.readIndex = 0; in HAL_ImuCtrlHandler()
1152 … hal_rpmsg_state_t *rpmsgHandle = HAL_RpmsgGetEndpointFromAddr(imuHandle, pImuMsg->PayloadPtr[0]); in HAL_ImuCtrlHandler()
1158 rpmsgStatus = HAL_ImuSendRpmsgEptQuiryRsp(imuHandle, pImuMsg->PayloadPtr[0], TRUE); in HAL_ImuCtrlHandler()
1161 k_event_set(&rpmsgQFlagsRef, RPMSG_EVENT_ENDPOINT_QUERY_RSP << imuHandle->imuLink); in HAL_ImuCtrlHandler()
1164 RPMSG_EVENT_ENDPOINT_QUERY_RSP << imuHandle->imuLink); in HAL_ImuCtrlHandler()
1171 rpmsgStatus = HAL_ImuSendRpmsgEptQuiryRsp(imuHandle, pImuMsg->PayloadPtr[0], FALSE); in HAL_ImuCtrlHandler()
1177 list_for_each(cur, &imuHandle->eptList) in HAL_ImuCtrlHandler()
1198 k_event_set(&rpmsgQFlagsRef, RPMSG_EVENT_ENDPOINT_QUERY_RSP << imuHandle->imuLink); in HAL_ImuCtrlHandler()
1201 RPMSG_EVENT_ENDPOINT_QUERY_RSP << imuHandle->imuLink); in HAL_ImuCtrlHandler()
1206 (void)HAL_RpmsgPutTxBuf(imuHandle, (uint8_t *)pImuMsg->PayloadPtr[0]); in HAL_ImuCtrlHandler()
1222 hal_imu_handle_t *imuHandle = NULL; in HAL_ImuReceive() local
1230 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuReceive()
1234 if (IMU_RX_FIFO_EMPTY((imu_link_t)imuHandle->imuLink)) in HAL_ImuReceive()
1236 …IMU_ClearPendingInterrupts((imu_link_t)imuHandle->imuLink, IMU_MSG_FIFO_CNTL_MSG_RDY_INT_CLR_MASK); in HAL_ImuReceive()
1237 os_ClearPendingISR(IMULINKID_TO_IRQID((imu_link_t)imuHandle->imuLink)); in HAL_ImuReceive()
1239 *IMU_SLEEP_FLAG_ADDR(imuHandle->imuLink) |= (uint32_t)(1 << 0U); in HAL_ImuReceive()
1246 *IMU_SLEEP_FLAG_ADDR(imuHandle->imuLink) &= (uint32_t)(~(1 << 0U)); in HAL_ImuReceive()
1255 pMsg = (IMU_Msg_t *)IMU_RD_MSG(imuHandle->imuLink); in HAL_ImuReceive()
1256 if ((pMsg != NULL) && (IMU_RX_FIFO_LOCKED(imuHandle->imuLink))) in HAL_ImuReceive()
1272 rpmsgStatus = HAL_ImuCtrlHandler(imuHandle, pMsg, pMsg->Hdr.length); in HAL_ImuReceive()
1273 if (imuHandle->imuHandler[IMU_MSG_CONTROL] != NULL) in HAL_ImuReceive()
1275 … rpmsgStatus = imuHandle->imuHandler[IMU_MSG_CONTROL]((IMU_Msg_t *)pMsg, pMsg->Hdr.length); in HAL_ImuReceive()
1279 if (imuHandle->imuHandler[IMU_MSG_COMMAND_RESPONSE] != NULL) in HAL_ImuReceive()
1282 … imuHandle->imuHandler[IMU_MSG_COMMAND_RESPONSE]((IMU_Msg_t *)pMsg, pMsg->Hdr.length); in HAL_ImuReceive()
1285 … rpmsgStatus = HAL_ImuSendCommandRspAck(imuHandle, (uint8_t *)&pMsg->PayloadPtr[0], 1); in HAL_ImuReceive()
1286 imuHandle->cmd_buffer_available = TRUE; in HAL_ImuReceive()
1290 if (imuHandle->imuHandler[IMU_MSG_EVENT] != NULL) in HAL_ImuReceive()
1292 … rpmsgStatus = imuHandle->imuHandler[IMU_MSG_EVENT]((IMU_Msg_t *)pMsg, pMsg->Hdr.length); in HAL_ImuReceive()
1295 … rpmsgStatus = HAL_ImuSendEventAck(imuHandle, (uint8_t *)&pMsg->PayloadPtr[0], 1); in HAL_ImuReceive()
1301 if (imuHandle->imuHandler[IMU_MSG_RX_DATA] != NULL) in HAL_ImuReceive()
1303 … rpmsgStatus = imuHandle->imuHandler[IMU_MSG_RX_DATA]((IMU_Msg_t *)pMsg, pMsg->Hdr.length); in HAL_ImuReceive()
1306 … rpmsgStatus = HAL_ImuFreeRxBuf(imuHandle, (uint8_t *)&pMsg->PayloadPtr[0], pMsg->Hdr.length); in HAL_ImuReceive()
1310 … ept = (hal_rpmsg_state_t *)HAL_RpmsgGetEndpointFromAddr(imuHandle, rpmsg_msg->hdr.dst); in HAL_ImuReceive()
1321 … rpmsgStatus = HAL_ImuSendRpmsgFreeBuf(imuHandle, (uint8_t *)&rpmsg_msg->data); in HAL_ImuReceive()
1336 (void)HAL_ImuSendUnlock(imuHandle); in HAL_ImuReceive()
1339 (void)os_InterruptMaskSet(IMULINKID_TO_IRQID((imu_link_t)imuHandle->imuLink)); in HAL_ImuReceive()
1567 hal_imu_handle_t *imuHandle; in HAL_ImuInit() local
1573 imuHandle = &imuHandleCh[link]; in HAL_ImuInit()
1574 imuHandle->imuLink = (uint8_t)link; in HAL_ImuInit()
1585 if ((imu_init_flag & (1U << imuHandle->imuLink)) == 0U) in HAL_ImuInit()
1587 HAL_ImuTaskInit(imuHandle->imuLink); in HAL_ImuInit()
1603 (void)HAL_RpmsgPutTxBuf(imuHandle, (uint8_t *)rpmsgTxBuf23[i]); in HAL_ImuInit()
1607 imuHandle->wlanTxqCtl.writeIndex = 0; in HAL_ImuInit()
1608 imuHandle->wlanTxqCtl.readIndex = 0; in HAL_ImuInit()
1609 imuHandle->imuMsgBufIdx = 0; in HAL_ImuInit()
1610 imuHandle->rpmsgTxqCtl.writeIndex = 0; in HAL_ImuInit()
1611 imuHandle->rpmsgTxqCtl.readIndex = 0; in HAL_ImuInit()
1616 (void)HAL_RpmsgPutTxBuf(imuHandle, (uint8_t *)rpmsgTxBuf13[i]); in HAL_ImuInit()
1623 (void)HAL_RpmsgPutTxBuf(imuHandle, (uint8_t *)rpmsgTxBuf23[i]); in HAL_ImuInit()
1631 LIST_init(&imuHandle->eptList); in HAL_ImuInit()
1632 imu_init_flag |= (1U << imuHandle->imuLink); in HAL_ImuInit()
1641 if ((uint8_t)IMU_UNINITIALIZED == imuHandle->imuSyncState) in HAL_ImuInit()
1643 state = HAL_ImuSendSync(imuHandle); in HAL_ImuInit()
1653 hal_imu_handle_t *imuHandle; in HAL_ImuDeinit() local
1658 imuHandle = &imuHandleCh[link]; in HAL_ImuDeinit()
1664 state = HAL_ImuSendShutdown(imuHandle); in HAL_ImuDeinit()
1672 …IMU_ClearPendingInterrupts((imu_link_t)imuHandle->imuLink, IMU_MSG_FIFO_CNTL_MSG_RDY_INT_CLR_MASK); in HAL_ImuDeinit()
1673 … IMU_ClearPendingInterrupts((imu_link_t)imuHandle->imuLink, IMU_MSG_FIFO_CNTL_SP_AV_INT_CLR_MASK); in HAL_ImuDeinit()
1674 (void)os_InterruptMaskClear(IMULINKID_TO_IRQID((imu_link_t)imuHandle->imuLink)); in HAL_ImuDeinit()
1675 IMU_Deinit((imu_link_t)imuHandle->imuLink); in HAL_ImuDeinit()
1676 imuHandle->imuSyncState = (uint8_t)IMU_UNINITIALIZED; in HAL_ImuDeinit()
1677 *IMU_MSG_CUR_MAGIC_P(imuHandle->imuLink) = 0; in HAL_ImuDeinit()
1678 imu_init_flag &= ~(1U << imuHandle->imuLink); in HAL_ImuDeinit()
1679 imuHandle->wlanTxqCtl.writeIndex = 0; in HAL_ImuDeinit()
1680 imuHandle->wlanTxqCtl.readIndex = 0; in HAL_ImuDeinit()
1681 imuHandle->imuMsgBufIdx = 0; in HAL_ImuDeinit()
1682 imuHandle->cmd_buffer = NULL; in HAL_ImuDeinit()
1683 imuHandle->cmd_buffer_available = 0; in HAL_ImuDeinit()
1684 imuHandle->cmd_response_buffer_available = 0; in HAL_ImuDeinit()
1688 while (*IMU_MSG_PEER_MAGIC_P((imu_link_t)imuHandle->imuLink) != 0) in HAL_ImuDeinit()
1695 HAL_ImuTaskDeinit(imuHandle->imuLink); in HAL_ImuDeinit()
1706 hal_imu_handle_t *imuHandle; in HAL_RpmsgInit() local
1749 imuHandle = &imuHandleCh[rpmsgHandle->imuLink]; in HAL_RpmsgInit()
1753 while (kStatus_HAL_RpmsgError == HAL_ImuLinkIsUp(imuHandle->imuLink)) in HAL_RpmsgInit()
1766 state = HAL_ImuSendRpmsgEptQuiry(imuHandle, rpmsgHandle->remote_addr); in HAL_RpmsgInit()
1772 …Events = k_event_wait(&rpmsgQFlagsRef, RPMSG_EVENT_ENDPOINT_QUERY_RSP << imuHandle->imuLink, 0, K_… in HAL_RpmsgInit()
1773 k_event_clear(&rpmsgQFlagsRef, RPMSG_EVENT_ENDPOINT_QUERY_RSP << imuHandle->imuLink); in HAL_RpmsgInit()
1775 …ntWait((osa_event_handle_t)rpmsgQFlagsRef, RPMSG_EVENT_ENDPOINT_QUERY_RSP << imuHandle->imuLink, 0, in HAL_RpmsgInit()
1783 … RPMSG_EVENT_ENDPOINT_QUERY_RSP << imuHandle->imuLink, 0, osaWaitForever_c, &Events); in HAL_RpmsgInit()
1815 hal_imu_handle_t *imuHandle; in HAL_RpmsgSend() local
1826 imuHandle = &imuHandleCh[rpmsgHandle->imuLink]; in HAL_RpmsgSend()
1828 assert(kStatus_HAL_RpmsgSuccess == HAL_ImuLinkIsUp(imuHandle->imuLink)); in HAL_RpmsgSend()
1858 … if (kStatus_HAL_RpmsgSuccess == HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_RPMSG, 0U, in HAL_RpmsgSend()
1866 (void)HAL_RpmsgPutTxBuf(imuHandle, rpmsg_tx_buf); in HAL_RpmsgSend()
1881 hal_imu_handle_t *imuHandle; in HAL_RpmsgNoCopySend() local
1892 imuHandle = &imuHandleCh[rpmsgHandle->imuLink]; in HAL_RpmsgNoCopySend()
1894 assert(kStatus_HAL_RpmsgSuccess == HAL_ImuLinkIsUp(imuHandle->imuLink)); in HAL_RpmsgNoCopySend()
1905 if (kStatus_HAL_RpmsgSuccess == HAL_ImuSendMsgBlocking(imuHandle, (uint8_t)IMU_MSG_RPMSG, 0U, in HAL_RpmsgNoCopySend()
1923 hal_imu_handle_t *imuHandle; in HAL_ImuInstallCallback() local
1927 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuInstallCallback()
1928 imuHandle->imuHandler[type] = callback; in HAL_ImuInstallCallback()
2081 hal_imu_handle_t *imuHandle; in HAL_RpmsgAllocTxBuffer() local
2098 imuHandle = &imuHandleCh[rpmsgHandle->imuLink]; in HAL_RpmsgAllocTxBuffer()
2100 buf = HAL_RpmsgGetTxBuf(imuHandle); in HAL_RpmsgAllocTxBuffer()
2106 buf = HAL_RpmsgGetTxBuf(imuHandle); in HAL_RpmsgAllocTxBuffer()
2116 hal_imu_handle_t *imuHandle; in HAL_RpmsgFreeRxBuffer() local
2121 imuHandle = &imuHandleCh[rpmsgHandle->imuLink]; in HAL_RpmsgFreeRxBuffer()
2123 return HAL_ImuSendRpmsgFreeBuf(imuHandle, data); in HAL_RpmsgFreeRxBuffer()
2128 hal_imu_handle_t *imuHandle; in HAL_ImuIsTxBufQueueEmpty() local
2133 imuHandle = &imuHandleCh[imuLink]; in HAL_ImuIsTxBufQueueEmpty()
2134 wlanTxqCtl = &imuHandle->wlanTxqCtl; in HAL_ImuIsTxBufQueueEmpty()