xref: /rk3399_ARM-atf/lib/extensions/debug/debugv8p9.c (revision beedfb93ceda7af1d7d45c33df230d76bb68fc6f)
1 /*
2  * Copyright (c) 2025, Arm Limited. All rights reserved.
3  *
4  * SPDX-License-Identifier: BSD-3-Clause
5  */
6 
7 #include <arch.h>
8 #include <arch_features.h>
9 #include <arch_helpers.h>
10 #include <lib/extensions/debug_v8p9.h>
11 
12 void debugv8p9_extended_bp_wp_enable(cpu_context_t *ctx)
13 {
14 	el3_state_t *state = get_el3state_ctx(ctx);
15 	u_register_t mdcr_el3_val;
16 
17 	if (read_brps_id_field() > 0U) {
18 		mdcr_el3_val = read_ctx_reg(state, CTX_MDCR_EL3);
19 		/* When FEAT_Debugv8p9 is implemented:
20 		 *
21 		 * MDCR_EL3.EBWE: Set to 0b1
22 		 * Enables use of additional breakpoints or watchpoints,
23 		 * and disables trap to EL3 on accesses to debug register.
24 		 */
25 		mdcr_el3_val |= MDCR_EBWE_BIT;
26 		write_ctx_reg(state, CTX_MDCR_EL3, mdcr_el3_val);
27 	}
28 }
29