OrgApache/incubator-nuttx
OrgApache
/
incubator-nuttx
mirror of https://github.com/apache/incubator-nuttx.git
1
0
Fork 0
Code Issues Releases Wiki Activity
incubator-nuttx/net/udp/udp_conn.c

1127 lines
34 KiB
C
Raw Blame History

/****************************************************************************
* net/udp/udp_conn.c
*
* SPDX-License-Identifier: BSD-3-Clause
*
* Copyright (C) 2007-2009, 2011-2012, 2016, 2018 Gregory Nutt. All rights
* reserved.
* Author: Gregory Nutt <gnutt@nuttx.org>
*
* Large parts of this file were leveraged from uIP logic:
*
* Copyright (c) 2001-2003, Adam Dunkels.
* All rights reserved.
*
* 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. The name of the author may not be used to endorse or promote
* products derived from this software without specific prior
* written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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 <nuttx/config.h>
#if defined(CONFIG_NET) && defined(CONFIG_NET_UDP)
#include <stdint.h>
#include <string.h>
#include <assert.h>
#include <errno.h>
#include <debug.h>
#include <netinet/in.h>
#include <arch/irq.h>
#include <nuttx/clock.h>
#include <nuttx/kmalloc.h>
#include <nuttx/mutex.h>
#include <nuttx/net/netconfig.h>
#include <nuttx/net/net.h>
#include <nuttx/net/netdev.h>
#include <nuttx/net/ip.h>
#include <nuttx/net/udp.h>
#include "devif/devif.h"
#include "inet/inet.h"
#include "nat/nat.h"
#include "netdev/netdev.h"
#include "socket/socket.h"
#include "igmp/igmp.h"
#include "udp/udp.h"
#include "utils/utils.h"
/****************************************************************************
* Private Data
****************************************************************************/
/* The array containing all UDP connections. */
#if CONFIG_NET_UDP_PREALLOC_CONNS > 0
static struct udp_conn_s g_udp_connections[CONFIG_NET_UDP_PREALLOC_CONNS];
#endif
/* A list of all free UDP connections */
static dq_queue_t g_free_udp_connections;
static mutex_t g_free_lock = NXMUTEX_INITIALIZER;
/* A list of all allocated UDP connections */
static dq_queue_t g_active_udp_connections;
/****************************************************************************
* Private Functions
****************************************************************************/
/****************************************************************************
* Name: udp_find_conn()
*
* Description:
* Find the UDP connection that uses this local port number.
*
* Input Parameters:
* domain - IP domain (PF_INET or PF_INET6)
* ipaddr - The IP address to use in the lookup
* portno - The port to use in the lookup
* opt - The option from another conn to match the conflict conn
* SO_REUSEADDR: If both sockets have this, they never confilct.
*
* Assumptions:
* This function must be called with the network locked.
*
****************************************************************************/
static FAR struct udp_conn_s *udp_find_conn(uint8_t domain,
FAR union ip_binding_u *ipaddr,
uint16_t portno, sockopt_t opt)
{
FAR struct udp_conn_s *conn = NULL;
#ifdef CONFIG_NET_SOCKOPTS
bool skip_reusable = _SO_GETOPT(opt, SO_REUSEADDR);
#endif
/* Now search each connection structure. */
while ((conn = udp_nextconn(conn)) != NULL)
{
/* With SO_REUSEADDR set for both sockets, we do not need to check its
* address and port.
*/
#ifdef CONFIG_NET_SOCKOPTS
if (skip_reusable && _SO_GETOPT(conn->sconn.s_options, SO_REUSEADDR))
{
continue;
}
#endif
/* If the port local port number assigned to the connections matches
* AND the IP address of the connection matches, then return a
* reference to the connection structure. INADDR_ANY is a special
* case: There can only be instance of a port number with INADDR_ANY.
*/
#ifdef CONFIG_NET_IPv4
#ifdef CONFIG_NET_IPv6
if (domain == PF_INET)
#endif
{
if (conn->domain == PF_INET && conn->lport == portno &&
(net_ipv4addr_cmp(conn->u.ipv4.laddr, ipaddr->ipv4.laddr) ||
net_ipv4addr_cmp(conn->u.ipv4.laddr, INADDR_ANY)))
{
return conn;
}
}
#endif /* CONFIG_NET_IPv4 */
#ifdef CONFIG_NET_IPv6
#ifdef CONFIG_NET_IPv4
else
#endif
{
if (conn->domain == PF_INET6 && conn->lport == portno &&
(net_ipv6addr_cmp(conn->u.ipv6.laddr, ipaddr->ipv6.laddr) ||
net_ipv6addr_cmp(conn->u.ipv6.laddr, g_ipv6_unspecaddr)))
{
return conn;
}
}
#endif /* CONFIG_NET_IPv6 */
}
return NULL;
}
/****************************************************************************
* Name: udp_ipv4_active
*
* Description:
* Find a connection structure that is the appropriate connection to be
* used within the provided UDP header
*
* Assumptions:
* This function must be called with the network locked.
*
****************************************************************************/
#ifdef CONFIG_NET_IPv4
static inline FAR struct udp_conn_s *
udp_ipv4_active(FAR struct net_driver_s *dev, FAR struct udp_conn_s *conn,
FAR struct udp_hdr_s *udp)
{
#ifdef CONFIG_NET_BROADCAST
static const in_addr_t bcast = INADDR_BROADCAST;
#endif
FAR struct ipv4_hdr_s *ip = IPv4BUF;
conn = udp_nextconn(conn);
while (conn)
{
/* If the local UDP port is non-zero, the connection is considered
* to be used. If so, then the following checks are performed:
*
* 1. The destination address is verified against the bound address
* of the connection.
*
* - The local port number is checked against the destination port
* number in the received packet.
* - If multiple network interfaces are supported, then the local
* IP address is available and we will insist that the
* destination IP matches the bound address (or the destination
* IP address is a broadcast address). If a socket is bound to
* INADDRY_ANY (laddr), then it should receive all packets
* directed to the port.
*
* 2. If this is a connection mode UDP socket, then the source address
* is verified against the connected remote address.
*
* - The remote port number is checked if the connection is bound
* to a remote port.
* - Finally, if the connection is bound to a remote IP address,
* the source IP address of the packet is checked. Broadcast
* addresses are also accepted.
*
* If all of the above are true then the newly received UDP packet
* is destined for this UDP connection.
*
* To send and receive multicast packets, the application should:
*
* - Bind socket to INADDR6_ANY (for the all-nodes multicast address)
* or to a specific <multicast-address>
* - setsockopt to SO_BROADCAST (for all-nodes address)
*
* For connection-less UDP sockets:
*
* - call sendto with sendaddr.sin_addr.s_addr = <multicast-address>
* - call recvfrom.
*
* For connection-mode UDP sockets:
*
* - call connect() to connect the UDP socket to a specific remote
* address, then
* - Call send() with no address address information
* - call recv() (from address information should not be needed)
*
* REVISIT: SO_BROADCAST flag is currently ignored.
*/
/* Check that there is a local port number and this matches
* the port number in the destination address.
*/
if (conn->lport != 0 && udp->destport == conn->lport &&
/* Local port accepts any address on this port or there
* is an exact match in destipaddr and the bound local
* address. This catches the receipt of a broadcast when
* the socket is bound to INADDR_ANY.
*/
(net_ipv4addr_cmp(conn->u.ipv4.laddr, INADDR_ANY) ||
net_ipv4addr_hdrcmp(ip->destipaddr, &conn->u.ipv4.laddr)))
{
/* Check if the socket is connection mode. In this case, only
* packets with source addresses from the connected remote peer
* will be accepted.
*/
if (_UDP_ISCONNECTMODE(conn->flags))
{
/* Check if the UDP connection is either (1) accepting packets
* from any port or (2) the packet srcport matches the local
* bound port number.
*/
if ((conn->rport == 0 || udp->srcport == conn->rport) &&
/* If (1) not connected to a remote address, or (2) a
* broadcast destipaddr was received, or (3) there is an
* exact match between the srcipaddr and the bound remote IP
* address, then accept the packet.
*/
(net_ipv4addr_cmp(conn->u.ipv4.raddr, INADDR_ANY) ||
#ifdef CONFIG_NET_BROADCAST
net_ipv4addr_hdrcmp(ip->destipaddr, &bcast) ||
#endif
net_ipv4addr_hdrcmp(ip->srcipaddr, &conn->u.ipv4.raddr)))
{
/* Matching connection found.. Break out of the loop and
* return this reference to it.
*/
break;
}
}
else
{
/* This UDP socket is not connected. We need to match only
* the destination address with the bound socket address.
* Break out out of the loop and return this reference to
* the matching connection structure.
*/
break;
}
}
/* Look at the next active connection */
conn = (FAR struct udp_conn_s *)conn->sconn.node.flink;
}
return conn;
}
#endif /* CONFIG_NET_IPv4 */
/****************************************************************************
* Name: udp_ipv6_active
*
* Description:
* Find a connection structure that is the appropriate connection to be
* used within the provided UDP header
*
* Assumptions:
* This function must be called with the network locked.
*
****************************************************************************/
#ifdef CONFIG_NET_IPv6
static inline FAR struct udp_conn_s *
udp_ipv6_active(FAR struct net_driver_s *dev, FAR struct udp_conn_s *conn,
FAR struct udp_hdr_s *udp)
{
FAR struct ipv6_hdr_s *ip = IPv6BUF;
conn = udp_nextconn(conn);
while (conn != NULL)
{
/* If the local UDP port is non-zero, the connection is considered
* to be used. If so, then the following checks are performed:
*
* 1. The destination address is verified against the bound address
* of the connection.
*
* - The local port number is checked against the destination port
* number in the received packet.
* - If multiple network interfaces are supported, then the local
* IP address is available and we will insist that the
* destination IP matches the bound address. If a socket is bound
* to INADDR6_ANY (laddr), then it should receive all packets
* directed to the port. REVISIT: Should also depend on
* SO_BROADCAST.
*
* 2. If this is a connection mode UDP socket, then the source address
* is verified against the connected remote address.
*
* - The remote port number is checked if the connection is bound
* to a remote port.
* - Finally, if the connection is bound to a remote IP address,
* the source IP address of the packet is checked.
*
* If all of the above are true then the newly received UDP packet
* is destined for this UDP connection.
*
* To send and receive multicast packets, the application should:
*
* - Bind socket to INADDR6_ANY (for the all-nodes multicast address)
* or to a specific <multicast-address>
* - setsockopt to SO_BROADCAST (for all-nodes address)
*
* For connection-less UDP sockets:
*
* - call sendto with sendaddr.sin_addr.s_addr = <multicast-address>
* - call recvfrom.
*
* For connection-mode UDP sockets:
*
* - call connect() to connect the UDP socket to a specific remote
* address, then
* - Call send() with no address address information
* - call recv() (from address information should not be needed)
*
* REVISIT: SO_BROADCAST flag is currently ignored.
*/
/* Check that there is a local port number and this matches
* the port number in the destination address.
*/
if ((conn->lport != 0 && udp->destport == conn->lport &&
/* Check if the local port accepts any address on this port or
* that there is an exact match between the destipaddr and the
* bound local address. This catches the case of the all nodes
* multicast when the socket is bound to the IPv6 unspecified
* address.
*/
(net_ipv6addr_cmp(conn->u.ipv6.laddr, g_ipv6_unspecaddr) ||
net_ipv6addr_hdrcmp(ip->destipaddr, conn->u.ipv6.laddr))))
{
/* Check if the socket is connection mode. In this case, only
* packets with source addresses from the connected remote peer
* will be accepted.
*/
if (_UDP_ISCONNECTMODE(conn->flags))
{
/* Check if the UDP connection is either (1) accepting packets
* from any port or (2) the packet srcport matches the local
* bound port number.
*/
if ((conn->rport == 0 || udp->srcport == conn->rport) &&
/* If (1) not connected to a remote address, or (2) a all-
* nodes multicast destipaddr was received, or (3) there is an
* exact match between the srcipaddr and the bound remote IP
* address, then accept the packet.
*/
(net_ipv6addr_cmp(conn->u.ipv6.raddr, g_ipv6_unspecaddr) ||
#ifdef CONFIG_NET_BROADCAST
net_ipv6addr_hdrcmp(ip->destipaddr, g_ipv6_allnodes) ||
#endif
net_ipv6addr_hdrcmp(ip->srcipaddr, conn->u.ipv6.raddr)))
{
/* Matching connection found.. Break out of the loop and
* return this reference to it.
*/
break;
}
}
else
{
/* This UDP socket is not connected. We need to match only
* the destination address with the bound socket address.
* Break out out of the loop and return this reference to
* the matching connection structure.
*/
break;
}
}
/* Look at the next active connection */
conn = (FAR struct udp_conn_s *)conn->sconn.node.flink;
}
return conn;
}
#endif /* CONFIG_NET_IPv6 */
/****************************************************************************
* Name: udp_alloc_conn
*
* Description:
* Allocate a uninitialized UDP connection structure.
*
****************************************************************************/
#if CONFIG_NET_UDP_ALLOC_CONNS > 0
static FAR struct udp_conn_s *udp_alloc_conn(void)
{
FAR struct udp_conn_s *conn;
int i;
/* Return the entry from the head of the free list */
if (dq_peek(&g_free_udp_connections) == NULL)
{
#if CONFIG_NET_UDP_MAX_CONNS > 0
if (dq_count(&g_active_udp_connections) +
CONFIG_NET_UDP_ALLOC_CONNS > CONFIG_NET_UDP_MAX_CONNS)
{
return NULL;
}
#endif
conn = kmm_zalloc(sizeof(struct udp_conn_s) *
CONFIG_NET_UDP_ALLOC_CONNS);
if (conn == NULL)
{
return conn;
}
/* Now initialize each connection structure */
for (i = 0; i < CONFIG_NET_UDP_ALLOC_CONNS; i++)
{
/* Mark the connection closed and move it to the free list */
conn[i].lport = 0;
dq_addlast(&conn[i].sconn.node, &g_free_udp_connections);
}
}
return (FAR struct udp_conn_s *)dq_remfirst(&g_free_udp_connections);
}
#endif
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* Name: udp_select_port
*
* Description:
* Select an unused port number.
*
* NOTE that in principle this function could fail if there is no available
* port number. There is no check for that case and it would actually
* in an infinite loop if that were the case. In this simple, small UDP
* implementation, it is reasonable to assume that that error cannot happen
* and that a port number will always be available.
*
* Input Parameters:
* None
*
* Returned Value:
* Next available port number in host byte order, 0 for failure.
*
****************************************************************************/
uint16_t udp_select_port(uint8_t domain, FAR union ip_binding_u *u)
{
static uint16_t g_last_udp_port;
uint16_t portno;
net_lock();
/* Generate port base dynamically */
if (g_last_udp_port == 0)
{
NET_PORT_RANDOM_INIT(g_last_udp_port);
}
/* Find an unused local port number. Loop until we find a valid
* listen port number that is not being used by any other connection.
*/
portno = g_last_udp_port; /* Record a starting port number */
do
{
NET_PORT_NEXT_H(g_last_udp_port);
if (g_last_udp_port == portno)
{
/* We have looped back, failed. */
portno = 0;
goto errout;
}
}
while (udp_find_conn(domain, u, HTONS(g_last_udp_port), 0) != NULL
#ifdef CONFIG_NET_NAT
|| nat_port_inuse(domain, IP_PROTO_UDP, (FAR union ip_addr_u *)u,
HTONS(g_last_udp_port))
#endif
);
/* Initialize and return the connection structure, bind it to the
* port number
*/
portno = g_last_udp_port;
errout:
net_unlock();
return portno;
}
/****************************************************************************
* Name: udp_initialize
*
* Description:
* Initialize the UDP connection structures. Called once and only from
* the UIP layer.
*
****************************************************************************/
void udp_initialize(void)
{
#if CONFIG_NET_UDP_PREALLOC_CONNS > 0
int i;
for (i = 0; i < CONFIG_NET_UDP_PREALLOC_CONNS; i++)
{
/* Mark the connection closed and move it to the free list */
g_udp_connections[i].lport = 0;
dq_addlast(&g_udp_connections[i].sconn.node, &g_free_udp_connections);
}
#endif
}
/****************************************************************************
* Name: udp_alloc
*
* Description:
* Allocate a new, uninitialized UDP connection structure. This is
* normally something done by the implementation of the socket() API
*
****************************************************************************/
FAR struct udp_conn_s *udp_alloc(uint8_t domain)
{
FAR struct udp_conn_s *conn;
/* The free list is protected by a mutex. */
nxmutex_lock(&g_free_lock);
conn = (FAR struct udp_conn_s *)dq_remfirst(&g_free_udp_connections);
#if CONFIG_NET_UDP_ALLOC_CONNS > 0
if (conn == NULL)
{
conn = udp_alloc_conn();
}
#endif
if (conn)
{
/* Make sure that the connection is marked as uninitialized */
conn->sconn.s_ttl = IP_TTL_DEFAULT;
conn->flags = 0;
#if defined(CONFIG_NET_IPv4) || defined(CONFIG_NET_IPv6)
conn->domain = domain;
#endif
conn->lport = 0;
#if CONFIG_NET_RECV_BUFSIZE > 0
conn->rcvbufs = CONFIG_NET_RECV_BUFSIZE;
#endif
#if CONFIG_NET_SEND_BUFSIZE > 0
conn->sndbufs = CONFIG_NET_SEND_BUFSIZE;
nxsem_init(&conn->sndsem, 0, 0);
#endif
#ifdef CONFIG_NET_UDP_WRITE_BUFFERS
/* Initialize the write buffer lists */
sq_init(&conn->write_q);
#endif
/* Enqueue the connection into the active list */
dq_addlast(&conn->sconn.node, &g_active_udp_connections);
}
nxmutex_unlock(&g_free_lock);
return conn;
}
/****************************************************************************
* Name: udp_free
*
* Description:
* Free a UDP connection structure that is no longer in use. This should be
* done by the implementation of close().
*
****************************************************************************/
void udp_free(FAR struct udp_conn_s *conn)
{
#ifdef CONFIG_NET_UDP_WRITE_BUFFERS
FAR struct udp_wrbuffer_s *wrbuffer;
#endif
/* The free list is protected by a mutex. */
DEBUGASSERT(conn->crefs == 0);
nxmutex_lock(&g_free_lock);
conn->lport = 0;
/* Remove the connection from the active list */
dq_rem(&conn->sconn.node, &g_active_udp_connections);
/* Release any read-ahead buffers attached to the connection, NULL is ok */
iob_free_chain(conn->readahead);
#ifdef CONFIG_NET_UDP_WRITE_BUFFERS
/* Release any write buffers attached to the connection */
while ((wrbuffer = (struct udp_wrbuffer_s *)
sq_remfirst(&conn->write_q)) != NULL)
{
udp_wrbuffer_release(wrbuffer);
}
#if CONFIG_NET_SEND_BUFSIZE > 0
/* Notify the send buffer available */
udp_sendbuffer_notify(conn);
#endif /* CONFIG_NET_SEND_BUFSIZE */
#endif
/* Free the connection.
* If this is a preallocated or a batch allocated connection store it in
* the free connections list. Else free it.
*/
#if CONFIG_NET_UDP_ALLOC_CONNS == 1
if (conn < g_udp_connections || conn >= (g_udp_connections +
CONFIG_NET_UDP_PREALLOC_CONNS))
{
kmm_free(conn);
}
else
#endif
{
memset(conn, 0, sizeof(*conn));
dq_addlast(&conn->sconn.node, &g_free_udp_connections);
}
nxmutex_unlock(&g_free_lock);
}
/****************************************************************************
* Name: udp_active
*
* Description:
* Find a connection structure that is the appropriate
* connection to be used within the provided UDP header
*
* Assumptions:
* This function must be called with the network locked.
*
****************************************************************************/
FAR struct udp_conn_s *udp_active(FAR struct net_driver_s *dev,
FAR struct udp_conn_s *conn,
FAR struct udp_hdr_s *udp)
{
#ifdef CONFIG_NET_IPv6
#ifdef CONFIG_NET_IPv4
if (IFF_IS_IPv6(dev->d_flags))
#endif
{
return udp_ipv6_active(dev, conn, udp);
}
#endif /* CONFIG_NET_IPv6 */
#ifdef CONFIG_NET_IPv4
#ifdef CONFIG_NET_IPv6
else
#endif
{
return udp_ipv4_active(dev, conn, udp);
}
#endif /* CONFIG_NET_IPv4 */
}
/****************************************************************************
* Name: udp_nextconn
*
* Description:
* Traverse the list of allocated UDP connections
*
* Assumptions:
* This function must be called with the network locked.
*
****************************************************************************/
FAR struct udp_conn_s *udp_nextconn(FAR struct udp_conn_s *conn)
{
if (!conn)
{
return (FAR struct udp_conn_s *)g_active_udp_connections.head;
}
else
{
return (FAR struct udp_conn_s *)conn->sconn.node.flink;
}
}
/****************************************************************************
* Name: udp_bind
*
* Description:
* This function implements the low level parts of the standard UDP
* bind() operation.
*
* Assumptions:
* This function is called from normal user level code.
*
****************************************************************************/
int udp_bind(FAR struct udp_conn_s *conn, FAR const struct sockaddr *addr)
{
uint16_t portno;
int ret;
FAR struct net_driver_s *dev;
#if defined(CONFIG_NET_IPv4) && defined(CONFIG_NET_IPv6)
if (conn->domain != addr->sa_family)
{
nerr("ERROR: Invalid address type: %d != %d\n", conn->domain,
addr->sa_family);
return -EINVAL;
}
#endif
/* Interrupts must be disabled while access the UDP connection list */
net_lock();
#ifdef CONFIG_NET_IPv4
#ifdef CONFIG_NET_IPv6
if (conn->domain == PF_INET)
#endif
{
FAR const struct sockaddr_in *inaddr =
(FAR const struct sockaddr_in *)addr;
if (!net_ipv4addr_cmp(inaddr->sin_addr.s_addr, INADDR_ANY) &&
!net_ipv4addr_cmp(inaddr->sin_addr.s_addr, HTONL(INADDR_LOOPBACK)) &&
!net_ipv4addr_cmp(inaddr->sin_addr.s_addr, INADDR_BROADCAST) &&
!IN_MULTICAST(NTOHL(inaddr->sin_addr.s_addr)))
{
ret = -EADDRNOTAVAIL;
for (dev = g_netdevices; dev; dev = dev->flink)
{
if (net_ipv4addr_cmp(inaddr->sin_addr.s_addr, dev->d_ipaddr))
{
ret = 0;
break;
}
}
if (ret == -EADDRNOTAVAIL)
{
net_unlock();
return ret;
}
}
/* Get the port number that we are binding to */
portno = inaddr->sin_port;
/* Bind the local IP address to the connection. NOTE this address may
* be INADDR_ANY meaning, essentially, that we are binding to all
* interfaces for receiving (Sending will use the default port).
*/
net_ipv4addr_copy(conn->u.ipv4.laddr, inaddr->sin_addr.s_addr);
}
#endif /* CONFIG_NET_IPv4 */
#ifdef CONFIG_NET_IPv6
#ifdef CONFIG_NET_IPv4
else
#endif
{
FAR const struct sockaddr_in6 *inaddr =
(FAR const struct sockaddr_in6 *)addr;
if (!net_ipv6addr_cmp(inaddr->sin6_addr.in6_u.u6_addr16,
g_ipv6_unspecaddr) &&
!net_ipv6addr_cmp(inaddr->sin6_addr.in6_u.u6_addr16,
g_ipv6_loopback) &&
!net_ipv6addr_cmp(inaddr->sin6_addr.in6_u.u6_addr16,
g_ipv6_allnodes) &&
!net_ipv6addr_cmp(inaddr->sin6_addr.in6_u.u6_addr16, g_ipv6_allnodes))
{
ret = -EADDRNOTAVAIL;
for (dev = g_netdevices; dev; dev = dev->flink)
{
if (NETDEV_IS_MY_V6ADDR(dev,
inaddr->sin6_addr.in6_u.u6_addr16))
{
ret = 0;
break;
}
}
if (ret == -EADDRNOTAVAIL)
{
net_unlock();
return ret;
}
}
/* Get the port number that we are binding to */
portno = inaddr->sin6_port;
/* Bind the local IP address to the connection. NOTE this address may
* be INADDR_ANY meaning, essentially, that we are binding to all
* interfaces for receiving (Sending will use the default port).
*/
net_ipv6addr_copy(conn->u.ipv6.laddr,
inaddr->sin6_addr.in6_u.u6_addr16);
}
#endif /* CONFIG_NET_IPv6 */
/* Is the user requesting to bind to any port? */
if (portno == 0)
{
/* Yes.. Select any unused local port number */
portno = HTONS(udp_select_port(conn->domain, &conn->u));
if (portno == 0)
{
ret = -EADDRINUSE;
}
else
{
conn->lport = portno;
ret = OK;
}
}
else
{
/* Is any other UDP connection already bound to this address
* and port ?
*/
if (udp_find_conn(conn->domain, &conn->u, portno,
#ifdef CONFIG_NET_SOCKOPTS
conn->sconn.s_options
#else
0
#endif
) == NULL
#ifdef CONFIG_NET_NAT
&& !nat_port_inuse(conn->domain, IP_PROTO_UDP,
(FAR union ip_addr_u *)&conn->u, portno)
#endif
)
{
/* No.. then bind the socket to the port */
conn->lport = portno;
ret = OK;
}
else
{
ret = -EADDRINUSE;
}
}
net_unlock();
return ret;
}
/****************************************************************************
* Name: udp_connect
*
* Description:
* This function simply assigns a remote address to UDP "connection"
* structure. This function is called as part of the implementation of:
*
* - connect(). If connect() is called for a SOCK_DGRAM socket, then
* this logic performs the moral equivalent of connect() operation
* for the UDP socket.
* - recvfrom() and sendto(). This function is called to set the
* remote address of the peer.
*
* The function will automatically allocate an unused local port for the
* new connection if the socket is not yet bound to a local address.
* However, another port can be chosen by using the udp_bind() call,
* after the udp_connect() function has been called.
*
* Input Parameters:
* conn - A reference to UDP connection structure. A value of NULL will
* disconnect from any previously connected address.
* addr - The address of the remote host.
*
* Assumptions:
* This function is called (indirectly) from user code. Interrupts may
* be enabled.
*
****************************************************************************/
int udp_connect(FAR struct udp_conn_s *conn, FAR const struct sockaddr *addr)
{
/* Has this address already been bound to a local port (lport)? */
if (!conn->lport)
{
/* No.. Find an unused local port number and bind it to the
* connection structure.
*/
conn->lport = HTONS(udp_select_port(conn->domain, &conn->u));
if (!conn->lport)
{
nerr("ERROR: Failed to get a local port!\n");
return -EADDRINUSE;
}
}
/* Is there a remote port (rport)? */
if (addr != NULL)
{
#ifdef CONFIG_NET_IPv4
#ifdef CONFIG_NET_IPv6
if (conn->domain == PF_INET)
#endif
{
FAR const struct sockaddr_in *inaddr =
(FAR const struct sockaddr_in *)addr;
conn->rport = inaddr->sin_port;
/* Note: 0.0.0.0 is mapped to 127.0.0.1 by convention. */
if (inaddr->sin_addr.s_addr == INADDR_ANY)
{
net_ipv4addr_copy(conn->u.ipv4.raddr, HTONL(INADDR_LOOPBACK));
}
else
{
net_ipv4addr_copy(conn->u.ipv4.raddr, inaddr->sin_addr.s_addr);
}
}
#endif /* CONFIG_NET_IPv4 */
#ifdef CONFIG_NET_IPv6
#ifdef CONFIG_NET_IPv4
else
#endif
{
FAR const struct sockaddr_in6 *inaddr =
(FAR const struct sockaddr_in6 *)addr;
conn->rport = inaddr->sin6_port;
/* Note: ::0 is mapped to ::1 by convention. */
if (net_ipv6addr_cmp(addr, g_ipv6_unspecaddr))
{
struct in6_addr loopback_sin6_addr = IN6ADDR_LOOPBACK_INIT;
net_ipv6addr_copy(conn->u.ipv6.raddr,
loopback_sin6_addr.s6_addr16);
}
else
{
net_ipv6addr_copy(conn->u.ipv6.raddr,
inaddr->sin6_addr.s6_addr16);
}
}
#endif /* CONFIG_NET_IPv6 */
}
else
{
conn->rport = 0;
#ifdef CONFIG_NET_IPv4
#ifdef CONFIG_NET_IPv6
if (conn->domain == PF_INET)
#endif
{
net_ipv4addr_copy(conn->u.ipv4.raddr, INADDR_ANY);
}
#endif /* CONFIG_NET_IPv4 */
#ifdef CONFIG_NET_IPv6
#ifdef CONFIG_NET_IPv4
else
#endif
{
net_ipv6addr_copy(conn->u.ipv6.raddr, g_ipv6_unspecaddr);
}
#endif /* CONFIG_NET_IPv6 */
}
return OK;
}
#if defined(CONFIG_NET_IGMP)
/****************************************************************************
* Name: udp_leavegroup
*
* Description:
* This function leaves the multicast group to which the conn belongs.
*
* Input Parameters:
* conn - A reference to UDP connection structure. A value of NULL will
* disconnect from any previously connected address.
*
* Assumptions:
* This function is called (indirectly) from user code. Interrupts may
* be enabled.
*
****************************************************************************/
void udp_leavegroup(FAR struct udp_conn_s *conn)
{
if (conn->mreq.imr_multiaddr.s_addr != 0)
{
FAR struct net_driver_s *dev;
if ((dev = netdev_findbyindex(conn->mreq.imr_ifindex)) != NULL)
{
igmp_leavegroup(dev, &conn->mreq.imr_multiaddr);
}
}
}
#endif
#endif /* CONFIG_NET && CONFIG_NET_UDP */
Reference in New Issue View Git Blame Copy Permalink