/**************************************************************************** * net/socket/bluetooth_sockif.c * * Copyright (C) 2018 Gregory Nutt. All rights reserved. * Author: Gregory Nutt * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in * the documentation and/or other materials provided with the * distribution. * 3. Neither the name NuttX nor the names of its contributors may be * used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. * ****************************************************************************/ /**************************************************************************** * Included Files ****************************************************************************/ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "bluetooth/bluetooth.h" #ifdef CONFIG_NET_BLUETOOTH /**************************************************************************** * Private Function Prototypes ****************************************************************************/ static int bluetooth_setup(FAR struct socket *psock, int protocol); static sockcaps_t bluetooth_sockcaps(FAR struct socket *psock); static void bluetooth_addref(FAR struct socket *psock); static int bluetooth_bind(FAR struct socket *psock, FAR const struct sockaddr *addr, socklen_t addrlen); static int bluetooth_getsockname(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen); static int bluetooth_listen(FAR struct socket *psock, int backlog); static int bluetooth_connect(FAR struct socket *psock, FAR const struct sockaddr *addr, socklen_t addrlen); static int bluetooth_accept(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen, FAR struct socket *newsock); #ifndef CONFIG_DISABLE_POLL static int bluetooth_poll_local(FAR struct socket *psock, FAR struct pollfd *fds, bool setup); #endif static ssize_t bluetooth_send(FAR struct socket *psock, FAR const void *buf, size_t len, int flags); static ssize_t bluetooth_sendto(FAR struct socket *psock, FAR const void *buf, size_t len, int flags, FAR const struct sockaddr *to, socklen_t tolen); static int bluetooth_close(FAR struct socket *psock); /**************************************************************************** * Public Data ****************************************************************************/ const struct sock_intf_s g_bluetooth_sockif = { bluetooth_setup, /* si_setup */ bluetooth_sockcaps, /* si_sockcaps */ bluetooth_addref, /* si_addref */ bluetooth_bind, /* si_bind */ bluetooth_getsockname, /* si_getsockname */ bluetooth_getpeername, /* si_getpeername */ bluetooth_listen, /* si_listen */ bluetooth_connect, /* si_connect */ bluetooth_accept, /* si_accept */ #ifndef CONFIG_DISABLE_POLL bluetooth_poll_local, /* si_poll */ #endif bluetooth_send, /* si_send */ bluetooth_sendto, /* si_sendto */ #ifdef CONFIG_NET_SENDFILE NULL, /* si_sendfile */ #endif bluetooth_recvfrom, /* si_recvfrom */ bluetooth_close /* si_close */ }; /**************************************************************************** * Private Functions ****************************************************************************/ /**************************************************************************** * Name: bluetooth_sockif_alloc * * Description: * Allocate and attach a PF_BLUETOOTH connection structure. * * Assumptions: * The network is locked * ****************************************************************************/ static int bluetooth_sockif_alloc(FAR struct socket *psock) { /* Allocate the packet socket connection structure and save in the new * socket instance. */ FAR struct bluetooth_conn_s *conn = bluetooth_conn_alloc(); if (conn == NULL) { /* Failed to reserve a connection structure */ return -ENOMEM; } /* Set the reference count on the connection structure. This reference * count will be incremented only if the socket is dup'ed */ DEBUGASSERT(conn->bc_crefs == 0); conn->bc_crefs = 1; /* Save the pre-allocated connection in the socket structure */ psock->s_conn = conn; return OK; } /**************************************************************************** * Name: bluetooth_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 (see sys/socket.h) * * Returned Value: * Zero (OK) is returned on success. Otherwise, a negater errno value is * returned. * ****************************************************************************/ static int bluetooth_setup(FAR struct socket *psock, int protocol) { /* Allocate the appropriate connection structure. This reserves the * the connection structure is is unallocated at this point. It will * not actually be initialized until the socket is connected. * * Only SOCK_RAW is supported */ if (psock->s_type == SOCK_RAW) { return bluetooth_sockif_alloc(psock); } else { return -EPROTONOSUPPORT; } } /**************************************************************************** * Name: bluetooth_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 set of socket cababilities is returned. * ****************************************************************************/ static sockcaps_t bluetooth_sockcaps(FAR struct socket *psock) { return 0; } /**************************************************************************** * Name: bluetooth_addref * * Description: * Increment the refernce 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 bluetooth_addref(FAR struct socket *psock) { FAR struct bluetooth_conn_s *conn; DEBUGASSERT(psock != NULL && psock->s_conn != NULL && psock->s_type == SOCK_RAW); conn = (FAR struct bluetooth_conn_s *)psock->s_conn; DEBUGASSERT(conn->bc_crefs > 0 && conn->bc_crefs < 255); conn->bc_crefs++; } /**************************************************************************** * Name: bluetooth_connect * * Description: * bluetooth_connect() connects the local socket referred to by the structure * 'psock' to the address specified by 'addr'. The addrlen argument * specifies the size of 'addr'. The format of the address in 'addr' is * determined by the address space of the socket 'psock'. * * Generally, connection-based protocol sockets may successfully * bluetooth_connect() only once; connectionless protocol sockets may use * bluetooth_connect() multiple times to change their association. * Connectionless sockets may dissolve the association by connecting to * an address with the bt_family member of sockaddr set to AF_UNSPEC. * * Input Parameters: * psock Pointer to a socket structure initialized by psock_socket() * addr Server address (form depends on type of socket) * addrlen Length of actual 'addr' * * Returned Value: * 0 on success; a negated errno value on failue. See connect() for the * list of appropriate errno values to be returned. * ****************************************************************************/ static int bluetooth_connect(FAR struct socket *psock, FAR const struct sockaddr *addr, socklen_t addrlen) { FAR struct bluetooth_conn_s *conn; FAR struct sockaddr_bt_s *btaddr; int ret; DEBUGASSERT(psock != NULL || addr != NULL); conn = (FAR struct bluetooth_conn_s *)psock->s_conn; DEBUGASSERT(conn != NULL); /* Verify the address family */ if (addr->sa_family == AF_BLUETOOTH) { /* Save the "connection" address */ btaddr = (FAR struct sockaddr_bt_s *)addr; memcpy(&conn->bc_raddr, &btaddr->bt_bdaddr, sizeof(bt_addr_t)); conn->bc_channel = btaddr->bt_channel; /* Mark the socket as connected. */ psock->s_flags |= _SF_CONNECTED; ret = OK; } else { /* The specified address is not a valid address for the address family * of the specified socket. */ ret = -EAFNOSUPPORT; } return ret; } /**************************************************************************** * Name: bluetooth_accept * * Description: * The bluetooth_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 bluetooth_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, bluetooth_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, bluetooth_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: 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 desrciption of the approriate error value. * * Assumptions: * The network is locked. * ****************************************************************************/ static int bluetooth_accept(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen, FAR struct socket *newsock) { return -EAFNOSUPPORT; } /**************************************************************************** * Name: bluetooth_bind * * Description: * bluetooth_bind() gives the socket 'psock' 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: * psock Socket structure of the socket to bind * addr Socket local address * addrlen Length of 'addr' * * Returned Value: * 0 on success; A negated errno value is returned on failure. See * bind() for a list a appropriate error values. * ****************************************************************************/ static int bluetooth_bind(FAR struct socket *psock, FAR const struct sockaddr *addr, socklen_t addrlen) { FAR const struct sockaddr_bt_s *iaddr; FAR struct radio_driver_s *radio; FAR struct bluetooth_conn_s *conn; DEBUGASSERT(psock != NULL && addr != NULL); /* Verify that a valid address has been provided */ if (addr->sa_family != AF_BLUETOOTH || addrlen < sizeof(struct sockaddr_bt_s)) { nerr("ERROR: Invalid family: %u or address length: %d < %d\n", addr->sa_family, addrlen, sizeof(struct sockaddr_bt_s)); return -EBADF; } /* Bind a PF_BLUETOOTH socket to an network device. * * Only SOCK_RAW is supported */ if (psock->s_type != SOCK_RAW) { nerr("ERROR: Invalid socket type: %u\n", psock->s_type); return -EBADF; } /* Verify that the socket is not already bound. */ if (_SS_ISBOUND(psock->s_flags)) { nerr("ERROR: Already bound\n"); return -EINVAL; } iaddr = (FAR const struct sockaddr_bt_s *)addr; /* Very that some address was provided */ /* REVISIT: Currently and explict address must be assigned. Should we * support some moral equivalent to INADDR_ANY? */ conn = (FAR struct bluetooth_conn_s *)psock->s_conn; /* Find the device associated with the requested address */ radio = bluetooth_find_device(conn, &iaddr->bt_bdaddr); if (radio == NULL) { nerr("ERROR: No radio at this address\n"); return -ENODEV; } /* Save the address as the socket's local address */ memcpy(&conn->bc_laddr, &iaddr->bt_bdaddr, sizeof(bt_addr_t)); /* Mark the socket bound */ psock->s_flags |= _SF_BOUND; return OK; } /**************************************************************************** * Name: bluetooth_getsockname * * Description: * The bluetooth_getsockname() function retrieves the locally-bound 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. * * Input 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 * getsockname() for the list of appropriate error numbers. * ****************************************************************************/ static int bluetooth_getsockname(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen) { FAR struct bluetooth_conn_s *conn; FAR struct sockaddr_bt_s tmp; socklen_t copylen; DEBUGASSERT(psock != NULL && addr != NULL && addrlen != NULL); conn = (FAR struct bluetooth_conn_s *)psock->s_conn; DEBUGASSERT(conn != NULL); /* Create a copy of the full address on the stack */ tmp.bt_family = AF_BLUETOOTH; memcpy(&tmp.bt_bdaddr, &conn->bc_laddr, sizeof(bt_addr_t)); /* Copy to the user buffer, truncating if necessary */ copylen = sizeof(struct sockaddr_bt_s); if (copylen > *addrlen) { copylen = *addrlen; } memcpy(addr, &tmp, copylen); /* Return the actual size transferred */ *addrlen = copylen; return OK; } /**************************************************************************** * Name: bluetooth_getpeername * * Description: * The bluetooth_getpeername() function retrieves the remote-connected name of * the specified local 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 bluetooth_getpeername(FAR struct socket *psock, FAR struct sockaddr *addr, FAR socklen_t *addrlen) { FAR struct bluetooth_conn_s *conn; FAR struct sockaddr_bt_s tmp; socklen_t copylen; DEBUGASSERT(psock != NULL && addr != NULL && addrlen != NULL); conn = (FAR struct bluetooth_conn_s *)psock->s_conn; DEBUGASSERT(conn != NULL); /* Create a copy of the full address on the stack */ tmp.bt_family = AF_BLUETOOTH; memcpy(&tmp.bt_bdaddr, &conn->bc_raddr, sizeof(bt_addr_t)); /* Copy to the user buffer, truncating if necessary */ copylen = sizeof(struct sockaddr_bt_s); if (copylen > *addrlen) { copylen = *addrlen; } memcpy(addr, &tmp, copylen); /* Return the actual size transferred */ *addrlen = copylen; return OK; } /**************************************************************************** * Name: bluetooth_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 * PF_BLUETOOTH sockets, psock_listen() calls this function. The listen() * call does not apply only to PF_BLUETOOTH sockets. * * Input Parameters: * psock Reference to an internal, boound 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 list() for the set of appropriate error values. * ****************************************************************************/ int bluetooth_listen(FAR struct socket *psock, int backlog) { return -EOPNOTSUPP; } /**************************************************************************** * Name: bluetooth_poll * * Description: * The standard poll() operation redirects operations on socket descriptors * to net_poll which, indiectly, calls to function. * * Input Parameters: * psock - An instance of the internal socket structure. * fds - The structure describing the events to be monitored, OR NULL if * this is a request to stop monitoring events. * setup - true: Setup up the poll; false: Teardown the poll * * Returned Value: * 0: Success; Negated errno on failure * ****************************************************************************/ #ifndef CONFIG_DISABLE_POLL static int bluetooth_poll_local(FAR struct socket *psock, FAR struct pollfd *fds, bool setup) { /* We should need to support some kind of write ahead buffering for this * feature. */ #warning Missing logic return -ENOSYS; } #endif /* !CONFIG_DISABLE_POLL */ /**************************************************************************** * Name: bluetooth_send * * Description: * Socket send() method for the PF_BLUETOOTH socket. * * Input Parameters: * psock An instance of the internal socket structure. * buf Data to send * len Length of data to send * flags Send flags * * Returned Value: * On success, returns the number of characters sent. On error, a negated * errno value is returned (see send() for the list of appropriate error * values. * ****************************************************************************/ static ssize_t bluetooth_send(FAR struct socket *psock, FAR const void *buf, size_t len, int flags) { struct sockaddr_bt_s to; FAR struct bluetooth_conn_s *conn; ssize_t ret; DEBUGASSERT(psock != NULL || buf != NULL); conn = (FAR struct bluetooth_conn_s *)psock->s_conn; DEBUGASSERT(conn != NULL); /* Only SOCK_RAW is supported */ if (psock->s_type == SOCK_RAW) { /* send() may be used only if the socket is has been connected. */ if (!_SS_ISCONNECTED( psock->s_flags)) { ret = -ENOTCONN; } else { to.bt_family = AF_BLUETOOTH; memcpy(&to.bt_bdaddr, &conn->bc_raddr, sizeof(bt_addr_t)); to.bt_channel = conn->bc_channel; /* Then perform the send() as sendto() */ ret = psock_bluetooth_sendto(psock, buf, len, flags, (FAR const struct sockaddr *)&to, sizeof(struct sockaddr_bt_s)); } } else { /* EDESTADDRREQ. Signifies that the socket is not connection-mode and * no peer address is set. */ ret = -EDESTADDRREQ; } return ret; } /**************************************************************************** * Name: bluetooth_sendto * * Description: * Implements the sendto() operation for the case of the PF_BLUETOOTH * socket. * * Input Parameters: * psock A pointer to a NuttX-specific, internal socket structure * buf Data to send * len Length of data to send * flags Send flags * to Address of recipient * tolen The length of the address structure * * Returned Value: * On success, returns the number of characters sent. On error, a negated * errno value is returned (see send_to() for the list of appropriate error * values. * ****************************************************************************/ static ssize_t bluetooth_sendto(FAR struct socket *psock, FAR const void *buf, size_t len, int flags, FAR const struct sockaddr *to, socklen_t tolen) { ssize_t ret; /* Only SOCK_RAW is supported */ if (psock->s_type == SOCK_RAW) { /* Raw packet send */ ret = psock_bluetooth_sendto(psock, buf, len, flags, to, tolen); } else { /* EDESTADDRREQ. Signifies that the socket is not connection-mode and * no peer address is set. */ ret = -EDESTADDRREQ; } return ret; } /**************************************************************************** * Name: bluetooth_close * * Description: * Performs the close operation on a PF_BLUETOOTH socket instance * * Input Parameters: * psock Socket instance * * Returned Value: * 0 on success; a negated errno value is returned on any failure. * * Assumptions: * ****************************************************************************/ static int bluetooth_close(FAR struct socket *psock) { /* Perform some pre-close operations for the PF_BLUETOOTH address type */ switch (psock->s_type) { /* Only SOCK_RAW is supported */ case SOCK_RAW: { FAR struct bluetooth_conn_s *conn = psock->s_conn; /* Is this the last reference to the connection structure (there * could be more if the socket was dup'ed). */ if (conn->bc_crefs <= 1) { /* Yes... free the connection structure */ conn->bc_crefs = 0; /* No more references on the connection */ bluetooth_conn_free(psock->s_conn); /* Free network resources */ } else { /* No.. Just decrement the reference count */ conn->bc_crefs--; } return OK; } default: return -EBADF; } } /**************************************************************************** * Public Functions ****************************************************************************/ #endif /* CONFIG_NET_BLUETOOTH */