/*
 * Copyright (C) 2015 Philippe Gerum <rpm@xenomai.org>.
 * Copyright (C) Siemens AG, 2021
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library 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
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA.
 */
#ifndef _LIB_COBALT_ARM64_SYSCALL_H
#define _LIB_COBALT_ARM64_SYSCALL_H

#include <xeno_config.h>
#include <errno.h>
#include <cobalt/uapi/syscall.h>

#define __xn_syscall_args0
#define __xn_syscall_args1 , unsigned long __a1
#define __xn_syscall_args2 __xn_syscall_args1, unsigned long __a2
#define __xn_syscall_args3 __xn_syscall_args2, unsigned long __a3
#define __xn_syscall_args4 __xn_syscall_args3, unsigned long __a4
#define __xn_syscall_args5 __xn_syscall_args4, unsigned long __a5

#define __emit_syscall0(__args...)					\
	register unsigned int __scno __asm__("w8") = __xn_syscode(__op); \
	register unsigned long __res __asm__("x0");			\
	__asm__ __volatile__ (						\
		"svc 0;\n\t"						\
		: "=r" (__res)						\
		: "r" (__scno), ##__args				\
		: "cc", "memory");					\
	return __res
#define __emit_syscall1(__args...)					\
	register unsigned long __x0 __asm__("x0") = __a1;		\
	__emit_syscall0("r" (__x0),  ##__args)
#define __emit_syscall2(__args...)					\
	register unsigned long __x1 __asm__("x1") = __a2;		\
	__emit_syscall1("r" (__x1), ##__args)
#define __emit_syscall3(__args...)					\
	register unsigned long __x2 __asm__("x2") = __a3;		\
	__emit_syscall2("r" (__x2), ##__args)
#define __emit_syscall4(__args...)					\
	register unsigned long __x3 __asm__("x3") = __a4;		\
	__emit_syscall3("r" (__x3), ##__args)
#define __emit_syscall5(__args...)	\
	register unsigned long __x4 __asm__("x4") = __a5;		\
	__emit_syscall4("r" (__x4), ##__args)

#define DEFINE_XENOMAI_SYSCALL(__argnr)					\
static inline long __attribute__((always_inline))			\
__xenomai_do_syscall##__argnr(unsigned int __op				\
			      __xn_syscall_args##__argnr)		\
{									\
	__emit_syscall##__argnr();					\
}

DEFINE_XENOMAI_SYSCALL(0)
DEFINE_XENOMAI_SYSCALL(1)
DEFINE_XENOMAI_SYSCALL(2)
DEFINE_XENOMAI_SYSCALL(3)
DEFINE_XENOMAI_SYSCALL(4)
DEFINE_XENOMAI_SYSCALL(5)

#define XENOMAI_SYSCALL0(__op)					\
	__xenomai_do_syscall0(__op)
#define XENOMAI_SYSCALL1(__op, __a1)				\
	__xenomai_do_syscall1(__op,				\
			      (unsigned long)__a1)
#define XENOMAI_SYSCALL2(__op, __a1, __a2)			\
	__xenomai_do_syscall2(__op,				\
			      (unsigned long)__a1,		\
			      (unsigned long)__a2)
#define XENOMAI_SYSCALL3(__op, __a1, __a2, __a3)		\
	__xenomai_do_syscall3(__op,				\
			      (unsigned long)__a1,		\
			      (unsigned long)__a2,		\
			      (unsigned long)__a3)
#define XENOMAI_SYSCALL4(__op, __a1, __a2, __a3, __a4)		\
	__xenomai_do_syscall4(__op,				\
			      (unsigned long)__a1,		\
			      (unsigned long)__a2,		\
			      (unsigned long)__a3,		\
			      (unsigned long)__a4)
#define XENOMAI_SYSCALL5(__op, __a1, __a2, __a3, __a4, __a5)	\
	__xenomai_do_syscall5(__op,				\
			      (unsigned long)__a1,		\
			      (unsigned long)__a2,		\
			      (unsigned long)__a3,		\
			      (unsigned long)__a4,		\
			      (unsigned long)__a5)
#define XENOMAI_SYSBIND(__breq)					\
	__xenomai_do_syscall1(sc_cobalt_bind,			\
			      (unsigned long)__breq)

#endif /* !_LIB_COBALT_ARM64_SYSCALL_H */