Manish V Badarkhe | f356f7e | 2021-06-29 11:44:20 +0100 | [diff] [blame] | 1 | /* |
Boyan Karatotev | 6468d4a | 2023-02-16 15:12:45 +0000 | [diff] [blame] | 2 | * Copyright (c) 2021-2023, Arm Limited. All rights reserved. |
Manish V Badarkhe | f356f7e | 2021-06-29 11:44:20 +0100 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
| 7 | #include <stdbool.h> |
| 8 | |
| 9 | #include <arch.h> |
| 10 | #include <arch_helpers.h> |
| 11 | #include <lib/extensions/sys_reg_trace.h> |
| 12 | |
Elizabeth Ho | 4fc00d2 | 2023-07-18 14:10:25 +0100 | [diff] [blame] | 13 | void sys_reg_trace_enable_per_world(per_world_context_t *per_world_ctx) |
Manish V Badarkhe | f356f7e | 2021-06-29 11:44:20 +0100 | [diff] [blame] | 14 | { |
Boyan Karatotev | 919d3c8 | 2023-02-13 16:32:47 +0000 | [diff] [blame] | 15 | /* |
| 16 | * CPTR_EL3.TTA: Set to zero so that System register accesses to the |
| 17 | * trace registers do not trap to EL3. |
| 18 | */ |
Elizabeth Ho | 4fc00d2 | 2023-07-18 14:10:25 +0100 | [diff] [blame] | 19 | uint64_t val = per_world_ctx->ctx_cptr_el3; |
Boyan Karatotev | 919d3c8 | 2023-02-13 16:32:47 +0000 | [diff] [blame] | 20 | val &= ~(TTA_BIT); |
Elizabeth Ho | 4fc00d2 | 2023-07-18 14:10:25 +0100 | [diff] [blame] | 21 | per_world_ctx->ctx_cptr_el3 = val; |
Boyan Karatotev | 919d3c8 | 2023-02-13 16:32:47 +0000 | [diff] [blame] | 22 | } |
Manish V Badarkhe | f356f7e | 2021-06-29 11:44:20 +0100 | [diff] [blame] | 23 | |
Elizabeth Ho | 4fc00d2 | 2023-07-18 14:10:25 +0100 | [diff] [blame] | 24 | void sys_reg_trace_disable_per_world(per_world_context_t *per_world_ctx) |
Boyan Karatotev | 919d3c8 | 2023-02-13 16:32:47 +0000 | [diff] [blame] | 25 | { |
| 26 | /* |
| 27 | * CPTR_EL3.TTA: Set to one so that System register accesses to the |
| 28 | * trace registers trap to EL3, unless it is trapped by CPACR.TRCDIS, |
| 29 | * CPACR_EL1.TTA, or CPTR_EL2.TTA |
Andre Przywara | 44e33e0 | 2022-11-17 16:42:09 +0000 | [diff] [blame] | 30 | */ |
Elizabeth Ho | 4fc00d2 | 2023-07-18 14:10:25 +0100 | [diff] [blame] | 31 | uint64_t val = per_world_ctx->ctx_cptr_el3; |
Boyan Karatotev | 919d3c8 | 2023-02-13 16:32:47 +0000 | [diff] [blame] | 32 | val |= TTA_BIT; |
Elizabeth Ho | 4fc00d2 | 2023-07-18 14:10:25 +0100 | [diff] [blame] | 33 | per_world_ctx->ctx_cptr_el3 = val; |
Manish V Badarkhe | f356f7e | 2021-06-29 11:44:20 +0100 | [diff] [blame] | 34 | } |
Boyan Karatotev | 6468d4a | 2023-02-16 15:12:45 +0000 | [diff] [blame] | 35 | |
| 36 | void sys_reg_trace_init_el2_unused(void) |
| 37 | { |
| 38 | /* |
| 39 | * CPTR_EL2.TTA: Set to zero so that Non-secure System register accesses |
| 40 | * to the trace registers from both Execution states do not trap to |
| 41 | * EL2. If PE trace unit System registers are not implemented then this |
| 42 | * bit is reserved, and must be set to zero. |
| 43 | */ |
| 44 | write_cptr_el2(read_cptr_el2() & ~CPTR_EL2_TTA_BIT); |
| 45 | } |