/**************************************************************************** * net/netlink/netlink_sockif.c * * Licensed to the Apache Software Foundation (ASF) under one or more * contributor license agreements. See the NOTICE file distributed with * this work for additional information regarding copyright ownership. The * ASF licenses this file to you under the Apache License, Version 2.0 (the * "License"); you may not use this file except in compliance with the * License. You may obtain a copy of the License at * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the * License for the specific language governing permissions and limitations * under the License. * ****************************************************************************/ /**************************************************************************** * Included Files ****************************************************************************/ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "netlink/netlink.h" #ifdef CONFIG_NET_NETLINK /**************************************************************************** * Private Function Prototypes ****************************************************************************/ static int netlink_setup(FAR struct socket *psock, int protocol); static sockcaps_t netlink_sockcaps(FAR struct socket *psock); static void netlink_addref(FAR struct socket *psock); static int netlink_bind(FAR struct socket *psock, FAR const struct sockaddr *addr, socklen_t addrlen); static int netlink_getsockname(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen); static int netlink_getpeername(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen); static int netlink_listen(FAR struct socket *psock, int backlog); static int netlink_connect(FAR struct socket *psock, FAR const struct sockaddr *addr, socklen_t addrlen); static int netlink_accept(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen, FAR struct socket *newsock); static int netlink_poll(FAR struct socket *psock, FAR struct pollfd *fds, bool setup); static ssize_t netlink_sendmsg(FAR struct socket *psock, FAR struct msghdr *msg, int flags); static ssize_t netlink_recvmsg(FAR struct socket *psock, FAR struct msghdr *msg, int flags); static int netlink_close(FAR struct socket *psock); /**************************************************************************** * Public Data ****************************************************************************/ const struct sock_intf_s g_netlink_sockif = { netlink_setup, /* si_setup */ netlink_sockcaps, /* si_sockcaps */ netlink_addref, /* si_addref */ netlink_bind, /* si_bind */ netlink_getsockname, /* si_getsockname */ netlink_getpeername, /* si_getpeername */ netlink_listen, /* si_listen */ netlink_connect, /* si_connect */ netlink_accept, /* si_accept */ netlink_poll, /* si_poll */ netlink_sendmsg, /* si_sendmsg */ netlink_recvmsg, /* si_recvmsg */ netlink_close /* si_close */ }; /**************************************************************************** * Private Functions ****************************************************************************/ /**************************************************************************** * Name: netlink_setup * * Description: * Called for socket() to verify that the provided socket type and * protocol are usable by this address family. Perform any family- * specific socket fields. * * Input Parameters: * psock - A pointer to a user allocated socket structure to be * initialized. * protocol - NetLink socket protocol (see sys/socket.h) * * Returned Value: * Zero (OK) is returned on success. Otherwise, a negated errno value is * returned. * ****************************************************************************/ static int netlink_setup(FAR struct socket *psock, int protocol) { int domain = psock->s_domain; int type = psock->s_type; /* Verify that the protocol is supported */ DEBUGASSERT((unsigned int)protocol <= UINT8_MAX); switch (protocol) { #ifdef CONFIG_NETLINK_ROUTE case NETLINK_ROUTE: break; #endif default: return -EPROTONOSUPPORT; } /* Verify the socket type (domain should always be PF_NETLINK here) */ if (domain == PF_NETLINK && (type == SOCK_RAW || type == SOCK_DGRAM)) { /* Allocate the NetLink socket connection structure and save it in the * new socket instance. */ FAR struct netlink_conn_s *conn = netlink_alloc(); if (conn == NULL) { /* Failed to reserve a connection structure */ return -ENOMEM; } /* Initialize the connection instance */ conn->protocol = (uint8_t)protocol; /* Set the reference count on the connection structure. This * reference count will be incremented only if the socket is * dup'ed */ conn->crefs = 1; /* Attach the connection instance to the socket */ psock->s_conn = conn; return OK; } return -EPROTONOSUPPORT; } /**************************************************************************** * Name: netlink_sockcaps * * Description: * Return the bit encoded capabilities of this socket. * * Input Parameters: * psock - Socket structure of the socket whose capabilities are being * queried. * * Returned Value: * The non-negative set of socket capabilities is returned. * ****************************************************************************/ static sockcaps_t netlink_sockcaps(FAR struct socket *psock) { /* Permit vfcntl to set socket to non-blocking */ return SOCKCAP_NONBLOCKING; } /**************************************************************************** * Name: netlink_addref * * Description: * Increment the reference count on the underlying connection structure. * * Input Parameters: * psock - Socket structure of the socket whose reference count will be * incremented. * * Returned Value: * None * ****************************************************************************/ static void netlink_addref(FAR struct socket *psock) { FAR struct netlink_conn_s *conn; DEBUGASSERT(psock != NULL && psock->s_conn != NULL); conn = psock->s_conn; DEBUGASSERT(conn->crefs > 0 && conn->crefs < 255); conn->crefs++; } /**************************************************************************** * Name: netlink_bind * * Description: * netlink_bind() gives the socket 'conn' the local address 'addr'. 'addr' * is 'addrlen' bytes long. Traditionally, this is called "assigning a name * to a socket." When a socket is created with socket, it exists in a name * space (address family) but has no name assigned. * * Input Parameters: * conn NetLink socket connection structure * addr Socket local address * addrlen Length of 'addr' * * Returned Value: * 0 on success; -1 on error with errno set appropriately * * EACCES * The address is protected, and the user is not the superuser. * EADDRINUSE * The given address is already in use. * EINVAL * The socket is already bound to an address. * ENOTSOCK * psock is a descriptor for a file, not a socket. * * Assumptions: * ****************************************************************************/ static int netlink_bind(FAR struct socket *psock, FAR const struct sockaddr *addr, socklen_t addrlen) { FAR struct sockaddr_nl *nladdr; FAR struct netlink_conn_s *conn; DEBUGASSERT(psock != NULL && psock->s_conn != NULL && addr != NULL && addrlen >= sizeof(struct sockaddr_nl)); /* Save the address information in the connection structure */ nladdr = (FAR struct sockaddr_nl *)addr; conn = (FAR struct netlink_conn_s *)psock->s_conn; conn->pid = nladdr->nl_pid ? nladdr->nl_pid : getpid(); conn->groups = nladdr->nl_groups; return OK; } /**************************************************************************** * Name: netlink_getsockname * * Description: * The getsockname() function retrieves the locally-bound name of the * specified socket, stores this address in the sockaddr structure pointed * to by the 'addr' argument, and stores the length of this address in the * object pointed to by the 'addrlen' argument. * * If the actual length of the address is greater than the length of the * supplied sockaddr structure, the stored address will be truncated. * * If the socket has not been bound to a local name, the value stored in * the object pointed to by address is unspecified. * * Input Parameters: * conn NetLink socket connection structure * addr sockaddr structure to receive data [out] * addrlen Length of sockaddr structure [in/out] * ****************************************************************************/ static int netlink_getsockname(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen) { FAR struct sockaddr_nl *nladdr; FAR struct netlink_conn_s *conn; DEBUGASSERT(psock != NULL && psock->s_conn != NULL && addr != NULL && addrlen != NULL && *addrlen >= sizeof(struct sockaddr_nl)); conn = (FAR struct netlink_conn_s *)psock->s_conn; /* Return the address information in the address structure */ nladdr = (FAR struct sockaddr_nl *)addr; memset(nladdr, 0, sizeof(struct sockaddr_nl)); nladdr->nl_family = AF_NETLINK; nladdr->nl_pid = conn->pid; nladdr->nl_groups = conn->groups; *addrlen = sizeof(struct sockaddr_nl); return OK; } /**************************************************************************** * Name: netlink_getpeername * * Description: * The netlink_getpeername() function retrieves the remote-connected name * of the specified packet socket, stores this address in the sockaddr * structure pointed to by the 'addr' argument, and stores the length of * this address in the object pointed to by the 'addrlen' argument. * * If the actual length of the address is greater than the length of the * supplied sockaddr structure, the stored address will be truncated. * * If the socket has not been bound to a local name, the value stored in * the object pointed to by address is unspecified. * * Parameters: * psock Socket structure of the socket to be queried * addr sockaddr structure to receive data [out] * addrlen Length of sockaddr structure [in/out] * * Returned Value: * On success, 0 is returned, the 'addr' argument points to the address * of the socket, and the 'addrlen' argument points to the length of the * address. Otherwise, a negated errno value is returned. See * getpeername() for the list of appropriate error numbers. * ****************************************************************************/ static int netlink_getpeername(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen) { FAR struct sockaddr_nl *nladdr; FAR struct netlink_conn_s *conn; DEBUGASSERT(psock != NULL && psock->s_conn != NULL && addr != NULL && addrlen != NULL && *addrlen >= sizeof(struct sockaddr_nl)); conn = (FAR struct netlink_conn_s *)psock->s_conn; /* Return the address information in the address structure */ nladdr = (FAR struct sockaddr_nl *)addr; memset(nladdr, 0, sizeof(struct sockaddr_nl)); nladdr->nl_family = AF_NETLINK; nladdr->nl_pid = conn->dst_pid; nladdr->nl_groups = conn->dst_groups; *addrlen = sizeof(struct sockaddr_nl); return OK; } /**************************************************************************** * Name: netlink_listen * * Description: * To accept connections, a socket is first created with psock_socket(), a * willingness to accept incoming connections and a queue limit for * incoming connections are specified with psock_listen(), and then the * connections are accepted with psock_accept(). For the case of AFINET * and AFINET6 sockets, psock_listen() calls this function. The * psock_listen() call applies only to sockets of type SOCK_STREAM or * SOCK_SEQPACKET. * * Input Parameters: * psock Reference to an internal, bound socket structure. * backlog The maximum length the queue of pending connections may grow. * If a connection request arrives with the queue full, the client * may receive an error with an indication of ECONNREFUSED or, * if the underlying protocol supports retransmission, the request * may be ignored so that retries succeed. * * Returned Value: * On success, zero is returned. On error, a negated errno value is * returned. See listen() for the set of appropriate error values. * ****************************************************************************/ static int netlink_listen(FAR struct socket *psock, int backlog) { return -EOPNOTSUPP; } /**************************************************************************** * Name: netlink_connect * * Description: * Perform a netlink connection * * Input Parameters: * psock A reference to the structure of the socket to be connected * addr The address of the remote server to connect to * addrlen Length of address buffer * * Returned Value: * None * * Assumptions: * ****************************************************************************/ static int netlink_connect(FAR struct socket *psock, FAR const struct sockaddr *addr, socklen_t addrlen) { FAR struct sockaddr_nl *nladdr; FAR struct netlink_conn_s *conn; DEBUGASSERT(psock != NULL && psock->s_conn != NULL && addr != NULL && addrlen >= sizeof(struct sockaddr_nl)); /* Save the address information in the connection structure */ nladdr = (FAR struct sockaddr_nl *)addr; conn = (FAR struct netlink_conn_s *)psock->s_conn; conn->dst_pid = nladdr->nl_pid; conn->dst_groups = nladdr->nl_groups; return OK; } /**************************************************************************** * Name: netlink_accept * * Description: * The netlink_accept function is used with connection-based socket * types (SOCK_STREAM, SOCK_SEQPACKET and SOCK_RDM). It extracts the first * connection request on the queue of pending connections, creates a new * connected socket with mostly the same properties as 'sockfd', and * allocates a new socket descriptor for the socket, which is returned. The * newly created socket is no longer in the listening state. The original * socket 'sockfd' is unaffected by this call. Per file descriptor flags * are not inherited across an inet_accept. * * The 'sockfd' argument is a socket descriptor that has been created with * socket(), bound to a local address with bind(), and is listening for * connections after a call to listen(). * * On return, the 'addr' structure is filled in with the address of the * connecting entity. The 'addrlen' argument initially contains the size * of the structure pointed to by 'addr'; on return it will contain the * actual length of the address returned. * * If no pending connections are present on the queue, and the socket is * not marked as non-blocking, accept blocks the caller until a * connection is present. If the socket is marked non-blocking and no * pending connections are present on the queue, inet_accept returns * EAGAIN. * * Input Parameters: * psock Reference to the listening socket structure * addr Receives the address of the connecting client * addrlen Input: Allocated size of 'addr' * Return: Actual size returned size of 'addr' * newsock Location to return the accepted socket information. * * Returned Value: * Returns 0 (OK) on success. On failure, it returns a negated errno * value. See accept() for a description of the appropriate error value. * * Assumptions: * The network is locked. * ****************************************************************************/ static int netlink_accept(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen, FAR struct socket *newsock) { return -EOPNOTSUPP; } /**************************************************************************** * Name: netlink_response_available * * Description: * Handle a Netlink response available notification. * * Input Parameters: * Standard work handler parameters * * Returned Value: * None * ****************************************************************************/ static void netlink_response_available(FAR void *arg) { FAR struct netlink_conn_s *conn = arg; DEBUGASSERT(conn != NULL); /* The following should always be true ... but maybe not in some race * condition? */ sched_lock(); net_lock(); if (conn->pollsem != NULL && conn->pollevent != NULL) { /* Wake up the poll() with POLLIN */ *conn->pollevent |= POLLIN; nxsem_post(conn->pollsem); } else { nwarn("WARNING: Missing references in connection.\n"); } /* Allow another poll() */ conn->pollsem = NULL; conn->pollevent = NULL; net_unlock(); sched_unlock(); } /**************************************************************************** * Name: netlink_poll * * Description: * The standard poll() operation redirects operations on socket descriptors * to this function. * * POLLUP: Will never be reported * POLLERR: Reported in the event of any failure. * POLLOUT: Always reported if requested. * POLLIN: Reported if requested but only when pending response data is * available * * Input Parameters: * psock - An instance of the internal socket structure. * fds - The structure describing the events to be monitored. * setup - true: Setup up the poll; false: Tear down the poll * * Returned Value: * 0: Success; Negated errno on failure * ****************************************************************************/ static int netlink_poll(FAR struct socket *psock, FAR struct pollfd *fds, bool setup) { FAR struct netlink_conn_s *conn; int ret = OK; DEBUGASSERT(psock != NULL && psock->s_conn != NULL); conn = (FAR struct netlink_conn_s *)psock->s_conn; /* Check if we are setting up or tearing down the poll */ if (setup) { /* If POLLOUT is selected, return immediately (maybe) */ pollevent_t revents = POLLOUT; /* If POLLIN is selected and a response is available, return * immediately (maybe). */ net_lock(); if (netlink_check_response(conn)) { revents |= POLLIN; } /* But return ONLY if POLLIN and/or POLLIN are included in the * requested event set. */ revents &= fds->events; if (revents != 0) { fds->revents = revents; nxsem_post(fds->sem); net_unlock(); return OK; } /* Set up to be notified when a response is available if POLLIN is * requested. */ if ((fds->events & POLLIN) != 0) { /* Some limitations: There can be only a single outstanding POLLIN * on the Netlink connection. */ if (conn->pollsem != NULL || conn->pollevent != NULL) { nerr("ERROR: Multiple polls() on socket not supported.\n"); net_unlock(); return -EBUSY; } /* Set up the notification */ conn->pollsem = fds->sem; conn->pollevent = &fds->revents; ret = netlink_notifier_setup(netlink_response_available, conn, conn); if (ret < 0) { nerr("ERROR: netlink_notifier_setup() failed: %d\n", ret); conn->pollsem = NULL; conn->pollevent = NULL; } } net_unlock(); } else { /* Cancel any response notifications */ ret = netlink_notifier_teardown(conn); conn->pollsem = NULL; conn->pollevent = NULL; } return ret; } /**************************************************************************** * Name: netlink_sendmsg * * Description: * If sendmsg() is used on a connection-mode (SOCK_STREAM, SOCK_SEQPACKET) * socket, the parameters 'msg_name' and 'msg_namelen' are ignored (and the * error EISCONN may be returned when they are not NULL and 0), and the * error ENOTCONN is returned when the socket was not actually connected. * * Input Parameters: * psock A reference to the structure of the socket to be connected * msg msg to send * flags Send flags (ignored) * * Returned Value: * On success, returns the number of characters sent. On error, a negated * errno value is returned (see sendmsg() for the list of appropriate error * values. * * Assumptions: * ****************************************************************************/ static ssize_t netlink_sendmsg(FAR struct socket *psock, FAR struct msghdr *msg, int flags) { FAR const void *buf = msg->msg_iov->iov_base; size_t len = msg->msg_iov->iov_len; FAR const struct sockaddr *to = msg->msg_name; socklen_t tolen = msg->msg_namelen; FAR struct netlink_conn_s *conn; FAR struct nlmsghdr *nlmsg; struct sockaddr_nl nladdr; int ret; DEBUGASSERT(psock != NULL && psock->s_conn != NULL && buf != NULL); /* Validity check, only single iov supported */ if (msg->msg_iovlen != 1) { return -ENOTSUP; } /* Get the underlying connection structure */ conn = (FAR struct netlink_conn_s *)psock->s_conn; if (to == NULL) { /* netlink_send() */ /* Format the address */ nladdr.nl_family = AF_NETLINK; nladdr.nl_pad = 0; nladdr.nl_pid = conn->dst_pid; nladdr.nl_groups = conn->dst_groups; to = (FAR const struct sockaddr *)&nladdr; tolen = sizeof(struct sockaddr_nl); } DEBUGASSERT(tolen >= sizeof(struct sockaddr_nl)); /* Get a reference to the netlink message */ nlmsg = (FAR struct nlmsghdr *)buf; DEBUGASSERT(nlmsg->nlmsg_len >= sizeof(struct nlmsghdr)); switch (conn->protocol) { #ifdef CONFIG_NETLINK_ROUTE case NETLINK_ROUTE: ret = netlink_route_sendto(conn, nlmsg, len, flags, (FAR const struct sockaddr_nl *)to, tolen); break; #endif default: ret = -EOPNOTSUPP; break; } return ret; } /**************************************************************************** * Name: netlink_recvmsg * * Description: * recvmsg() receives messages from a socket, and may be used to receive * data on a socket whether or not it is connection-oriented. * * If msg_name is not NULL, and the underlying protocol provides the source * address, this source address is filled in. The argument 'msg_namelen' is * initialized to the size of the buffer associated with msg_name, and * modified on return to indicate the actual size of the address stored * there. * * Input Parameters: * psock A pointer to a NuttX-specific, internal socket structure * msg Buffer to receive the message * flags Receive flags (ignored) * ****************************************************************************/ static ssize_t netlink_recvmsg(FAR struct socket *psock, FAR struct msghdr *msg, int flags) { FAR void *buf = msg->msg_iov->iov_base; size_t len = msg->msg_iov->iov_len; FAR struct sockaddr *from = msg->msg_name; FAR socklen_t *fromlen = &msg->msg_namelen; FAR struct netlink_response_s *entry; DEBUGASSERT(psock != NULL && psock->s_conn != NULL && buf != NULL); DEBUGASSERT(from == NULL || (fromlen != NULL && *fromlen >= sizeof(struct sockaddr_nl))); /* Find the response to this message. The return value */ entry = netlink_tryget_response(psock->s_conn); if (entry == NULL) { /* No response is variable, but presumably, one is expected. Check * if the socket has been configured for non-blocking operation. */ if (_SS_ISNONBLOCK(psock->s_flags) || (flags & MSG_DONTWAIT) != 0) { return -EAGAIN; } /* Wait for the response. This should always succeed. */ entry = netlink_get_response(psock->s_conn); DEBUGASSERT(entry != NULL); if (entry == NULL) { return -EPIPE; } } if (len > entry->msg.nlmsg_len) { len = entry->msg.nlmsg_len; } /* Copy the payload to the user buffer */ memcpy(buf, &entry->msg, len); kmm_free(entry); if (from != NULL) { netlink_getpeername(psock, from, fromlen); } return len; } /**************************************************************************** * Name: netlink_close * * Description: * Performs the close operation on a NetLink socket instance * * Input Parameters: * psock Socket instance * * Returned Value: * 0 on success; -1 on error with errno set appropriately. * * Assumptions: * ****************************************************************************/ static int netlink_close(FAR struct socket *psock) { FAR struct netlink_conn_s *conn = psock->s_conn; int ret = OK; /* Perform some pre-close operations for the NETLINK socket type. */ /* Is this the last reference to the connection structure (there * could be more if the socket was dup'ed). */ if (conn->crefs <= 1) { /* Free the connection structure */ conn->crefs = 0; netlink_free(psock->s_conn); if (ret < 0) { /* Return with error code, but free resources. */ nerr("ERROR: netlink_close failed: %d\n", ret); return ret; } } else { /* No.. Just decrement the reference count */ conn->crefs--; } return ret; } #endif /* CONFIG_NET_NETLINK */