semtimedop.c 999 B

123456789101112131415161718192021222324252627282930313233343536
  1. #define _GNU_SOURCE
  2. #include <sys/sem.h>
  3. #include <errno.h>
  4. #include "syscall.h"
  5. #include "ipc.h"
  6. #define IS32BIT(x) !((x)+0x80000000ULL>>32)
  7. #define CLAMP(x) (int)(IS32BIT(x) ? (x) : 0x7fffffffU+((0ULL+(x))>>63))
  8. #if !defined(SYS_semtimedop) && !defined(SYS_ipc) || \
  9. SYS_semtimedop == SYS_semtimedop_time64
  10. #define NO_TIME32 1
  11. #else
  12. #define NO_TIME32 0
  13. #endif
  14. int semtimedop(int id, struct sembuf *buf, size_t n, const struct timespec *ts)
  15. {
  16. #ifdef SYS_semtimedop_time64
  17. time_t s = ts ? ts->tv_sec : 0;
  18. long ns = ts ? ts->tv_nsec : 0;
  19. int r = -ENOSYS;
  20. if (NO_TIME32 || !IS32BIT(s))
  21. r = __syscall(SYS_semtimedop_time64, id, buf, n,
  22. ts ? ((long long[]){s, ns}) : 0);
  23. if (NO_TIME32 || r!=-ENOSYS) return __syscall_ret(r);
  24. ts = ts ? (void *)(long[]){CLAMP(s), ns} : 0;
  25. #endif
  26. #if defined(SYS_ipc)
  27. return syscall(SYS_ipc, IPCOP_semtimedop, id, n, 0, buf, ts);
  28. #elif defined(SYS_semtimedop)
  29. return syscall(SYS_semtimedop, id, buf, n, ts);
  30. #else
  31. return __syscall_ret(-ENOSYS);
  32. #endif
  33. }