lib/libc/sys-minix/recvmsg.c

   1 #include <sys/cdefs.h>
   2 #include "namespace.h"
   3
   4 #undef NDEBUG
   5
   6 #include <errno.h>
   7 #include <sys/ioctl.h>
   8 #include <sys/ioc_net.h>
   9 #include <sys/socket.h>
  10 #include <sys/types.h>
  11 #include <sys/un.h>
  12
  13 #define DEBUG 0
  14
  15 static ssize_t _uds_recvmsg_conn(int sock, struct msghdr *msg, int flags);
  16 static ssize_t _uds_recvmsg_dgram(int sock, struct msghdr *msg, int flags);
  17
  18 ssize_t recvmsg(int sock, struct msghdr *msg, int flags)
  19 {
  20         int r;
  21         int uds_sotype;
  22
  23         if (msg == NULL) {
  24                 errno= EFAULT;
  25                 return -1;
  26         }
  27
  28         r= ioctl(sock, NWIOGUDSSOTYPE, &uds_sotype);
  29         if (r != -1 || (errno != ENOTTY && errno != EBADIOCTL)) {
  30                 if (r == -1) {
  31                         return r;
  32                 }
  33
  34                 if (uds_sotype == SOCK_DGRAM) {
  35                         return _uds_recvmsg_dgram(sock, msg, flags);
  36                 } else {
  37                         return _uds_recvmsg_conn(sock, msg, flags);
  38                 }
  39         }
  40
  41 #if DEBUG
  42         fprintf(stderr, "recvmsg: not implemented for fd %d\n", sock);
  43 #endif
  44
  45         errno= ENOSYS;
  46         return -1;
  47 }
  48
  49 static ssize_t _uds_recvmsg_conn(int sock, struct msghdr *msg, int flags)
  50 {
  51         int r, rc;
  52
  53         if (flags != 0) {
  54 #if DEBUG
  55                 fprintf(stderr, "recvmsg(uds): flags not implemented\n");
  56 #endif
  57                 errno= ENOSYS;
  58                 return -1;
  59         }
  60
  61         r= readv(sock, msg->msg_iov, msg->msg_iovlen);
  62
  63         if (r >= 0 && msg->msg_name && msg->msg_namelen > 0) {
  64                 getpeername(sock, msg->msg_name, &msg->msg_namelen);
  65         }
  66
  67         /* get control data */
  68         if (r >= 0 && msg->msg_control && msg->msg_controllen > 0) {
  69                 struct msg_control msg_ctrl;
  70
  71                 memset(&msg_ctrl, '\0', sizeof(struct msg_control));
  72                 msg_ctrl.msg_controllen = msg->msg_controllen;
  73                 rc = ioctl(sock, NWIOGUDSCTRL, &msg_ctrl);
  74                 if (rc == -1) {
  75                         return rc;
  76                 }
  77
  78                 if (msg_ctrl.msg_controllen <= msg->msg_controllen) {
  79                         memcpy(msg->msg_control, msg_ctrl.msg_control,
  80                                                 msg_ctrl.msg_controllen);
  81                         msg->msg_controllen = msg_ctrl.msg_controllen;
  82                 }
  83         }
  84
  85         msg->msg_flags = 0;
  86
  87         return r;
  88 }
  89
  90 static ssize_t _uds_recvmsg_dgram(int sock, struct msghdr *msg, int flags)
  91 {
  92         int r, rc;
  93
  94         if (flags != 0) {
  95 #if DEBUG
  96                 fprintf(stderr, "recvmsg(uds): flags not implemented\n");
  97 #endif
  98                 errno= ENOSYS;
  99                 return -1;
 100         }
 101
 102         r= readv(sock, msg->msg_iov, msg->msg_iovlen);
 103
 104         if (r >= 0 && msg->msg_name &&
 105                                 msg->msg_namelen >= sizeof(struct sockaddr_un))
 106         {
 107                 rc= ioctl(sock, NWIOGUDSFADDR, msg->msg_name);
 108                 if (rc == -1) {
 109                         return rc;
 110                 }
 111                 msg->msg_namelen= sizeof(struct sockaddr_un);
 112         }
 113
 114         /* get control data */
 115         if (r >= 0 && msg->msg_control && msg->msg_controllen > 0) {
 116                 struct msg_control msg_ctrl;
 117
 118                 memset(&msg_ctrl, '\0', sizeof(struct msg_control));
 119                 msg_ctrl.msg_controllen = msg->msg_controllen;
 120                 rc = ioctl(sock, NWIOGUDSCTRL, &msg_ctrl);
 121                 if (rc == -1) {
 122                         return rc;
 123                 }
 124
 125                 if (msg_ctrl.msg_controllen <= msg->msg_controllen) {
 126                         memcpy(msg->msg_control, msg_ctrl.msg_control,
 127                                                 msg_ctrl.msg_controllen);
 128                         msg->msg_controllen = msg_ctrl.msg_controllen;
 129                 }
 130         }
 131
 132         msg->msg_flags = 0;
 133
 134         return r;
 135 }