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
|
// SPDX-License-Identifier: BSD-2-Clause
/*
* Copyright (c) 2015, Linaro Limited
* All rights reserved.
*/
#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_NB_POOLS 3
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;
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;
}
/*
* 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);
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);
|
