FIX: arm-trustzone: Use the proper bit shift for SECURE_CP mask.
FIX: arm-trustzone: Implement some privileged loads/stores correctly.
WIP: arm-trustzone: Cleanup IRQ/FIQ entry code
WIP: arm-trustzone: Prepare get_phys_addr for TrustZone memory checks.