| #include <sys/socket.h> | |
| #include <limits.h> | |
| #include <time.h> | |
| #include <sys/time.h> | |
| #include <string.h> | |
| #include "syscall.h" | |
| hidden void __convert_scm_timestamps(struct msghdr *, socklen_t); | |
| void __convert_scm_timestamps(struct msghdr *msg, socklen_t csize) | |
| { | |
| if (SCM_TIMESTAMP == SCM_TIMESTAMP_OLD) return; | |
| if (!msg->msg_control || !msg->msg_controllen) return; | |
| struct cmsghdr *cmsg, *last=0; | |
| long tmp; | |
| long long tvts[2]; | |
| int type = 0; | |
| for (cmsg=CMSG_FIRSTHDR(msg); cmsg; cmsg=CMSG_NXTHDR(msg, cmsg)) { | |
| if (cmsg->cmsg_level==SOL_SOCKET) switch (cmsg->cmsg_type) { | |
| case SCM_TIMESTAMP_OLD: | |
| if (type) break; | |
| type = SCM_TIMESTAMP; | |
| goto common; | |
| case SCM_TIMESTAMPNS_OLD: | |
| type = SCM_TIMESTAMPNS; | |
| common: | |
| memcpy(&tmp, CMSG_DATA(cmsg), sizeof tmp); | |
| tvts[0] = tmp; | |
| memcpy(&tmp, CMSG_DATA(cmsg) + sizeof tmp, sizeof tmp); | |
| tvts[1] = tmp; | |
| break; | |
| } | |
| last = cmsg; | |
| } | |
| if (!last || !type) return; | |
| if (CMSG_SPACE(sizeof tvts) > csize-msg->msg_controllen) { | |
| msg->msg_flags |= MSG_CTRUNC; | |
| return; | |
| } | |
| msg->msg_controllen += CMSG_SPACE(sizeof tvts); | |
| cmsg = CMSG_NXTHDR(msg, last); | |
| cmsg->cmsg_level = SOL_SOCKET; | |
| cmsg->cmsg_type = type; | |
| cmsg->cmsg_len = CMSG_LEN(sizeof tvts); | |
| memcpy(CMSG_DATA(cmsg), &tvts, sizeof tvts); | |
| } | |
| ssize_t recvmsg(int fd, struct msghdr *msg, int flags) | |
| { | |
| ssize_t r; | |
| socklen_t orig_controllen = msg->msg_controllen; | |
| #if LONG_MAX > INT_MAX | |
| struct msghdr h, *orig = msg; | |
| if (msg) { | |
| h = *msg; | |
| h.__pad1 = h.__pad2 = 0; | |
| msg = &h; | |
| } | |
| #endif | |
| r = socketcall_cp(recvmsg, fd, msg, flags, 0, 0, 0); | |
| if (r >= 0) __convert_scm_timestamps(msg, orig_controllen); | |
| #if LONG_MAX > INT_MAX | |
| if (orig) *orig = h; | |
| #endif | |
| return r; | |
| } |