static void init_vfp_sec(void)
{
uint32_t cpacr = read_cpacr();
/*
* Enable Advanced SIMD functionality.
* Enable use of D16-D31 of the Floating-point Extension register
* file.
*/
cpacr &= ~(CPACR_ASEDIS | CPACR_D32DIS);
/*
* Enable usage of CP10 and CP11 (SIMD/VFP) (both kernel and user
* mode.
*/
cpacr |= CPACR_CP(10, CPACR_CP_ACCESS_FULL);
cpacr |= CPACR_CP(11, CPACR_CP_ACCESS_FULL);
write_cpacr(cpacr);
}
/*******************************************************************************
* Place holder function to perform any S-EL1 specific architectural setup. At
* the moment there is nothing to do.
******************************************************************************/
void bl2_arch_setup(void)
{
/* Give access to FP/SIMD registers */
write_cpacr(CPACR_EL1_FPEN(CPACR_EL1_FP_TRAP_NONE));
}
