GK SDK 源码库: XMIPCLinuxV100R005C00SPC030 (kernel/tools/open_source excluded)
This commit is contained in:
+28
@@ -0,0 +1,28 @@
|
||||
/*
|
||||
* Copyright (c) 2019, Arm Limited. All rights reserved.
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#ifndef PMF_ASM_MACROS_S
|
||||
#define PMF_ASM_MACROS_S
|
||||
|
||||
#define PMF_TS_SIZE 8
|
||||
|
||||
/*
|
||||
* This macro calculates the address of the per-cpu timestamp
|
||||
* for the given service name and local timestamp id.
|
||||
* Clobbers: r0 - r4
|
||||
*/
|
||||
.macro pmf_calc_timestamp_addr _name, _tid
|
||||
mov r4, lr
|
||||
bl plat_my_core_pos
|
||||
mov lr, r4
|
||||
ldr r1, =__PERCPU_TIMESTAMP_SIZE__
|
||||
mov r2, #(\_tid * PMF_TS_SIZE)
|
||||
mla r0, r0, r1, r2
|
||||
ldr r1, =pmf_ts_mem_\_name
|
||||
add r0, r0, r1
|
||||
.endm
|
||||
|
||||
#endif /* PMF_ASM_MACROS_S */
|
||||
+30
@@ -0,0 +1,30 @@
|
||||
/*
|
||||
* Copyright (c) 2016-2018, ARM Limited and Contributors. All rights reserved.
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#ifndef PMF_ASM_MACROS_S
|
||||
#define PMF_ASM_MACROS_S
|
||||
|
||||
#define PMF_TS_SIZE 8
|
||||
|
||||
/*
|
||||
* This macro calculates the address of the per-cpu timestamp
|
||||
* for the given service name and local timestamp id.
|
||||
* Clobbers: x0 - x9
|
||||
*/
|
||||
.macro pmf_calc_timestamp_addr _name, _tid
|
||||
mov x9, x30
|
||||
bl plat_my_core_pos
|
||||
mov x30, x9
|
||||
adr x2, __PMF_PERCPU_TIMESTAMP_END__
|
||||
adr x1, __PMF_TIMESTAMP_START__
|
||||
sub x1, x2, x1
|
||||
mov x2, #(\_tid * PMF_TS_SIZE)
|
||||
madd x0, x0, x1, x2
|
||||
adr x1, pmf_ts_mem_\_name
|
||||
add x0, x0, x1
|
||||
.endm
|
||||
|
||||
#endif /* PMF_ASM_MACROS_S */
|
||||
@@ -0,0 +1,75 @@
|
||||
/*
|
||||
* Copyright (c) 2016-2020, ARM Limited and Contributors. All rights reserved.
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#ifndef PMF_H
|
||||
#define PMF_H
|
||||
|
||||
#include <lib/cassert.h>
|
||||
#include <lib/pmf/pmf_helpers.h>
|
||||
#include <lib/utils_def.h>
|
||||
|
||||
/*
|
||||
* Constants used for/by PMF services.
|
||||
*/
|
||||
#define PMF_ARM_TIF_IMPL_ID UL(0x41)
|
||||
#define PMF_TID_SHIFT 0
|
||||
#define PMF_TID_MASK (UL(0xFF) << PMF_TID_SHIFT)
|
||||
#define PMF_SVC_ID_SHIFT 10
|
||||
#define PMF_SVC_ID_MASK (UL(0x3F) << PMF_SVC_ID_SHIFT)
|
||||
#define PMF_IMPL_ID_SHIFT 24
|
||||
#define PMF_IMPL_ID_MASK (UL(0xFF) << PMF_IMPL_ID_SHIFT)
|
||||
|
||||
/*
|
||||
* Flags passed to PMF_REGISTER_SERVICE
|
||||
*/
|
||||
#define PMF_STORE_ENABLE (1 << 0)
|
||||
#define PMF_DUMP_ENABLE (1 << 1)
|
||||
|
||||
/*
|
||||
* Flags passed to PMF_GET_TIMESTAMP_XXX
|
||||
* and PMF_CAPTURE_TIMESTAMP
|
||||
*/
|
||||
#define PMF_CACHE_MAINT (U(1) << 0)
|
||||
#define PMF_NO_CACHE_MAINT U(0)
|
||||
|
||||
/*
|
||||
* Defines for PMF SMC function ids.
|
||||
*/
|
||||
#define PMF_SMC_GET_TIMESTAMP_32 U(0x82000010)
|
||||
#define PMF_SMC_GET_TIMESTAMP_64 U(0xC2000010)
|
||||
#define PMF_NUM_SMC_CALLS 2
|
||||
|
||||
/*
|
||||
* The macros below are used to identify
|
||||
* PMF calls from the SMC function ID.
|
||||
*/
|
||||
#define PMF_FID_MASK U(0xffe0)
|
||||
#define PMF_FID_VALUE U(0)
|
||||
#define is_pmf_fid(_fid) (((_fid) & PMF_FID_MASK) == PMF_FID_VALUE)
|
||||
|
||||
/* Following are the supported PMF service IDs */
|
||||
#define PMF_PSCI_STAT_SVC_ID 0
|
||||
#define PMF_RT_INSTR_SVC_ID 1
|
||||
|
||||
/*******************************************************************************
|
||||
* Function & variable prototypes
|
||||
******************************************************************************/
|
||||
/* PMF common functions */
|
||||
int pmf_get_timestamp_smc(unsigned int tid,
|
||||
u_register_t mpidr,
|
||||
unsigned int flags,
|
||||
unsigned long long *ts_value);
|
||||
int pmf_setup(void);
|
||||
uintptr_t pmf_smc_handler(unsigned int smc_fid,
|
||||
u_register_t x1,
|
||||
u_register_t x2,
|
||||
u_register_t x3,
|
||||
u_register_t x4,
|
||||
void *cookie,
|
||||
void *handle,
|
||||
u_register_t flags);
|
||||
|
||||
#endif /* PMF_H */
|
||||
@@ -0,0 +1,256 @@
|
||||
/*
|
||||
* Copyright (c) 2016-2020, ARM Limited and Contributors. All rights reserved.
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#ifndef PMF_HELPERS_H
|
||||
#define PMF_HELPERS_H
|
||||
|
||||
#include <assert.h>
|
||||
#include <stddef.h>
|
||||
#include <stdint.h>
|
||||
|
||||
#include <arch_helpers.h>
|
||||
#include <common/bl_common.h>
|
||||
#include <plat/common/platform.h>
|
||||
|
||||
/*
|
||||
* Prototype for PMF service functions.
|
||||
*/
|
||||
typedef int (*pmf_svc_init_t)(void);
|
||||
typedef unsigned long long (*pmf_svc_get_ts_t)(unsigned int tid,
|
||||
u_register_t mpidr,
|
||||
unsigned int flags);
|
||||
|
||||
/*
|
||||
* This is the definition of PMF service desc.
|
||||
*/
|
||||
typedef struct pmf_svc_desc {
|
||||
/* Structure version information */
|
||||
param_header_t h;
|
||||
|
||||
/* Name of the PMF service */
|
||||
const char *name;
|
||||
|
||||
/* PMF service config: Implementer id, Service id and total id*/
|
||||
unsigned int svc_config;
|
||||
|
||||
/* PMF service initialization handler */
|
||||
pmf_svc_init_t init;
|
||||
|
||||
/* PMF service time-stamp retrieval handler */
|
||||
pmf_svc_get_ts_t get_ts;
|
||||
} pmf_svc_desc_t;
|
||||
|
||||
#if ENABLE_PMF
|
||||
/*
|
||||
* Convenience macros for capturing time-stamp.
|
||||
*/
|
||||
#define PMF_DECLARE_CAPTURE_TIMESTAMP(_name) \
|
||||
void pmf_capture_timestamp_with_cache_maint_ ## _name( \
|
||||
unsigned int tid, \
|
||||
unsigned long long ts); \
|
||||
void pmf_capture_timestamp_ ## _name( \
|
||||
unsigned int tid, \
|
||||
unsigned long long ts);
|
||||
|
||||
#define PMF_CAPTURE_TIMESTAMP(_name, _tid, _flags) \
|
||||
do { \
|
||||
unsigned long long ts = read_cntpct_el0(); \
|
||||
if (((_flags) & PMF_CACHE_MAINT) != 0U) \
|
||||
pmf_capture_timestamp_with_cache_maint_ ## _name((_tid), ts);\
|
||||
else \
|
||||
pmf_capture_timestamp_ ## _name((_tid), ts); \
|
||||
} while (0)
|
||||
|
||||
#define PMF_CAPTURE_AND_GET_TIMESTAMP(_name, _tid, _flags, _tsval) \
|
||||
do { \
|
||||
(_tsval) = read_cntpct_el0(); \
|
||||
CASSERT(sizeof(_tsval) == sizeof(unsigned long long), invalid_tsval_size);\
|
||||
if (((_flags) & PMF_CACHE_MAINT) != 0U) \
|
||||
pmf_capture_timestamp_with_cache_maint_ ## _name((_tid), (_tsval));\
|
||||
else \
|
||||
pmf_capture_timestamp_ ## _name((_tid), (_tsval));\
|
||||
} while (0)
|
||||
|
||||
#define PMF_WRITE_TIMESTAMP(_name, _tid, _flags, _wrval) \
|
||||
do { \
|
||||
CASSERT(sizeof(_wrval) == sizeof(unsigned long long), invalid_wrval_size);\
|
||||
if (((_flags) & PMF_CACHE_MAINT) != 0U) \
|
||||
pmf_capture_timestamp_with_cache_maint_ ## _name((_tid), (_wrval));\
|
||||
else \
|
||||
pmf_capture_timestamp_ ## _name((_tid), (_wrval));\
|
||||
} while (0)
|
||||
|
||||
/*
|
||||
* Convenience macros for retrieving time-stamp.
|
||||
*/
|
||||
#define PMF_DECLARE_GET_TIMESTAMP(_name) \
|
||||
unsigned long long pmf_get_timestamp_by_index_ ## _name(\
|
||||
unsigned int tid, \
|
||||
unsigned int cpuid, \
|
||||
unsigned int flags); \
|
||||
unsigned long long pmf_get_timestamp_by_mpidr_ ## _name(\
|
||||
unsigned int tid, \
|
||||
u_register_t mpidr, \
|
||||
unsigned int flags);
|
||||
|
||||
#define PMF_GET_TIMESTAMP_BY_MPIDR(_name, _tid, _mpidr, _flags, _tsval)\
|
||||
_tsval = pmf_get_timestamp_by_mpidr_ ## _name(_tid, _mpidr, _flags)
|
||||
|
||||
#define PMF_GET_TIMESTAMP_BY_INDEX(_name, _tid, _cpuid, _flags, _tsval)\
|
||||
_tsval = pmf_get_timestamp_by_index_ ## _name(_tid, _cpuid, _flags)
|
||||
|
||||
/* Convenience macros to register a PMF service.*/
|
||||
/*
|
||||
* This macro is used to register a PMF Service. It allocates PMF memory
|
||||
* and defines default service-specific PMF functions.
|
||||
*/
|
||||
#define PMF_REGISTER_SERVICE(_name, _svcid, _totalid, _flags) \
|
||||
PMF_ALLOCATE_TIMESTAMP_MEMORY(_name, _totalid) \
|
||||
PMF_DEFINE_CAPTURE_TIMESTAMP(_name, _flags) \
|
||||
PMF_DEFINE_GET_TIMESTAMP(_name)
|
||||
|
||||
/*
|
||||
* This macro is used to register a PMF service, including an
|
||||
* SMC interface to that service.
|
||||
*/
|
||||
#define PMF_REGISTER_SERVICE_SMC(_name, _svcid, _totalid, _flags)\
|
||||
PMF_REGISTER_SERVICE(_name, _svcid, _totalid, _flags) \
|
||||
PMF_DEFINE_SERVICE_DESC(_name, PMF_ARM_TIF_IMPL_ID, \
|
||||
_svcid, _totalid, NULL, \
|
||||
pmf_get_timestamp_by_mpidr_ ## _name)
|
||||
|
||||
/*
|
||||
* This macro is used to register a PMF service that has an SMC interface
|
||||
* but provides its own service-specific PMF functions.
|
||||
*/
|
||||
#define PMF_REGISTER_SERVICE_SMC_OWN(_name, _implid, _svcid, _totalid, \
|
||||
_init, _getts) \
|
||||
PMF_DEFINE_SERVICE_DESC(_name, _implid, _svcid, _totalid, \
|
||||
_init, _getts)
|
||||
|
||||
#else
|
||||
|
||||
#define PMF_REGISTER_SERVICE(_name, _svcid, _totalid, _flags)
|
||||
#define PMF_REGISTER_SERVICE_SMC(_name, _svcid, _totalid, _flags)
|
||||
#define PMF_REGISTER_SERVICE_SMC_OWN(_name, _implid, _svcid, _totalid, \
|
||||
_init, _getts)
|
||||
#define PMF_DECLARE_CAPTURE_TIMESTAMP(_name)
|
||||
#define PMF_DECLARE_GET_TIMESTAMP(_name)
|
||||
#define PMF_CAPTURE_TIMESTAMP(_name, _tid, _flags)
|
||||
#define PMF_GET_TIMESTAMP_BY_MPIDR(_name, _tid, _mpidr, _flags, _tsval)
|
||||
#define PMF_GET_TIMESTAMP_BY_INDEX(_name, _tid, _cpuid, _flags, _tsval)
|
||||
|
||||
#endif /* ENABLE_PMF */
|
||||
|
||||
/*
|
||||
* Convenience macro to allocate memory for a PMF service.
|
||||
*
|
||||
* The extern declaration is there to satisfy MISRA C-2012 rule 8.4.
|
||||
*/
|
||||
#define PMF_ALLOCATE_TIMESTAMP_MEMORY(_name, _total_id) \
|
||||
extern unsigned long long pmf_ts_mem_ ## _name[_total_id]; \
|
||||
unsigned long long pmf_ts_mem_ ## _name[_total_id] \
|
||||
__aligned(CACHE_WRITEBACK_GRANULE) \
|
||||
__section("pmf_timestamp_array") \
|
||||
__used;
|
||||
|
||||
/*
|
||||
* Convenience macro to validate tid index for the given TS array.
|
||||
*/
|
||||
#define PMF_VALIDATE_TID(_name, _tid) \
|
||||
assert((_tid & PMF_TID_MASK) < (ARRAY_SIZE(pmf_ts_mem_ ## _name)))
|
||||
|
||||
/*
|
||||
* Convenience macros for capturing time-stamp.
|
||||
*
|
||||
* The extern declaration is there to satisfy MISRA C-2012 rule 8.4.
|
||||
*/
|
||||
#define PMF_DEFINE_CAPTURE_TIMESTAMP(_name, _flags) \
|
||||
void pmf_capture_timestamp_ ## _name( \
|
||||
unsigned int tid, \
|
||||
unsigned long long ts) \
|
||||
{ \
|
||||
CASSERT(_flags != 0, select_proper_config); \
|
||||
PMF_VALIDATE_TID(_name, (uint64_t)tid); \
|
||||
uintptr_t base_addr = (uintptr_t) pmf_ts_mem_ ## _name; \
|
||||
if (((_flags) & PMF_STORE_ENABLE) != 0) \
|
||||
__pmf_store_timestamp(base_addr, \
|
||||
(uint64_t)tid, ts); \
|
||||
if (((_flags) & PMF_DUMP_ENABLE) != 0) \
|
||||
__pmf_dump_timestamp((uint64_t)tid, ts); \
|
||||
} \
|
||||
void pmf_capture_timestamp_with_cache_maint_ ## _name( \
|
||||
unsigned int tid, \
|
||||
unsigned long long ts) \
|
||||
{ \
|
||||
CASSERT(_flags != 0, select_proper_config); \
|
||||
PMF_VALIDATE_TID(_name, (uint64_t)tid); \
|
||||
uintptr_t base_addr = (uintptr_t) pmf_ts_mem_ ## _name; \
|
||||
if (((_flags) & PMF_STORE_ENABLE) != 0) \
|
||||
__pmf_store_timestamp_with_cache_maint( \
|
||||
base_addr, (uint64_t)tid, ts); \
|
||||
if (((_flags) & PMF_DUMP_ENABLE) != 0) \
|
||||
__pmf_dump_timestamp((uint64_t)tid, ts); \
|
||||
}
|
||||
|
||||
/*
|
||||
* Convenience macros for retrieving time-stamp.
|
||||
*
|
||||
* The extern declaration is there to satisfy MISRA C-2012 rule 8.4.
|
||||
*/
|
||||
#define PMF_DEFINE_GET_TIMESTAMP(_name) \
|
||||
unsigned long long pmf_get_timestamp_by_index_ ## _name( \
|
||||
unsigned int tid, unsigned int cpuid, unsigned int flags)\
|
||||
{ \
|
||||
PMF_VALIDATE_TID(_name, tid); \
|
||||
uintptr_t base_addr = (uintptr_t) pmf_ts_mem_ ## _name; \
|
||||
return __pmf_get_timestamp(base_addr, tid, cpuid, flags);\
|
||||
} \
|
||||
unsigned long long pmf_get_timestamp_by_mpidr_ ## _name( \
|
||||
unsigned int tid, u_register_t mpidr, unsigned int flags)\
|
||||
{ \
|
||||
PMF_VALIDATE_TID(_name, tid); \
|
||||
uintptr_t base_addr = (uintptr_t) pmf_ts_mem_ ## _name; \
|
||||
return __pmf_get_timestamp(base_addr, tid, \
|
||||
plat_core_pos_by_mpidr(mpidr), flags); \
|
||||
}
|
||||
|
||||
/*
|
||||
* Convenience macro to register a PMF service.
|
||||
* This is needed for services that require SMC handling.
|
||||
*/
|
||||
#define PMF_DEFINE_SERVICE_DESC(_name, _implid, _svcid, _totalid, \
|
||||
_init, _getts_by_mpidr) \
|
||||
static const pmf_svc_desc_t __pmf_desc_ ## _name \
|
||||
__section("pmf_svc_descs") __used = { \
|
||||
.h.type = PARAM_EP, \
|
||||
.h.version = VERSION_1, \
|
||||
.h.size = sizeof(pmf_svc_desc_t), \
|
||||
.h.attr = 0, \
|
||||
.name = #_name, \
|
||||
.svc_config = ((((_implid) << PMF_IMPL_ID_SHIFT) & \
|
||||
PMF_IMPL_ID_MASK) | \
|
||||
(((_svcid) << PMF_SVC_ID_SHIFT) & \
|
||||
PMF_SVC_ID_MASK) | \
|
||||
(((_totalid) << PMF_TID_SHIFT) & \
|
||||
PMF_TID_MASK)), \
|
||||
.init = _init, \
|
||||
.get_ts = _getts_by_mpidr \
|
||||
};
|
||||
|
||||
/* PMF internal functions */
|
||||
void __pmf_dump_timestamp(unsigned int tid, unsigned long long ts);
|
||||
void __pmf_store_timestamp(uintptr_t base_addr,
|
||||
unsigned int tid,
|
||||
unsigned long long ts);
|
||||
void __pmf_store_timestamp_with_cache_maint(uintptr_t base_addr,
|
||||
unsigned int tid,
|
||||
unsigned long long ts);
|
||||
unsigned long long __pmf_get_timestamp(uintptr_t base_addr,
|
||||
unsigned int tid,
|
||||
unsigned int cpuid,
|
||||
unsigned int flags);
|
||||
#endif /* PMF_HELPERS_H */
|
||||
Reference in New Issue
Block a user