Fix SMC handling

Make sure the proper modes are selected when running in Monitor mode
including the MMU access
Use the correct banked SCTLR register at faults