1/* 2 * Copyright (c) 2013, Google Inc. All rights reserved 3 * 4 * Permission is hereby granted, free of charge, to any person obtaining 5 * a copy of this software and associated documentation files 6 * (the "Software"), to deal in the Software without restriction, 7 * including without limitation the rights to use, copy, modify, merge, 8 * publish, distribute, sublicense, and/or sell copies of the Software, 9 * and to permit persons to whom the Software is furnished to do so, 10 * subject to the following conditions: 11 * 12 * The above copyright notice and this permission notice shall be 13 * included in all copies or substantial portions of the Software. 14 * 15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 16 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 17 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. 18 * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY 19 * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, 20 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE 21 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. 22 */ 23 24#include <asm.h> 25#include <arch/asm_macros.h> 26#include <lib/sm/monitor.h> 27#include <lib/sm/smcall.h> 28#include <lib/sm/sm_err.h> 29 30#include <kernel/vm.h> 31 32FUNCTION(sm_sched_nonsecure) 33 push x1, x30 34 mov x1, x0 35 36 ldr x0, =SMC_SC_NS_RETURN 37 mov x2, xzr 38 mov x3, xzr 39 smc #0 40 41 pop x9, x30 42 stp w0, w1, [x9], #8 43 stp w2, w3, [x9], #8 44 str x7, [x9], #8 45 ret 46 47FUNCTION(platform_early_halt) 48 /* Disable interrupts and FIQs */ 49 msr daifset, #3 50 51.Lloop: 52 ldr x0, =SMC_SC_NS_RETURN 53 ldr x1, =SM_ERR_PANIC 54 mov x2, xzr 55 mov x3, xzr 56 smc #0 57 58 b .Lloop 59