Files
Fraessspindel/stm32-stepper-root/stepper_h7/CM7/OPENAMP/mbox_hsem.c
T
2026-10-16 13:08:06 +02:00

214 lines
5.0 KiB
C

/* 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;
}