1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
|
// SPDX-License-Identifier: BSD-2-Clause
/*
* Copyright (c) 2015, Linaro Limited
*/
#include <compiler.h>
#include <stdio.h>
#include <trace.h>
#include <kernel/pseudo_ta.h>
#include <mm/tee_pager.h>
#include <mm/tee_mm.h>
#include <string.h>
#include <string_ext.h>
#include <malloc.h>
#define TA_NAME "stats.ta"
#define STATS_UUID \
{ 0xd96a5b40, 0xe2c7, 0xb1af, \
{ 0x87, 0x94, 0x10, 0x02, 0xa5, 0xd5, 0xc6, 0x1b } }
#define STATS_CMD_PAGER_STATS 0
#define STATS_CMD_ALLOC_STATS 1
#define STATS_CMD_MEMLEAK_STATS 2
#define STATS_NB_POOLS 4
static TEE_Result get_alloc_stats(uint32_t type, TEE_Param p[TEE_NUM_PARAMS])
{
struct malloc_stats *stats;
uint32_t size_to_retrieve;
uint32_t pool_id;
uint32_t i;
/*
* p[0].value.a = pool id (from 0 to n)
* - 0 means all the pools to be retrieved
* - 1..n means pool id
* p[0].value.b = 0 if no reset of the stats
* p[1].memref.buffer = output buffer to struct malloc_stats
*/
if (TEE_PARAM_TYPES(TEE_PARAM_TYPE_VALUE_INPUT,
TEE_PARAM_TYPE_MEMREF_OUTPUT,
TEE_PARAM_TYPE_NONE,
TEE_PARAM_TYPE_NONE) != type) {
return TEE_ERROR_BAD_PARAMETERS;
}
pool_id = p[0].value.a;
if (pool_id > STATS_NB_POOLS)
return TEE_ERROR_BAD_PARAMETERS;
size_to_retrieve = sizeof(struct malloc_stats);
if (!pool_id)
size_to_retrieve *= STATS_NB_POOLS;
if (p[1].memref.size < size_to_retrieve) {
p[1].memref.size = size_to_retrieve;
return TEE_ERROR_SHORT_BUFFER;
}
p[1].memref.size = size_to_retrieve;
stats = p[1].memref.buffer;
for (i = 1; i <= STATS_NB_POOLS; i++) {
if ((pool_id) && (i != pool_id))
continue;
switch (i) {
case 1:
malloc_get_stats(stats);
strlcpy(stats->desc, "Heap", sizeof(stats->desc));
if (p[0].value.b)
malloc_reset_stats();
break;
case 2:
EMSG("public DDR not managed by secure side anymore");
break;
case 3:
tee_mm_get_pool_stats(&tee_mm_sec_ddr, stats,
!!p[0].value.b);
strlcpy(stats->desc, "Secure DDR", sizeof(stats->desc));
break;
#ifdef CFG_VIRTUALIZATION
case 4:
nex_malloc_get_stats(stats);
strlcpy(stats->desc, "KHeap", sizeof(stats->desc));
if (p[0].value.b)
nex_malloc_reset_stats();
break;
#endif
default:
EMSG("Wrong pool id");
break;
}
stats++;
}
return TEE_SUCCESS;
}
static TEE_Result get_pager_stats(uint32_t type, TEE_Param p[TEE_NUM_PARAMS])
{
struct tee_pager_stats stats;
if (TEE_PARAM_TYPES(TEE_PARAM_TYPE_VALUE_OUTPUT,
TEE_PARAM_TYPE_VALUE_OUTPUT,
TEE_PARAM_TYPE_VALUE_OUTPUT,
TEE_PARAM_TYPE_NONE) != type) {
EMSG("expect 3 output values as argument");
return TEE_ERROR_BAD_PARAMETERS;
}
tee_pager_get_stats(&stats);
p[0].value.a = stats.npages;
p[0].value.b = stats.npages_all;
p[1].value.a = stats.ro_hits;
p[1].value.b = stats.rw_hits;
p[2].value.a = stats.hidden_hits;
p[2].value.b = stats.zi_released;
return TEE_SUCCESS;
}
static TEE_Result get_memleak_stats(uint32_t type,
TEE_Param p[TEE_NUM_PARAMS] __unused)
{
if (TEE_PARAM_TYPES(TEE_PARAM_TYPE_NONE, TEE_PARAM_TYPE_NONE,
TEE_PARAM_TYPE_NONE, TEE_PARAM_TYPE_NONE) != type)
return TEE_ERROR_BAD_PARAMETERS;
mdbg_check(1);
return TEE_SUCCESS;
}
/*
* Trusted Application Entry Points
*/
static TEE_Result invoke_command(void *psess __unused,
uint32_t cmd, uint32_t ptypes,
TEE_Param params[TEE_NUM_PARAMS])
{
switch (cmd) {
case STATS_CMD_PAGER_STATS:
return get_pager_stats(ptypes, params);
case STATS_CMD_ALLOC_STATS:
return get_alloc_stats(ptypes, params);
case STATS_CMD_MEMLEAK_STATS:
return get_memleak_stats(ptypes, params);
default:
break;
}
return TEE_ERROR_BAD_PARAMETERS;
}
pseudo_ta_register(.uuid = STATS_UUID, .name = TA_NAME,
.flags = PTA_DEFAULT_FLAGS,
.invoke_command_entry_point = invoke_command);
|
