81 lines
3.2 KiB
C
81 lines
3.2 KiB
C
|
/*
|
||
|
|
* Copyright (c) CompanyNameMagicTag 2012-2019. All rights reserved.
|
||
|
|
* Description: 1.Modify the cpu occupancy statistics code. cpup_diag_dfx.c code
|
||
|
|
* Author: CompanyName
|
||
|
|
* Create: 2012-02-21
|
||
|
|
*/
|
||
|
|
#include "cpup_diag_dfx.h"
|
||
|
|
#include <soc_types.h>
|
||
|
|
#include <soc_mdm_types.h>
|
||
|
|
#include <soc_mdm_mem.h>
|
||
|
|
#include <soc_stdlib.h>
|
||
|
|
#include <soc_mdm_diag.h>
|
||
|
|
#include <dfx_diag_cmd_id.h>
|
||
|
|
#include <soc_mdm_cpup.h>
|
||
|
|
#include <soc_mdm_task.h>
|
||
|
|
#include <dfx_cpup.h>
|
||
|
|
|
||
|
|
td_u32 g_cpup_report_cnt;
|
||
|
|
|
||
|
|
EXT_PRV td_u32 cpup_dfx_diag_cmd(td_u16 id, EXT_IN td_pvoid cmd_param, td_u16 cmd_param_size, td_u8 option)
|
||
|
|
{
|
||
|
|
td_u32 ret = EXT_ERR_SUCCESS;
|
||
|
|
td_char printline[100] = { 0 };
|
||
|
|
ext_dfx_diag_cpup_cmd *cmd = cmd_param;
|
||
|
|
ext_unref_param(cmd_param_size);
|
||
|
|
if (cmd->option & 0x1) {
|
||
|
|
uapi_cpup_reset_usage();
|
||
|
|
}
|
||
|
|
ext_cpup_item *cpup_items = uapi_malloc(EXT_MOD_ID_CPUP_DFX, (td_u32)(sizeof(ext_cpup_item) * g_cpup_report_cnt));
|
||
|
|
if (cpup_items == TD_NULL) {
|
||
|
|
if (snprintf_s(printline, sizeof(printline), sizeof(printline) - 1, "cmd id %d errcode=%d\n", id,
|
||
|
|
EXT_ERR_NOT_ENOUGH_MEMORY) < 0) {
|
||
|
|
goto END;
|
||
|
|
}
|
||
|
|
uapi_diag_report_packet(id, option, (td_pbyte)printline, (td_u16)strlen(printline), TD_TRUE);
|
||
|
|
goto END;
|
||
|
|
}
|
||
|
|
if (uapi_cpup_get_usage(g_cpup_report_cnt, cpup_items) != EXT_ERR_SUCCESS) {
|
||
|
|
if (snprintf_s(printline, sizeof(printline), sizeof(printline) - 1, "cmd id %d errcode=%d\n", id, ret) < 0) {
|
||
|
|
goto END;
|
||
|
|
}
|
||
|
|
uapi_diag_report_packet(id, option, (td_pbyte)printline, (td_u16)strlen(printline), TD_TRUE);
|
||
|
|
goto END;
|
||
|
|
}
|
||
|
|
for (td_u32 i = 0; i < g_cpup_report_cnt; i++) {
|
||
|
|
ext_cpup_item *item = &cpup_items[i];
|
||
|
|
ext_task_info_s info = { 0 };
|
||
|
|
if (item->valid == 0) {
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
td_u32 low_time = (td_u32)item->cpu_time;
|
||
|
|
td_u32 high_time = (td_u32)(item->cpu_time >> 32); // right(32)
|
||
|
|
if (item->task) {
|
||
|
|
ret = uapi_task_get_info(item->id, &info);
|
||
|
|
if (ret == EXT_ERR_SUCCESS && snprintf_s(printline, sizeof(printline), sizeof(printline) - 1,
|
||
|
|
"[%s][pe\rmillage=%d][cpu_time=0x%08x%08x]\n", info.name, item->permillage, high_time, low_time) >= 0) {
|
||
|
|
uapi_diag_report_packet(id, option, (td_pbyte)printline, (td_u16)strlen(printline), TD_TRUE);
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
snprintf_s(printline, sizeof(printline), sizeof(printline) - 1,
|
||
|
|
"[isr%d][permillage=%d][cpu_time=0x%08x%08x]\n", item->id, item->permillage, high_time, low_time);
|
||
|
|
uapi_diag_report_packet(id, option, (td_pbyte)printline, (td_u16)strlen(printline), TD_TRUE);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
END:
|
||
|
|
if (cpup_items != TD_NULL) {
|
||
|
|
uapi_free(EXT_MOD_ID_CPUP_DFX, cpup_items);
|
||
|
|
}
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
EXT_PRV EXT_CONST ext_diag_cmd_reg_obj g_cpu_dfx_tbl[] = {
|
||
|
|
{ ID_DIAG_CMD_DRV_OS_CPUP, ID_DIAG_CMD_DRV_OS_CPUP, cpup_dfx_diag_cmd },
|
||
|
|
};
|
||
|
|
|
||
|
|
__init td_u32 usr_cpup_dfx_init(td_u8 report_count)
|
||
|
|
{
|
||
|
|
g_cpup_report_cnt = report_count;
|
||
|
|
return uapi_diag_register_cmd(g_cpu_dfx_tbl, sizeof(g_cpu_dfx_tbl) / sizeof(g_cpu_dfx_tbl[0]));
|
||
|
|
}
|