94 lines
2.4 KiB
C
94 lines
2.4 KiB
C
|
/**************************************************************************//**
|
||
|
|
*
|
||
|
|
* @copyright (C) 2019 Nuvoton Technology Corp. All rights reserved.
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*
|
||
|
|
* Change Logs:
|
||
|
|
* Date Author Notes
|
||
|
|
* 2022-10-5 Wayne First version
|
||
|
|
*
|
||
|
|
******************************************************************************/
|
||
|
|
|
||
|
|
#include <rtthread.h>
|
||
|
|
|
||
|
|
#if defined(BSP_USING_HWSEM)
|
||
|
|
|
||
|
|
#include "drv_common.h"
|
||
|
|
#include "drv_hwsem.h"
|
||
|
|
|
||
|
|
#define DEF_COUNTER_ADDR_RTP (3*1024*1024)
|
||
|
|
#define DEF_COUNTER_ADDR_A35 ((0x80000000+DEF_COUNTER_ADDR_RTP)|UNCACHEABLE)
|
||
|
|
|
||
|
|
#if defined(USE_MA35D1_SUBM)
|
||
|
|
#define DEF_COUNTER_ADDR DEF_COUNTER_ADDR_RTP
|
||
|
|
#else
|
||
|
|
#define DEF_COUNTER_ADDR DEF_COUNTER_ADDR_A35
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static void hwsem_counter_go(void *parameter)
|
||
|
|
{
|
||
|
|
rt_err_t ret;
|
||
|
|
rt_device_t psNuHwSem = (rt_device_t)parameter;
|
||
|
|
uint32_t *pu32Counter = (uint32_t *)DEF_COUNTER_ADDR;
|
||
|
|
|
||
|
|
nu_mutex_t psNuMutex = nu_mutex_init(psNuHwSem, evHWSEM0);
|
||
|
|
if (psNuMutex == RT_NULL)
|
||
|
|
return;
|
||
|
|
|
||
|
|
*pu32Counter = 0;
|
||
|
|
while (1)
|
||
|
|
{
|
||
|
|
ret = nu_mutex_take(psNuMutex, RT_WAITING_FOREVER);
|
||
|
|
if (ret != RT_EOK)
|
||
|
|
continue;
|
||
|
|
|
||
|
|
if (*pu32Counter >= 10)
|
||
|
|
{
|
||
|
|
nu_mutex_release(psNuMutex);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
*pu32Counter = *pu32Counter + 1;
|
||
|
|
|
||
|
|
#ifdef RT_USING_SMP
|
||
|
|
rt_kprintf("[%08x@CPU-%d] ->Inc %d@%08x\n", rt_thread_self(), rt_hw_cpu_id(), *pu32Counter, DEF_COUNTER_ADDR);
|
||
|
|
#else
|
||
|
|
rt_kprintf("[%08x]-> Inc %d@%08x\n", rt_thread_self(), *pu32Counter, DEF_COUNTER_ADDR);
|
||
|
|
#endif /* RT_USING_SMP */
|
||
|
|
|
||
|
|
nu_mutex_release(psNuMutex);
|
||
|
|
|
||
|
|
/* Relax, fair to get the mutex. */
|
||
|
|
rt_thread_mdelay(500);
|
||
|
|
}
|
||
|
|
|
||
|
|
nu_mutex_deinit(psNuHwSem, evHWSEM0);
|
||
|
|
}
|
||
|
|
|
||
|
|
static int hwsem_counter_app(void)
|
||
|
|
{
|
||
|
|
rt_err_t result = 0;
|
||
|
|
rt_thread_t thread;
|
||
|
|
rt_device_t psNuHwSem = rt_device_find("hwsem0");
|
||
|
|
if (psNuHwSem == RT_NULL)
|
||
|
|
return -1;
|
||
|
|
|
||
|
|
thread = rt_thread_create("hwsa35", hwsem_counter_go, (void *)psNuHwSem, 2048, 25, 20);
|
||
|
|
if (thread != RT_NULL)
|
||
|
|
{
|
||
|
|
#ifdef RT_USING_SMP
|
||
|
|
rt_thread_control(thread, RT_THREAD_CTRL_BIND_CPU, (void *)0);
|
||
|
|
#endif
|
||
|
|
result = rt_thread_startup(thread);
|
||
|
|
RT_ASSERT(result == RT_EOK);
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
INIT_APP_EXPORT(hwsem_counter_app);
|
||
|
|
MSH_CMD_EXPORT(hwsem_counter_app, demo hwsem);
|
||
|
|
|
||
|
|
#endif /* #if defined(BSP_USING_HWSEM)*/
|
||
|
|
|