| 1 | #define _GNU_SOURCE |
| 2 | #include <sys/socket.h> |
| 3 | #include <limits.h> |
| 4 | #include <errno.h> |
| 5 | #include <time.h> |
| 6 | #include "syscall.h" |
| 7 | |
| 8 | #define IS32BIT(x) !((x)+0x80000000ULL>>32) |
| 9 | #define CLAMP(x) (int)(IS32BIT(x) ? (x) : 0x7fffffffU+((0ULL+(x))>>63)) |
| 10 | |
| 11 | hidden void __convert_scm_timestamps(struct msghdr *, socklen_t); |
| 12 | |
| 13 | int recvmmsg(int fd, struct mmsghdr *msgvec, unsigned int vlen, unsigned int flags, struct timespec *timeout) |
| 14 | { |
| 15 | #if LONG_MAX > INT_MAX |
| 16 | 	struct mmsghdr *mh = msgvec; |
| 17 | 	unsigned int i; |
| 18 | 	for (i = vlen; i; i--, mh++) |
| 19 | 		mh->msg_hdr.__pad1 = mh->msg_hdr.__pad2 = 0; |
| 20 | #endif |
| 21 | #ifdef SYS_recvmmsg_time64 |
| 22 | 	time_t s = timeout ? timeout->tv_sec : 0; |
| 23 | 	long ns = timeout ? timeout->tv_nsec : 0; |
| 24 | 	int r = __syscall_cp(SYS_recvmmsg_time64, fd, msgvec, vlen, flags, |
| 25 | 			timeout ? ((long long[]){s, ns}) : 0); |
| 26 | 	if (SYS_recvmmsg == SYS_recvmmsg_time64 || r!=-ENOSYS) |
| 27 | 		return __syscall_ret(r); |
| 28 | 	if (vlen > IOV_MAX) vlen = IOV_MAX; |
| 29 | 	socklen_t csize[vlen]; |
| 30 | 	for (int i=0; i<vlen; i++) csize[i] = msgvec[i].msg_hdr.msg_controllen; |
| 31 | 	r = __syscall_cp(SYS_recvmmsg, fd, msgvec, vlen, flags, |
| 32 | 		timeout ? ((long[]){CLAMP(s), ns}) : 0); |
| 33 | 	for (int i=0; i<r; i++) |
| 34 | 		__convert_scm_timestamps(&msgvec[i].msg_hdr, csize[i]); |
| 35 | 	return __syscall_ret(r); |
| 36 | #else |
| 37 | 	return syscall_cp(SYS_recvmmsg, fd, msgvec, vlen, flags, timeout); |
| 38 | #endif |
| 39 | } |