Quelle  secure_cntvoff.S

/* SPDX-License-Identifier: GPL-2.0 */
/*
 * Copyright (C) 2014 Renesas Electronics Corporation
 *
 * Initialization of CNTVOFF register from secure mode
 *
 */

#include <linux/linkage.h>
#include <asm/assembler.h>

ENTRY(secure_cntvoff_init)
 .arch armv7-a
 /*
 * CNTVOFF has to be initialized either from non-secure Hypervisor
 * mode or secure Monitor mode with SCR.NS==1. If TrustZone is enabled
 * then it should be handled by the secure code. The CPU must implement
 * the virtualization extensions.
 */
 cps #MON_MODE
 mrc p15, 0, r1, c1, c1, 0  /* Get Secure Config */
 orr r0, r1, #1
 mcr p15, 0, r0, c1, c1, 0  /* Set Non Secure bit */
 isb
 mov r0, #0
 mcrr p15, 4, r0, r0, c14  /* CNTVOFF = 0 */
 isb
 mcr p15, 0, r1, c1, c1, 0  /* Set Secure bit */
 isb
 cps #SVC_MODE
 ret lr
ENDPROC(secure_cntvoff_init)