758 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			758 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * Copyright (c) 2013-2019 Huawei Technologies Co., Ltd. All rights reserved.
 | 
						|
 * Copyright (c) 2020-2022 Huawei Device Co., Ltd. All rights reserved.
 | 
						|
 *
 | 
						|
 * Redistribution and use in source and binary forms, with or without modification,
 | 
						|
 * are permitted provided that the following conditions are met:
 | 
						|
 *
 | 
						|
 * 1. Redistributions of source code must retain the above copyright notice, this list of
 | 
						|
 *    conditions and the following disclaimer.
 | 
						|
 *
 | 
						|
 * 2. Redistributions in binary form must reproduce the above copyright notice, this list
 | 
						|
 *    of conditions and the following disclaimer in the documentation and/or other materials
 | 
						|
 *    provided with the distribution.
 | 
						|
 *
 | 
						|
 * 3. Neither the name of the copyright holder nor the names of its contributors may be used
 | 
						|
 *    to endorse or promote products derived from this software without specific prior written
 | 
						|
 *    permission.
 | 
						|
 *
 | 
						|
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 | 
						|
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
 | 
						|
 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 | 
						|
 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
 | 
						|
 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
 | 
						|
 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
 | 
						|
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
 | 
						|
 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 | 
						|
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
 | 
						|
 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
 | 
						|
 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 | 
						|
 */
 | 
						|
 | 
						|
#include "los_cpup.h"
 | 
						|
#include "securec.h"
 | 
						|
#include "los_memory.h"
 | 
						|
#include "los_debug.h"
 | 
						|
#include "los_tick.h"
 | 
						|
 | 
						|
#if (LOSCFG_BASE_CORE_SWTMR == 1)
 | 
						|
#include "los_swtmr.h"
 | 
						|
#endif
 | 
						|
 | 
						|
#if (LOSCFG_CPUP_INCLUDE_IRQ == 1)
 | 
						|
#include "los_arch_interrupt.h"
 | 
						|
#endif
 | 
						|
 | 
						|
#if (LOSCFG_BASE_CORE_CPUP == 1)
 | 
						|
/**
 | 
						|
 * @ingroup los_cpup
 | 
						|
 * CPU usage-type macro: used for tasks.
 | 
						|
 */
 | 
						|
#define OS_THREAD_TYPE_TASK     0
 | 
						|
 | 
						|
/**
 | 
						|
 * @ingroup los_cpup
 | 
						|
 * CPU usage-type macro: used for hardware interrupts.
 | 
						|
 */
 | 
						|
#define OS_THREAD_TYPE_HWI      1
 | 
						|
 | 
						|
#define OS_CPUP_RECORD_PERIOD   (g_sysClock)
 | 
						|
 | 
						|
#define OS_SYS_CYCLE_TO_US(cycle)  ((cycle) / (g_sysClock)) * OS_SYS_US_PER_SECOND + \
 | 
						|
    ((cycle) % (g_sysClock) * OS_SYS_US_PER_SECOND / (g_sysClock))
 | 
						|
 | 
						|
LITE_OS_SEC_BSS UINT16    g_cpupInitFlg = 0;
 | 
						|
LITE_OS_SEC_BSS OsCpupCB  *g_cpup = NULL;
 | 
						|
LITE_OS_SEC_BSS UINT64    g_lastRecordTime;
 | 
						|
LITE_OS_SEC_BSS UINT16    g_hisPos; /* current Sampling point of historyTime */
 | 
						|
 | 
						|
#if (LOSCFG_CPUP_INCLUDE_IRQ == 1)
 | 
						|
LITE_OS_SEC_BSS UINT16    g_irqCpupInitFlg = 0;
 | 
						|
LITE_OS_SEC_BSS UINT16    g_irqHisPos = 0; /* current Sampling point of historyTime */
 | 
						|
LITE_OS_SEC_BSS UINT64    g_irqLastRecordTime;
 | 
						|
LITE_OS_SEC_BSS OsIrqCpupCB *g_irqCpup = NULL;
 | 
						|
LITE_OS_SEC_BSS STATIC UINT64 g_cpuHistoryTime[OS_CPUP_HISTORY_RECORD_NUM];
 | 
						|
#define OS_CPUP_USED      0x1U
 | 
						|
 | 
						|
#if (LOSCFG_BASE_CORE_SWTMR == 1)
 | 
						|
LITE_OS_SEC_TEXT_INIT VOID OsCpupGuard(VOID)
 | 
						|
{
 | 
						|
    UINT16 prevPos;
 | 
						|
    UINT32 loop;
 | 
						|
    UINT32 intSave;
 | 
						|
 | 
						|
    intSave = LOS_IntLock();
 | 
						|
    prevPos = g_irqHisPos;
 | 
						|
 | 
						|
    if (g_irqHisPos == OS_CPUP_HISTORY_RECORD_NUM - 1) {
 | 
						|
        g_irqHisPos = 0;
 | 
						|
    } else {
 | 
						|
        g_irqHisPos++;
 | 
						|
    }
 | 
						|
 | 
						|
    g_cpuHistoryTime[prevPos] = 0;
 | 
						|
    for (loop = 0; loop < LOSCFG_PLATFORM_HWI_LIMIT; loop++) {
 | 
						|
        if (g_irqCpup[loop].status != OS_CPUP_USED) {
 | 
						|
            continue;
 | 
						|
        }
 | 
						|
        g_irqCpup[loop].historyTime[prevPos] = g_irqCpup[loop].allTime;
 | 
						|
        g_cpuHistoryTime[prevPos] += g_irqCpup[loop].allTime;
 | 
						|
    }
 | 
						|
    LOS_IntRestore(intSave);
 | 
						|
 | 
						|
    return;
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_INIT UINT32 OsCpupGuardCreator(VOID)
 | 
						|
{
 | 
						|
    UINT32 cpupSwtmrID;
 | 
						|
#if (LOSCFG_BASE_CORE_SWTMR_ALIGN == 1)
 | 
						|
    (VOID)LOS_SwtmrCreate(LOSCFG_BASE_CORE_TICK_PER_SECOND, LOS_SWTMR_MODE_PERIOD,
 | 
						|
                          (SWTMR_PROC_FUNC)OsCpupGuard, &cpupSwtmrID, 0,
 | 
						|
                          OS_SWTMR_ROUSES_ALLOW, OS_SWTMR_ALIGN_INSENSITIVE);
 | 
						|
#else
 | 
						|
    (VOID)LOS_SwtmrCreate(LOSCFG_BASE_CORE_TICK_PER_SECOND, LOS_SWTMR_MODE_PERIOD,
 | 
						|
                          (SWTMR_PROC_FUNC)OsCpupGuard, &cpupSwtmrID, 0);
 | 
						|
#endif
 | 
						|
 | 
						|
    (VOID)LOS_SwtmrStart(cpupSwtmrID);
 | 
						|
 | 
						|
    return LOS_OK;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : OsCpupDaemonInit
 | 
						|
Description: initialization of CPUP Daemon
 | 
						|
Input      : None
 | 
						|
Return     : LOS_OK or Error Information
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_INIT UINT32 OsCpupDaemonInit()
 | 
						|
{
 | 
						|
#if (LOSCFG_BASE_CORE_SWTMR == 1)
 | 
						|
    (VOID)OsCpupGuardCreator();
 | 
						|
    g_irqCpupInitFlg = 1;
 | 
						|
#endif
 | 
						|
 | 
						|
    return LOS_OK;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : OsCpupInit
 | 
						|
Description: initialization of CPUP
 | 
						|
Input      : None
 | 
						|
Return     : LOS_OK or Error Information
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_INIT UINT32 OsCpupInit()
 | 
						|
{
 | 
						|
    UINT32 size;
 | 
						|
    CHAR *cpupMem = NULL;
 | 
						|
 | 
						|
    size = g_taskMaxNum * sizeof(OsCpupCB);
 | 
						|
#if (LOSCFG_CPUP_INCLUDE_IRQ == 1)
 | 
						|
    size += LOSCFG_PLATFORM_HWI_LIMIT * sizeof(OsIrqCpupCB);
 | 
						|
#endif
 | 
						|
 | 
						|
    cpupMem = LOS_MemAlloc(m_aucSysMem0, size);
 | 
						|
    if (cpupMem == NULL) {
 | 
						|
        return LOS_ERRNO_CPUP_NO_MEMORY;
 | 
						|
    }
 | 
						|
    (VOID)memset_s(cpupMem, size, 0, size);
 | 
						|
 | 
						|
    g_cpup = (OsCpupCB *)cpupMem;
 | 
						|
#if (LOSCFG_CPUP_INCLUDE_IRQ == 1)
 | 
						|
    g_irqCpup = (OsIrqCpupCB *)(cpupMem + g_taskMaxNum * sizeof(OsCpupCB));
 | 
						|
#endif
 | 
						|
 | 
						|
    g_cpupInitFlg = 1;
 | 
						|
 | 
						|
    return LOS_OK;
 | 
						|
}
 | 
						|
 | 
						|
/* The calculation time unit is changed to us to decouple the influence of
 | 
						|
 * system frequency modulation on CPUP
 | 
						|
 */
 | 
						|
STATIC UINT64 CpupTimeUsGet(VOID)
 | 
						|
{
 | 
						|
    UINT64 time = LOS_SysCycleGet();
 | 
						|
    return OS_SYS_CYCLE_TO_US(time);
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : OsTskCycleStart
 | 
						|
Description: start task to get cycles count in current task beginning
 | 
						|
Input      : None
 | 
						|
Return     : None
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_MINOR VOID OsTskCycleStart(VOID)
 | 
						|
{
 | 
						|
    UINT32 taskID;
 | 
						|
 | 
						|
    if (g_cpupInitFlg == 0) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    taskID = g_losTask.newTask->taskID;
 | 
						|
    g_cpup[taskID].cpupID = taskID;
 | 
						|
    g_cpup[taskID].startTime = CpupTimeUsGet();
 | 
						|
 | 
						|
    return;
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : OsTskCycleEnd
 | 
						|
Description: quit task and get cycle count
 | 
						|
Input      : None
 | 
						|
Return     : None
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_MINOR VOID OsTskCycleEnd(VOID)
 | 
						|
{
 | 
						|
    UINT32 taskID;
 | 
						|
    UINT64 cpuTime;
 | 
						|
 | 
						|
    if (g_cpupInitFlg == 0) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    taskID = g_losTask.runTask->taskID;
 | 
						|
 | 
						|
    if (g_cpup[taskID].startTime == 0) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    cpuTime = CpupTimeUsGet();
 | 
						|
    if (cpuTime < g_cpup[taskID].startTime) {
 | 
						|
        cpuTime += OS_US_PER_TICK;
 | 
						|
    }
 | 
						|
 | 
						|
    g_cpup[taskID].allTime += (cpuTime - g_cpup[taskID].startTime);
 | 
						|
    g_cpup[taskID].startTime = 0;
 | 
						|
 | 
						|
    return;
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : OsTskCycleEndStart
 | 
						|
Description: start task to get cycles count in current task ending
 | 
						|
Input      : None
 | 
						|
Return     : None
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_MINOR VOID OsTskCycleEndStart(VOID)
 | 
						|
{
 | 
						|
    UINT32 taskID;
 | 
						|
    UINT64 cpuTime;
 | 
						|
    UINT16 loopNum;
 | 
						|
 | 
						|
    if (g_cpupInitFlg == 0) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    taskID = g_losTask.runTask->taskID;
 | 
						|
    cpuTime = CpupTimeUsGet();
 | 
						|
 | 
						|
    if (g_cpup[taskID].startTime != 0) {
 | 
						|
        if (cpuTime < g_cpup[taskID].startTime) {
 | 
						|
            cpuTime += OS_US_PER_TICK;
 | 
						|
        }
 | 
						|
 | 
						|
        g_cpup[taskID].allTime += (cpuTime - g_cpup[taskID].startTime);
 | 
						|
        g_cpup[taskID].startTime = 0;
 | 
						|
    }
 | 
						|
 | 
						|
    taskID = g_losTask.newTask->taskID;
 | 
						|
    g_cpup[taskID].cpupID = taskID;
 | 
						|
    g_cpup[taskID].startTime = cpuTime;
 | 
						|
 | 
						|
    if ((cpuTime - g_lastRecordTime) > OS_CPUP_RECORD_PERIOD) {
 | 
						|
        g_lastRecordTime = cpuTime;
 | 
						|
 | 
						|
        for (loopNum = 0; loopNum < g_taskMaxNum; loopNum++) {
 | 
						|
            g_cpup[loopNum].historyTime[g_hisPos] = g_cpup[loopNum].allTime;
 | 
						|
        }
 | 
						|
 | 
						|
        if (g_hisPos == (OS_CPUP_HISTORY_RECORD_NUM - 1)) {
 | 
						|
            g_hisPos = 0;
 | 
						|
        } else {
 | 
						|
            g_hisPos++;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    return;
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_MINOR STATIC INLINE UINT16 OsGetPrePos(UINT16 curPos)
 | 
						|
{
 | 
						|
    return (curPos == 0) ? (OS_CPUP_HISTORY_RECORD_NUM - 1) : (curPos - 1);
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_MINOR STATIC VOID OsGetPositions(UINT16 mode, UINT16* curPosAddr, UINT16* prePosAddr)
 | 
						|
{
 | 
						|
    UINT16 curPos;
 | 
						|
    UINT16 prePos = 0;
 | 
						|
 | 
						|
    curPos = g_hisPos;
 | 
						|
 | 
						|
    if (mode == CPUP_IN_1S) {
 | 
						|
        curPos = OsGetPrePos(curPos);
 | 
						|
        prePos = OsGetPrePos(curPos);
 | 
						|
    } else if (mode == CPUP_LESS_THAN_1S) {
 | 
						|
        curPos = OsGetPrePos(curPos);
 | 
						|
    }
 | 
						|
 | 
						|
    *curPosAddr = curPos;
 | 
						|
    *prePosAddr = prePos;
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : LOS_SysCpuUsage
 | 
						|
Description: get current CPU usage
 | 
						|
Input      : None
 | 
						|
Return     : cpupRet:current CPU usage
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_MINOR UINT32 LOS_SysCpuUsage(VOID)
 | 
						|
{
 | 
						|
    UINT64  cpuTimeAll = 0;
 | 
						|
    UINT32  cpupRet = 0;
 | 
						|
    UINT16  loopNum;
 | 
						|
    UINT32 intSave;
 | 
						|
 | 
						|
    if (g_cpupInitFlg == 0) {
 | 
						|
        return LOS_ERRNO_CPUP_NO_INIT;
 | 
						|
    }
 | 
						|
 | 
						|
    // get end time of current task
 | 
						|
    intSave = LOS_IntLock();
 | 
						|
    OsTskCycleEnd();
 | 
						|
 | 
						|
    for (loopNum = 0; loopNum < g_taskMaxNum; loopNum++) {
 | 
						|
        cpuTimeAll += g_cpup[loopNum].allTime;
 | 
						|
    }
 | 
						|
 | 
						|
    if (cpuTimeAll) {
 | 
						|
        cpupRet = LOS_CPUP_PRECISION -  (UINT32)((LOS_CPUP_PRECISION *
 | 
						|
            g_cpup[g_idleTaskID].allTime) / cpuTimeAll);
 | 
						|
    }
 | 
						|
 | 
						|
    OsTskCycleStart();
 | 
						|
    LOS_IntRestore(intSave);
 | 
						|
 | 
						|
    return cpupRet;
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : LOS_HistorySysCpuUsage
 | 
						|
Description: get CPU usage history
 | 
						|
Input      : mode: mode,0 = usage in 10s,1 = usage in last 1s, else = less than 1s
 | 
						|
Return     : cpupRet:CPU usage history
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_MINOR UINT32 LOS_HistorySysCpuUsage(UINT16 mode)
 | 
						|
{
 | 
						|
    UINT64  cpuTimeAll = 0;
 | 
						|
    UINT64  idleCycleAll = 0;
 | 
						|
    UINT32  cpupRet = 0;
 | 
						|
    UINT16  loopNum;
 | 
						|
    UINT16  curPos;
 | 
						|
    UINT16  prePos = 0;
 | 
						|
    UINT32 intSave;
 | 
						|
 | 
						|
    if (g_cpupInitFlg == 0) {
 | 
						|
        return LOS_ERRNO_CPUP_NO_INIT;
 | 
						|
    }
 | 
						|
 | 
						|
    // get end time of current task
 | 
						|
    intSave = LOS_IntLock();
 | 
						|
    OsTskCycleEnd();
 | 
						|
 | 
						|
    OsGetPositions(mode, &curPos, &prePos);
 | 
						|
 | 
						|
    for (loopNum = 0; loopNum < g_taskMaxNum; loopNum++) {
 | 
						|
        if (mode == CPUP_IN_1S) {
 | 
						|
            cpuTimeAll += g_cpup[loopNum].historyTime[curPos] - g_cpup[loopNum].historyTime[prePos];
 | 
						|
        } else {
 | 
						|
            cpuTimeAll += g_cpup[loopNum].allTime - g_cpup[loopNum].historyTime[curPos];
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    if (mode == CPUP_IN_1S) {
 | 
						|
        idleCycleAll += g_cpup[g_idleTaskID].historyTime[curPos] -
 | 
						|
                           g_cpup[g_idleTaskID].historyTime[prePos];
 | 
						|
    } else {
 | 
						|
        idleCycleAll += g_cpup[g_idleTaskID].allTime - g_cpup[g_idleTaskID].historyTime[curPos];
 | 
						|
    }
 | 
						|
 | 
						|
    if (cpuTimeAll) {
 | 
						|
        cpupRet = (LOS_CPUP_PRECISION -  (UINT32)((LOS_CPUP_PRECISION * idleCycleAll) / cpuTimeAll));
 | 
						|
    }
 | 
						|
 | 
						|
    OsTskCycleStart();
 | 
						|
    LOS_IntRestore(intSave);
 | 
						|
 | 
						|
    return cpupRet;
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : LOS_TaskCpuUsage
 | 
						|
Description: get CPU usage of certain task
 | 
						|
Input      : taskID : task ID
 | 
						|
Return     : cpupRet:CPU usage of certain task
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_MINOR UINT32 LOS_TaskCpuUsage(UINT32 taskID)
 | 
						|
{
 | 
						|
    UINT64  cpuTimeAll = 0;
 | 
						|
    UINT16  loopNum;
 | 
						|
    UINT32 intSave;
 | 
						|
    UINT32  cpupRet = 0;
 | 
						|
 | 
						|
    if (g_cpupInitFlg == 0) {
 | 
						|
        return LOS_ERRNO_CPUP_NO_INIT;
 | 
						|
    }
 | 
						|
    if (OS_TSK_GET_INDEX(taskID) >= g_taskMaxNum) {
 | 
						|
        return LOS_ERRNO_CPUP_TSK_ID_INVALID;
 | 
						|
    }
 | 
						|
    if (g_cpup[taskID].cpupID != taskID) {
 | 
						|
        return LOS_ERRNO_CPUP_THREAD_NO_CREATED;
 | 
						|
    }
 | 
						|
    if ((g_cpup[taskID].status & OS_TASK_STATUS_UNUSED) || (g_cpup[taskID].status == 0)) {
 | 
						|
        return LOS_ERRNO_CPUP_THREAD_NO_CREATED;
 | 
						|
    }
 | 
						|
    intSave = LOS_IntLock();
 | 
						|
    OsTskCycleEnd();
 | 
						|
 | 
						|
    /* get total Cycle */
 | 
						|
    for (loopNum = 0; loopNum < g_taskMaxNum; loopNum++) {
 | 
						|
        if ((g_cpup[loopNum].status & OS_TASK_STATUS_UNUSED) || (g_cpup[loopNum].status == 0)) {
 | 
						|
            continue;
 | 
						|
        }
 | 
						|
        cpuTimeAll += g_cpup[loopNum].allTime;
 | 
						|
    }
 | 
						|
 | 
						|
    if (cpuTimeAll) {
 | 
						|
        cpupRet = (UINT32)((LOS_CPUP_PRECISION * g_cpup[taskID].allTime) / cpuTimeAll);
 | 
						|
    }
 | 
						|
 | 
						|
    OsTskCycleStart();
 | 
						|
    LOS_IntRestore(intSave);
 | 
						|
 | 
						|
    return cpupRet;
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : LOS_HistoryTaskCpuUsage
 | 
						|
Description: get CPU usage history of certain task
 | 
						|
Input      : taskID : task ID
 | 
						|
           : mode: mode,0 = usage in 10s,1 = usage in last 1s, else = less than 1s
 | 
						|
Return     : cpupRet:CPU usage history of task
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_MINOR UINT32 LOS_HistoryTaskCpuUsage(UINT32 taskID, UINT16 mode)
 | 
						|
{
 | 
						|
    UINT64  cpuTimeAll = 0;
 | 
						|
    UINT64  cpuTimeCurTsk = 0;
 | 
						|
    UINT16  loopNum, curPos;
 | 
						|
    UINT16  prePos = 0;
 | 
						|
    UINT32 intSave;
 | 
						|
    UINT32  cpupRet = 0;
 | 
						|
 | 
						|
    if (g_cpupInitFlg == 0) {
 | 
						|
        return LOS_ERRNO_CPUP_NO_INIT;
 | 
						|
    }
 | 
						|
    if (OS_TSK_GET_INDEX(taskID) >= g_taskMaxNum) {
 | 
						|
        return LOS_ERRNO_CPUP_TSK_ID_INVALID;
 | 
						|
    }
 | 
						|
    if (g_cpup[taskID].cpupID != taskID) {
 | 
						|
        return LOS_ERRNO_CPUP_THREAD_NO_CREATED;
 | 
						|
    }
 | 
						|
    if ((g_cpup[taskID].status & OS_TASK_STATUS_UNUSED) || (g_cpup[taskID].status == 0)) {
 | 
						|
        return LOS_ERRNO_CPUP_THREAD_NO_CREATED;
 | 
						|
    }
 | 
						|
    intSave = LOS_IntLock();
 | 
						|
    OsTskCycleEnd();
 | 
						|
 | 
						|
    OsGetPositions(mode, &curPos, &prePos);
 | 
						|
 | 
						|
    /* get total Cycle in history */
 | 
						|
    for (loopNum = 0; loopNum < g_taskMaxNum; loopNum++) {
 | 
						|
        if ((g_cpup[loopNum].status & OS_TASK_STATUS_UNUSED) || (g_cpup[loopNum].status == 0)) {
 | 
						|
            continue;
 | 
						|
        }
 | 
						|
 | 
						|
        if (mode == CPUP_IN_1S) {
 | 
						|
            cpuTimeAll += g_cpup[loopNum].historyTime[curPos] - g_cpup[loopNum].historyTime[prePos];
 | 
						|
        } else {
 | 
						|
            cpuTimeAll += g_cpup[loopNum].allTime - g_cpup[loopNum].historyTime[curPos];
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    if (mode == CPUP_IN_1S) {
 | 
						|
        cpuTimeCurTsk += g_cpup[taskID].historyTime[curPos] - g_cpup[taskID].historyTime[prePos];
 | 
						|
    } else {
 | 
						|
        cpuTimeCurTsk += g_cpup[taskID].allTime - g_cpup[taskID].historyTime[curPos];
 | 
						|
    }
 | 
						|
    if (cpuTimeAll) {
 | 
						|
        cpupRet = (UINT32)((LOS_CPUP_PRECISION * cpuTimeCurTsk) / cpuTimeAll);
 | 
						|
    }
 | 
						|
 | 
						|
    OsTskCycleStart();
 | 
						|
    LOS_IntRestore(intSave);
 | 
						|
 | 
						|
    return cpupRet;
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_MINOR UINT32 LOS_AllTaskCpuUsage(CPUP_INFO_S *cpupInfo, UINT16 mode)
 | 
						|
{
 | 
						|
    UINT16  loopNum;
 | 
						|
    UINT16  curPos;
 | 
						|
    UINT16  prePos = 0;
 | 
						|
    UINT32 intSave;
 | 
						|
    UINT64  cpuTimeAll = 0;
 | 
						|
    UINT64  cpuTimeCurTsk = 0;
 | 
						|
 | 
						|
    if (g_cpupInitFlg == 0) {
 | 
						|
        return  LOS_ERRNO_CPUP_NO_INIT;
 | 
						|
    }
 | 
						|
 | 
						|
    if (cpupInfo == NULL) {
 | 
						|
        return LOS_ERRNO_CPUP_TASK_PTR_NULL;
 | 
						|
    }
 | 
						|
 | 
						|
    intSave = LOS_IntLock();
 | 
						|
    OsTskCycleEnd();
 | 
						|
 | 
						|
    OsGetPositions(mode, &curPos, &prePos);
 | 
						|
 | 
						|
    for (loopNum = 0; loopNum < g_taskMaxNum; loopNum++) {
 | 
						|
        if ((g_cpup[loopNum].status & OS_TASK_STATUS_UNUSED) ||
 | 
						|
            (g_cpup[loopNum].status == 0)) {
 | 
						|
            continue;
 | 
						|
        }
 | 
						|
 | 
						|
        if (mode == CPUP_IN_1S) {
 | 
						|
            cpuTimeAll += g_cpup[loopNum].historyTime[curPos] - g_cpup[loopNum].historyTime[prePos];
 | 
						|
        } else {
 | 
						|
            cpuTimeAll += g_cpup[loopNum].allTime - g_cpup[loopNum].historyTime[curPos];
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    for (loopNum = 0; loopNum < g_taskMaxNum; loopNum++) {
 | 
						|
        if ((g_cpup[loopNum].status & OS_TASK_STATUS_UNUSED) ||
 | 
						|
            (g_cpup[loopNum].status == 0)) {
 | 
						|
            continue;
 | 
						|
        }
 | 
						|
 | 
						|
        if (mode == CPUP_IN_1S) {
 | 
						|
            cpuTimeCurTsk += g_cpup[loopNum].historyTime[curPos] - g_cpup[loopNum].historyTime[prePos];
 | 
						|
        } else {
 | 
						|
            cpuTimeCurTsk += g_cpup[loopNum].allTime - g_cpup[loopNum].historyTime[curPos];
 | 
						|
        }
 | 
						|
        cpupInfo[loopNum].usStatus = g_cpup[loopNum].status;
 | 
						|
        if (cpuTimeAll) {
 | 
						|
            cpupInfo[loopNum].uwUsage = (UINT32)((LOS_CPUP_PRECISION * cpuTimeCurTsk) / cpuTimeAll);
 | 
						|
        }
 | 
						|
 | 
						|
        cpuTimeCurTsk = 0;
 | 
						|
    }
 | 
						|
 | 
						|
    OsTskCycleStart();
 | 
						|
    LOS_IntRestore(intSave);
 | 
						|
 | 
						|
    return LOS_OK;
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************
 | 
						|
Function   : LOS_CpupUsageMonitor
 | 
						|
Description: Get CPU usage history of certain task.
 | 
						|
Input      : type: cpup type, SYS_CPU_USAGE and TASK_CPU_USAGE
 | 
						|
           : taskID: task ID, Only in SYS_CPU_USAGE type, taskID is invalid
 | 
						|
           : mode: mode, CPUP_IN_10S = usage in 10s, CPUP_IN_1S = usage in last 1s, CPUP_LESS_THAN_1S = less than 1s
 | 
						|
Return     : LOS_OK on success, or OS_ERROR on failure
 | 
						|
*****************************************************************************/
 | 
						|
LITE_OS_SEC_TEXT_MINOR UINT32 LOS_CpupUsageMonitor(CPUP_TYPE_E type, CPUP_MODE_E mode, UINT32 taskID)
 | 
						|
{
 | 
						|
    UINT32 ret;
 | 
						|
    LosTaskCB *taskCB = NULL;
 | 
						|
 | 
						|
    switch (type) {
 | 
						|
        case SYS_CPU_USAGE:
 | 
						|
            if (mode == CPUP_IN_10S) {
 | 
						|
                PRINTK("\nSysCpuUsage in 10s: ");
 | 
						|
            } else if (mode == CPUP_IN_1S) {
 | 
						|
                PRINTK("\nSysCpuUsage in 1s: ");
 | 
						|
            } else {
 | 
						|
                PRINTK("\nSysCpuUsage in <1s: ");
 | 
						|
            }
 | 
						|
            ret = LOS_HistorySysCpuUsage(mode);
 | 
						|
            PRINTK("%d.%d", ret / LOS_CPUP_PRECISION_MULT, ret % LOS_CPUP_PRECISION_MULT);
 | 
						|
            break;
 | 
						|
 | 
						|
        case TASK_CPU_USAGE:
 | 
						|
            if (taskID > LOSCFG_BASE_CORE_TSK_LIMIT) {
 | 
						|
                PRINT_ERR("\nThe taskid is invalid.\n");
 | 
						|
                return OS_ERROR;
 | 
						|
            }
 | 
						|
            taskCB = OS_TCB_FROM_TID(taskID);
 | 
						|
            if ((taskCB->taskStatus & OS_TASK_STATUS_UNUSED)) {
 | 
						|
                PRINT_ERR("\nThe taskid is invalid.\n");
 | 
						|
                return OS_ERROR;
 | 
						|
            }
 | 
						|
            if (mode == CPUP_IN_10S) {
 | 
						|
                PRINTK("\nCPUusage of taskID %d in 10s: ", taskID);
 | 
						|
            } else if (mode == CPUP_IN_1S) {
 | 
						|
                PRINTK("\nCPUusage of taskID %d in 1s: ", taskID);
 | 
						|
            } else {
 | 
						|
                PRINTK("\nCPUusage of taskID %d in <1s: ", taskID);
 | 
						|
            }
 | 
						|
            ret = LOS_HistoryTaskCpuUsage(taskID, mode);
 | 
						|
            PRINTK("%u.%u", ret / LOS_CPUP_PRECISION_MULT, ret % LOS_CPUP_PRECISION_MULT);
 | 
						|
            break;
 | 
						|
 | 
						|
        default:
 | 
						|
            PRINT_ERR("\nThe type is invalid.\n");
 | 
						|
            return OS_ERROR;
 | 
						|
    }
 | 
						|
 | 
						|
    return LOS_OK;
 | 
						|
}
 | 
						|
 | 
						|
#if (LOSCFG_CPUP_INCLUDE_IRQ == 1)
 | 
						|
LITE_OS_SEC_TEXT_MINOR VOID OsCpupIrqStart(UINT32 intNum)
 | 
						|
{
 | 
						|
    if (g_irqCpupInitFlg == 0) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    g_irqCpup[intNum].startTime = CpupTimeUsGet();
 | 
						|
    return;
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_MINOR VOID OsCpupIrqEnd(UINT32 intNum)
 | 
						|
{
 | 
						|
    UINT64 cpuTime;
 | 
						|
    UINT64 usedTime;
 | 
						|
 | 
						|
    if (g_irqCpupInitFlg == 0) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    if (g_irqCpup[intNum].startTime == 0) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    cpuTime = CpupTimeUsGet();
 | 
						|
    if (cpuTime < g_irqCpup[intNum].startTime) {
 | 
						|
        cpuTime += OS_US_PER_TICK;
 | 
						|
    }
 | 
						|
 | 
						|
    g_irqCpup[intNum].cpupID = intNum;
 | 
						|
    g_irqCpup[intNum].status = OS_CPUP_USED;
 | 
						|
    usedTime = cpuTime - g_irqCpup[intNum].startTime;
 | 
						|
 | 
						|
    if (g_irqCpup[intNum].count <= 1000) { /* 1000, Take 1000 samples */
 | 
						|
        g_irqCpup[intNum].allTime += usedTime;
 | 
						|
        g_irqCpup[intNum].count++;
 | 
						|
    } else {
 | 
						|
        g_irqCpup[intNum].allTime = 0;
 | 
						|
        g_irqCpup[intNum].count = 0;
 | 
						|
    }
 | 
						|
    g_irqCpup[intNum].startTime = 0;
 | 
						|
    if (usedTime > g_irqCpup[intNum].timeMax) {
 | 
						|
        g_irqCpup[intNum].timeMax = usedTime;
 | 
						|
    }
 | 
						|
    return;
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_MINOR OsIrqCpupCB *OsGetIrqCpupArrayBase(VOID)
 | 
						|
{
 | 
						|
    return g_irqCpup;
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_MINOR STATIC VOID OsGetIrqPositions(UINT16 mode, UINT16* curPosAddr, UINT16* prePosAddr)
 | 
						|
{
 | 
						|
    UINT16 curPos;
 | 
						|
    UINT16 prePos = 0;
 | 
						|
 | 
						|
    curPos = g_irqHisPos;
 | 
						|
 | 
						|
    if (mode == CPUP_IN_1S) {
 | 
						|
        curPos = OsGetPrePos(curPos);
 | 
						|
        prePos = OsGetPrePos(curPos);
 | 
						|
    } else if (mode == CPUP_LESS_THAN_1S) {
 | 
						|
        curPos = OsGetPrePos(curPos);
 | 
						|
    }
 | 
						|
 | 
						|
    *curPosAddr = curPos;
 | 
						|
    *prePosAddr = prePos;
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_MINOR STATIC UINT64 OsGetIrqAllTime(VOID)
 | 
						|
{
 | 
						|
    INT32 i;
 | 
						|
    UINT64 cpuTimeAll = 0;
 | 
						|
    for (i = 0; i < OS_CPUP_HISTORY_RECORD_NUM; i++) {
 | 
						|
        cpuTimeAll += g_cpuHistoryTime[i];
 | 
						|
    }
 | 
						|
 | 
						|
    return cpuTimeAll;
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_MINOR STATIC UINT64 OsGetIrqAllHisTime(UINT32 num)
 | 
						|
{
 | 
						|
    INT32 i;
 | 
						|
    UINT64 historyTime = 0;
 | 
						|
    for (i = 0; i < OS_CPUP_HISTORY_RECORD_NUM; i++) {
 | 
						|
        historyTime += g_irqCpup[num].historyTime[i];
 | 
						|
    }
 | 
						|
 | 
						|
    return historyTime;
 | 
						|
}
 | 
						|
 | 
						|
LITE_OS_SEC_TEXT_MINOR UINT32 LOS_GetAllIrqCpuUsage(UINT16 mode, CPUP_INFO_S *cpupInfo)
 | 
						|
{
 | 
						|
    UINT16 loopNum;
 | 
						|
    UINT16 curPos;
 | 
						|
    UINT16 prePos = 0;
 | 
						|
    UINT32 intSave;
 | 
						|
    UINT64 cpuTimeAll;
 | 
						|
    UINT64 cpuTimeCurIrq;
 | 
						|
 | 
						|
    if (g_irqCpupInitFlg == 0) {
 | 
						|
        return  LOS_ERRNO_CPUP_NO_INIT;
 | 
						|
    }
 | 
						|
 | 
						|
    if (cpupInfo == NULL) {
 | 
						|
        return LOS_ERRNO_CPUP_TASK_PTR_NULL;
 | 
						|
    }
 | 
						|
 | 
						|
    intSave = LOS_IntLock();
 | 
						|
 | 
						|
    OsGetIrqPositions(mode, &curPos, &prePos);
 | 
						|
    if (mode == CPUP_IN_10S) {
 | 
						|
        cpuTimeAll = OsGetIrqAllTime();
 | 
						|
    } else {
 | 
						|
        cpuTimeAll = g_cpuHistoryTime[curPos] - g_cpuHistoryTime[prePos];
 | 
						|
    }
 | 
						|
 | 
						|
    for (loopNum = 0; loopNum < LOSCFG_PLATFORM_HWI_LIMIT; loopNum++) {
 | 
						|
        if (g_irqCpup[loopNum].status != OS_CPUP_USED) {
 | 
						|
            continue;
 | 
						|
        }
 | 
						|
 | 
						|
        cpupInfo[loopNum].usStatus = g_irqCpup[loopNum].status;
 | 
						|
 | 
						|
        if (mode == CPUP_IN_10S) {
 | 
						|
            cpuTimeCurIrq = OsGetIrqAllHisTime(loopNum);
 | 
						|
        } else {
 | 
						|
            cpuTimeCurIrq = g_irqCpup[loopNum].historyTime[curPos] - g_irqCpup[loopNum].historyTime[prePos];
 | 
						|
        }
 | 
						|
 | 
						|
        if (cpuTimeAll != 0) {
 | 
						|
            cpupInfo[loopNum].uwUsage = (UINT32)((LOS_CPUP_PRECISION * cpuTimeCurIrq) / cpuTimeAll);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    LOS_IntRestore(intSave);
 | 
						|
    return LOS_OK;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#endif /* LOSCFG_BASE_CORE_CPUP */
 |