48 lines
		
	
	
		
			1010 B
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			48 lines
		
	
	
		
			1010 B
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * Copyright (C) 2020 Embecosm Limited
 | 
						|
 * SPDX-License-Identifier: BSD-2-Clause
 | 
						|
 */
 | 
						|
#ifndef _INTERNAL_SYSCALL_H
 | 
						|
#define _INTERNAL_SYSCALL_H
 | 
						|
 | 
						|
extern int errno;
 | 
						|
 | 
						|
static inline long
 | 
						|
__semihost_syscall (long id, long *data_block)
 | 
						|
{
 | 
						|
  register long a0 asm ("a0") = id;
 | 
						|
  register long a1 asm ("a1") = (long) data_block;
 | 
						|
 | 
						|
  /* RISC-V semihosting trap sequence.  Must be uncompressed and must not
 | 
						|
     cross page boundary.  */
 | 
						|
  asm volatile (
 | 
						|
    ".balign 16             \n"
 | 
						|
    ".option push           \n"
 | 
						|
    ".option norvc          \n"
 | 
						|
    "slli zero, zero, 0x1f  \n"
 | 
						|
    "ebreak                 \n"
 | 
						|
    "srai zero, zero, 0x7   \n"
 | 
						|
    ".option pop            \n"
 | 
						|
      : "+r"(a0) : "r"(a1) : "memory");
 | 
						|
 | 
						|
  return a0;
 | 
						|
}
 | 
						|
 | 
						|
static inline long
 | 
						|
__syscall_error ()
 | 
						|
{
 | 
						|
  errno = __semihost_syscall (SEMIHOST_errno, 0);
 | 
						|
  return -1;
 | 
						|
}
 | 
						|
 | 
						|
static inline long
 | 
						|
syscall_errno (long id, long *data_block)
 | 
						|
{
 | 
						|
  long res = __semihost_syscall (id, data_block);
 | 
						|
  if (res < 0)
 | 
						|
    return __syscall_error ();
 | 
						|
  return res;
 | 
						|
}
 | 
						|
 | 
						|
#endif
 |