2019-08-06 05:09:51 +01:00
|
|
|
/*
|
|
|
|
|
* Copyright (c) 2018-2019 Atmosphère-NX
|
|
|
|
|
*
|
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
|
* under the terms and conditions of the GNU General Public License,
|
|
|
|
|
* version 2, as published by the Free Software Foundation.
|
|
|
|
|
*
|
|
|
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
|
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
|
|
|
* more details.
|
|
|
|
|
*
|
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
|
*/
|
|
|
|
|
|
2020-01-14 00:58:31 +00:00
|
|
|
#include "asm_macros.s"
|
2019-08-06 05:09:51 +01:00
|
|
|
|
|
|
|
|
// Precondition: x1 <= 16
|
2020-01-14 00:58:31 +00:00
|
|
|
FUNCTION loadBreakpointRegs
|
2019-08-06 05:09:51 +01:00
|
|
|
// x1 = number
|
2020-01-19 18:18:48 +00:00
|
|
|
dmb ish
|
2020-01-09 22:47:22 +00:00
|
|
|
|
2019-08-06 05:09:51 +01:00
|
|
|
adr x16, 1f
|
|
|
|
|
add x0, x0, #(16 * 8)
|
|
|
|
|
mov x4, #(16 * 12)
|
|
|
|
|
sub x4, x4, x1,lsl #3
|
|
|
|
|
sub x4, x4, x1,lsl #2
|
|
|
|
|
add x16, x16, x4
|
|
|
|
|
br x16
|
|
|
|
|
|
|
|
|
|
1:
|
|
|
|
|
.irp count, 15,14,13,12,11,10,9,8,7,6,5,4,3,2,1,0
|
|
|
|
|
ldp x2, x3, [x0, #-0x10]!
|
|
|
|
|
msr dbgbcr\count\()_el1, x2
|
|
|
|
|
msr dbgbvr\count\()_el1, x3
|
|
|
|
|
.endr
|
2020-01-19 18:18:48 +00:00
|
|
|
dsb ish
|
2019-08-06 05:09:51 +01:00
|
|
|
isb
|
|
|
|
|
ret
|
2020-01-14 00:58:31 +00:00
|
|
|
END_FUNCTION
|
2019-08-06 05:09:51 +01:00
|
|
|
|
|
|
|
|
// Precondition: x1 <= 16
|
2020-01-14 00:58:31 +00:00
|
|
|
FUNCTION loadWatchpointRegs
|
2019-08-06 05:09:51 +01:00
|
|
|
// x1 = number
|
2020-01-19 18:18:48 +00:00
|
|
|
dmb ish
|
2020-01-09 22:47:22 +00:00
|
|
|
|
2019-08-06 05:09:51 +01:00
|
|
|
adr x16, 1f
|
|
|
|
|
add x0, x0, #(16 * 8)
|
|
|
|
|
mov x4, #(16 * 12)
|
|
|
|
|
sub x4, x4, x1,lsl #3
|
|
|
|
|
sub x4, x4, x1,lsl #2
|
|
|
|
|
add x16, x16, x4
|
|
|
|
|
br x16
|
|
|
|
|
|
|
|
|
|
1:
|
|
|
|
|
.irp count, 15,14,13,12,11,10,9,8,7,6,5,4,3,2,1,0
|
|
|
|
|
ldp x2, x3, [x0, #-0x10]!
|
|
|
|
|
msr dbgwcr\count\()_el1, x2
|
|
|
|
|
msr dbgwvr\count\()_el1, x3
|
|
|
|
|
.endr
|
2020-01-19 18:18:48 +00:00
|
|
|
dsb ish
|
2019-08-06 05:09:51 +01:00
|
|
|
isb
|
|
|
|
|
ret
|
2020-01-14 00:58:31 +00:00
|
|
|
END_FUNCTION
|
