/*
 * Copyright (c) 2014, NVIDIA Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 */

#include <linux/linkage.h>
#include <linux/init.h>

#ifdef CONFIG_ARM64

ENTRY(tlk_irq_handler)
	mov	x0, #0x5
	movk	x0, #0x3200, lsl #16	// TE_SMC_NS_IRQ_DONE
	smc	#0
	ret
ENDPROC(tlk_irq_handler)

/* uint32_t tlk_generic_smc(uint32_t arg0, uint32_t arg1, uint32_t arg2) */
ENTRY(_tlk_generic_smc)
	smc	#0
	ret
ENDPROC(_tlk_generic_smc)

	/* allows MAX_EXT_SMC_ARGS (r0-r11) to be passed in registers */

/* uint32_t tlk_extended_smc(uint32_t *regs) */
ENTRY(_tlk_extended_smc)
	/*
	 * Allows MAX_EXT_SMC_ARGS (r0-r11) to be passed in registers
	 * (for aarch64, these are scratch, so no need to save them)
	 */
	mov	x12, x0
	ldp	x0, x1, [x12], #16
	ldp	x2, x3, [x12], #16
	ldp	x4, x5, [x12], #16
	ldp	x6, x7, [x12], #16
	ldp	x8, x9, [x12], #16
	ldp	x10, x11, [x12], #16
	smc	#0
	ret
ENDPROC(_tlk_extended_smc)

#else

ENTRY(tlk_irq_handler)
	movw	r0, #0x5
	movt	r0, #0x3200	@ TE_SMC_NS_IRQ_DONE
	mov	r1, #0
	mov	r2, #0
	smc	#0
ENDPROC(tlk_irq_handler)

ENTRY(_tlk_generic_smc)
	smc	#0
	mov	pc, lr
ENDPROC(_tlk_generic_smc)

ENTRY(_tlk_extended_smc)
	stmfd	sp!, {r4-r12}	@ save reg state
	mov	r12, r0		@ reg ptr to r12
	ldmia	r12, {r0-r11}	@ load arg regs
	smc	#0
	ldmfd	sp!, {r4-r12}	@ restore saved regs
ENDPROC(_tlk_extended_smc)

#endif