first commit
This commit is contained in:
commit
92cbe97616
1978 files changed
+1688498
No files matched your search
@@ -0,0 +1,213 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* File Name : mbox_hsem.c
|
||||
* Description : This file provides code for the configuration
|
||||
* of the mailbox based on hardware semaphore.
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 STMicroelectronics.
|
||||
* All rights reserved.
|
||||
*
|
||||
* This software is licensed under terms that can be found in the LICENSE file
|
||||
* in the root directory of this software component.
|
||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
/* USER CODE END Header */
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include "openamp/open_amp.h"
|
||||
#include "stm32h7xx_hal.h"
|
||||
#include "openamp_conf.h"
|
||||
#include "mbox_hsem.h"
|
||||
|
||||
/* Private define ------------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Define */
|
||||
|
||||
/* USER CODE END Define */
|
||||
|
||||
#define RX_NO_MSG 0
|
||||
#define RX_NEW_MSG 1
|
||||
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN PV */
|
||||
|
||||
/* USER CODE END PV */
|
||||
|
||||
static uint32_t msg_received = RX_NO_MSG;
|
||||
|
||||
/* Private functions ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN PFP */
|
||||
|
||||
/* USER CODE END PFP */
|
||||
|
||||
void HAL_HSEM_FreeCallback(uint32_t SemMask)
|
||||
{
|
||||
|
||||
/* USER CODE BEGIN HSEM_FREE_CALLBACK */
|
||||
|
||||
/* USER CODE END HSEM_FREE_CALLBACK */
|
||||
|
||||
/* Prevent unused argument(s) compilation warning */
|
||||
UNUSED(SemMask);
|
||||
msg_received = RX_NEW_MSG;
|
||||
|
||||
#ifdef CORE_CM7
|
||||
|
||||
/* USER CODE BEGIN PRE_HSEM_FREE_CALLBACK_CM7 */
|
||||
|
||||
/* USER CODE END PRE_HSEM_FREE_CALLBACK_CM7 */
|
||||
|
||||
HAL_HSEM_ActivateNotification(__HAL_HSEM_SEMID_TO_MASK(HSEM_ID_1));
|
||||
|
||||
/* USER CODE BEGIN POST_HSEM_FREE_CALLBACK_CM7 */
|
||||
|
||||
/* USER CODE END POST_HSEM_FREE_CALLBACK_CM7 */
|
||||
|
||||
#endif
|
||||
#ifdef CORE_CM4
|
||||
|
||||
/* USER CODE BEGIN PRE_HSEM_FREE_CALLBACK_CM4 */
|
||||
|
||||
/* USER CODE END PRE_HSEM_FREE_CALLBACK_CM4 */
|
||||
|
||||
HAL_HSEM_ActivateNotification(__HAL_HSEM_SEMID_TO_MASK(HSEM_ID_0));
|
||||
|
||||
/* USER CODE BEGIN POST_HSEM_FREE_CALLBACK_CM4 */
|
||||
|
||||
/* USER CODE END POST_HSEM_FREE_CALLBACK_CM4 */
|
||||
#endif
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Initialize MAILBOX with HSEM peripheral
|
||||
* @param None
|
||||
* @retval : Operation result
|
||||
*/
|
||||
int MAILBOX_Init(void)
|
||||
{
|
||||
/* USER CODE BEGIN MAILBOX_INIT */
|
||||
|
||||
/* USER CODE END MAILBOX_INIT */
|
||||
__HAL_RCC_HSEM_CLK_ENABLE();
|
||||
|
||||
#ifdef CORE_CM7
|
||||
|
||||
/* USER CODE BEGIN PRE_MAILBOX_INIT_CM7 */
|
||||
|
||||
/* USER CODE END PRE_MAILBOX_INIT_CM7 */
|
||||
|
||||
HAL_HSEM_ActivateNotification(__HAL_HSEM_SEMID_TO_MASK(HSEM_ID_1));
|
||||
|
||||
/* USER CODE BEGIN POST_MAILBOX_INIT_CM7 */
|
||||
|
||||
/* USER CODE END POST_MAILBOX_INIT_CM7 */
|
||||
#endif
|
||||
#ifdef CORE_CM4
|
||||
|
||||
/* USER CODE BEGIN MAILBOX_INIT_CM4 */
|
||||
|
||||
/* USER CODE END MAILBOX_INIT_CM4 */
|
||||
|
||||
HAL_HSEM_ActivateNotification(__HAL_HSEM_SEMID_TO_MASK(HSEM_ID_0));
|
||||
|
||||
/* USER CODE BEGIN POST_MAILBOX_INIT_CM4 */
|
||||
|
||||
/* USER CODE END POST_MAILBOX_INIT_CM4 */
|
||||
#endif
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Initialize MAILBOX with HSEM peripheral
|
||||
* @param virtio device
|
||||
* @retval : Operation result
|
||||
*/
|
||||
int MAILBOX_Poll(struct virtio_device *vdev)
|
||||
{
|
||||
/* If we got an interrupt, ask for the corresponding virtqueue processing */
|
||||
|
||||
if (msg_received == RX_NEW_MSG)
|
||||
{
|
||||
|
||||
/* USER CODE BEGIN NEW_MSG */
|
||||
|
||||
/* USER CODE END NEW_MSG */
|
||||
#ifdef CORE_CM7
|
||||
|
||||
/* USER CODE BEGIN PRE_NEW_MSG_CM7 */
|
||||
|
||||
/* USER CODE END PRE_NEW_MSG_CM7 */
|
||||
|
||||
rproc_virtio_notified(vdev, VRING0_ID);
|
||||
|
||||
/* USER CODE BEGIN POST_NEW_MSG_CM7 */
|
||||
|
||||
/* USER CODE END POST_NEW_MSG_CM7 */
|
||||
#endif
|
||||
#ifdef CORE_CM4
|
||||
|
||||
/* USER CODE BEGIN PRE_NEW_MSG_CM4 */
|
||||
|
||||
/* USER CODE END PRE_NEW_MSG_CM4 */
|
||||
|
||||
rproc_virtio_notified(vdev, VRING1_ID);
|
||||
|
||||
/* USER CODE BEGIN POST_NEW_MSG_CM4 */
|
||||
|
||||
/* USER CODE END POST_NEW_MSG_CM4 */
|
||||
#endif
|
||||
msg_received = RX_NO_MSG;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN NO_MSG */
|
||||
|
||||
/* USER CODE END NO_MSG */
|
||||
return -EAGAIN;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Callback function called by OpenAMP MW to notify message processing
|
||||
* @param VRING id
|
||||
* @retval Operation result
|
||||
*/
|
||||
int MAILBOX_Notify(void *priv, uint32_t id)
|
||||
{
|
||||
(void)priv;
|
||||
(void)id;
|
||||
|
||||
/* USER CODE BEGIN MAILBOX_NOTIFY*/
|
||||
|
||||
/* USER CODE END MAILBOX_NOTIFY */
|
||||
#ifdef CORE_CM7
|
||||
|
||||
/* USER CODE BEGIN PRE_MAILBOX_NOTIFY_CM7 */
|
||||
|
||||
/* USER CODE END PRE_MAILBOX_NOTIFY_CM7 */
|
||||
HAL_HSEM_FastTake(HSEM_ID_0);
|
||||
HAL_HSEM_Release(HSEM_ID_0,0);
|
||||
|
||||
/* USER CODE BEGIN POST_MAILBOX_NOTIFY_CM7 */
|
||||
|
||||
/* USER CODE END POST_MAILBOX_NOTIFY_CM7 */
|
||||
#endif
|
||||
#ifdef CORE_CM4
|
||||
|
||||
/* USER CODE BEGIN PRE_MAILBOX_NOTIFY_CM4 */
|
||||
|
||||
/* USER CODE END PRE_MAILBOX_NOTIFY_CM4 */
|
||||
|
||||
HAL_HSEM_FastTake(HSEM_ID_1);
|
||||
HAL_HSEM_Release(HSEM_ID_1,0);
|
||||
|
||||
/* USER CODE BEGIN POST_MAILBOX_NOTIFY_CM4 */
|
||||
|
||||
/* USER CODE END POST_MAILBOX_NOTIFY_CM4 */
|
||||
#endif
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in new issue
Block a user