123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300 |
- #ifndef NRF_SVCI_H__
- #define NRF_SVCI_H__
- #include "stdint.h"
- #include "compiler_abstraction.h"
- #include "app_util.h"
- #ifdef __cplusplus
- extern "C" {
- #endif
- #define NRF_SVCI_SVC_NUM 0
- #define NRF_SVCI_SVC_NUM_INVALID (0xFFFFFFFF)
- #ifdef __cplusplus
- #define GCC_CAST_CPP (uint16_t)
- #else
- #define GCC_CAST_CPP
- #endif
- #if (__LINT__ != 1)
- #if defined (__CC_ARM)
- #define SVCI_DECL(svci_num, return_type, function_name, ...) \
- return_type __svc_indirect(NRF_SVCI_SVC_NUM) \
- svci_ ## function_name(uint32_t _svci_num, ##__VA_ARGS__);
-
- #define SVCI_DECL_0(svci_num, return_type, function_name) \
- return_type __svc_indirect(NRF_SVCI_SVC_NUM) \
- svci_ ## function_name(uint32_t _svci_num);
-
- #define SVCI_0(svci_num, return_type, function_name) \
- SVCI_DECL_0(svci_num, return_type, function_name) \
- static __INLINE return_type function_name(void) \
- { \
- return svci_ ## function_name(svci_num); \
- }
- #define SVCI_1(svci_num, return_type, function_name, p0t, p0n) \
- SVCI_DECL(svci_num, return_type, function_name, p0t p0n) \
- static __INLINE return_type function_name(p0t p0n) \
- { \
- return svci_ ## function_name(svci_num, p0n); \
- }
- #define SVCI_2(svci_num, return_type, function_name, p0t, p0n, p1t, p1n) \
- SVCI_DECL(svci_num, return_type, function_name, p0t p0n, p1t p1n) \
- static __INLINE return_type function_name(p0t p0n, p1t p1n) \
- { \
- return svci_ ## function_name(svci_num, p0n, p1n); \
- }
- #define SVCI_3(svci_num, return_type, function_name, p0t, p0n, p1t, p1n, p2t, p2n) \
- SVCI_DECL(svci_num, return_type, function_name, p0t p0n, p1t p1n, p2t p2n) \
- static __INLINE return_type function_name(p0t p0n, p1t p1n, p2t p2n) \
- { \
- return svci_ ## function_name(svci_num, p0n, p1n, p2n); \
- }
- #define SVCI_4(svci_num, return_type, function_name, p0t, p0n, p1t, p1n, p2t, p2n, p3t, p3n) \
- SVCI_DECL(svci_num, return_type, function_name, p0t p0n, p1t p1n, p2t p2n, p3t p3n) \
- static __INLINE return_type function_name(p0t p0n, p1t p1n, p2t p2n, p3t p3n) \
- { \
- return svci_ ## function_name(svci_num, p0n, p1n, p2n, p3n); \
- }
-
- #else
-
- #if defined (__GNUC__)
- #define SVCI_DECL_0(svci_num, return_type, function_name) \
- _Pragma("GCC diagnostic push") \
- _Pragma("GCC diagnostic ignored \"-Wreturn-type\"") \
- __attribute__((naked, unused)) \
- static return_type svci_ ## function_name(void) \
- { \
-
- \
- __ASM __volatile \
- ( \
- " ldr r12, =%0 \n" \
- " svc %1 \n" \
- " bx lr \n" \
- " .ltorg" \
- : \
- : \
- "X"(svci_num), \
- "I"(GCC_CAST_CPP NRF_SVCI_SVC_NUM) \
- : \
- "r12" \
- ); \
- } \
- _Pragma("GCC diagnostic pop")
-
- #define SVCI_DECL(svci_num, return_type, function_name, ...) \
- _Pragma("GCC diagnostic push") \
- _Pragma("GCC diagnostic ignored \"-Wreturn-type\"") \
- __attribute__((naked, unused)) \
- static return_type svci_ ## function_name(__VA_ARGS__) \
- { \
-
- \
- __ASM __volatile \
- ( \
- " ldr.w r12, =%0 \n" \
- " svc %1 \n" \
- " bx lr \n" \
- " .ltorg" \
- : \
- : \
- "X"(svci_num), \
- "I"(GCC_CAST_CPP NRF_SVCI_SVC_NUM) \
- : \
- "r12" \
- ); \
- } \
- _Pragma("GCC diagnostic pop")
- #elif defined (__ICCARM__)
- #define SVCI_DECL_0(svci_num, return_type, function_name) \
- \
- _Pragma("diag_suppress=Pe940") \
- static __root return_type svci_ ## function_name(void) \
- { \
-
- \
- __ASM volatile \
- ( \
- " mov r12, %0 \n" \
- " svc %1 \n" \
- : \
- : "r" (svci_num), "I" (NRF_SVCI_SVC_NUM) \
- : \
- ); \
- }
- #define SVCI_DECL(svci_num, return_type, function_name, ...) \
- \
- _Pragma("diag_suppress=Pe940") \
- static __root return_type svci_ ## function_name(__VA_ARGS__) \
- { \
-
- \
- __ASM volatile ( "push {r0, r1, r2, r3}\n\t" ); \
-
- \
- __ASM volatile \
- ( \
- " mov r12, %0 \n" \
- " pop {r0, r1, r2, r3} \n" \
- : \
- : "r" (svci_num) \
- : \
- ); \
-
- \
- __ASM volatile \
- ( \
- " svc %0 \n" \
- " bx lr \n" \
- : \
- : "I" (NRF_SVCI_SVC_NUM) \
- : \
- ); \
- }
- #else
- #error Unsupported compiler for SVCI interface
- #endif
-
- #define SVCI_0(svci_num, return_type, function_name) \
- SVCI_DECL_0(svci_num, return_type, function_name) \
- static __INLINE return_type function_name(void) \
- { \
- return svci_ ## function_name(); \
- }
- #define SVCI_1(svci_num, return_type, function_name, p0t, p0n) \
- SVCI_DECL(svci_num, return_type, function_name, p0t p0n) \
- static __INLINE return_type function_name(p0t p0n) \
- { \
- return svci_ ## function_name(p0n); \
- }
- #define SVCI_2(svci_num, return_type, function_name, p0t, p0n, p1t, p1n) \
- SVCI_DECL(svci_num, return_type, function_name, p0t p0n, p1t p1n) \
- static __INLINE return_type function_name(p0t p0n, p1t p1n) \
- { \
- return svci_ ## function_name(p0n, p1n); \
- }
- #define SVCI_3(svci_num, return_type, function_name, p0t, p0n, p1t, p1n, p2t, p2n) \
- SVCI_DECL(svci_num, return_type, function_name, p0t p0n, p1t p1n, p2t p2n) \
- static __INLINE return_type function_name(p0t p0n, p1t p1n, p2t p2n) \
- { \
- return svci_ ## function_name(p0n, p1n, p2n); \
- }
- #define SVCI_4(svci_num, return_type, function_name, p0t, p0n, p1t, p1n, p2t, p2n, p3t, p3n) \
- SVCI_DECL(svci_num, return_type, function_name, p0t p0n, p1t p1n, p2t p2n, p3t p3n) \
- static __INLINE return_type function_name(p0t p0n, p1t p1n, p2t p2n, p3t p3n) \
- { \
- return svci_ ## function_name(p0n, p1n, p2n, p3n); \
- }
-
- #endif
- #define VA_NARGS_IMPL(_0, _1, _2, _3, _4, _5, _6, _7, _8, N, ...) N
- #define VA_NARGS(...) VA_NARGS_IMPL(__VA_ARGS__, 4, 4, 3, 3, 2, 2, 1, 1, 0)
- #ifdef SVCALL_INDIRECT_AS_NORMAL_FUNCTION
- #define SVCI(svci_num, return_type, function_name, ...) \
- return_type function_name(##__VA_ARGS__)
- #else
-
-
- #define SVCI_IMPLI(count, svci_num, return_type, function_name, ...) \
- SVCI##_##count (svci_num, return_type, function_name, ##__VA_ARGS__)
- #define SVCI_IMPL(count, svci_num, return_type, function_name, ...) \
- SVCI_IMPLI(count, svci_num, return_type, function_name, ##__VA_ARGS__)
- #define SVCI(svci_num, return_type, function_name, ...) \
- SVCI_IMPL(VA_NARGS(__VA_ARGS__), svci_num, return_type, function_name, ##__VA_ARGS__)
-
- #endif
- #else
- #define SVCI(svci_num, return_type, function_name, ...)
- #endif
- #ifdef __cplusplus
- }
- #endif
- #endif
|