423 lines
12 KiB
C
423 lines
12 KiB
C
/****************************************************************************
|
|
* net/netdev/netdev_findbyaddr.c
|
|
*
|
|
* Copyright (C) 2007-2009, 2014-2015, 2017 Gregory Nutt. All rights reserved.
|
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
|
*
|
|
* 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 <nuttx/config.h>
|
|
#if defined(CONFIG_NET) && CONFIG_NSOCKET_DESCRIPTORS > 0
|
|
|
|
#include <stdbool.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <debug.h>
|
|
|
|
#include <netinet/in.h>
|
|
|
|
#include <nuttx/net/netdev.h>
|
|
#include <nuttx/net/ip.h>
|
|
|
|
#include "utils/utils.h"
|
|
#include "devif/devif.h"
|
|
#include "inet/inet.h"
|
|
#include "route/route.h"
|
|
#include "netdev/netdev.h"
|
|
|
|
/****************************************************************************
|
|
* Private Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: netdev_finddevice_ipv4addr
|
|
*
|
|
* Description:
|
|
* Find a previously registered network device by matching a local address
|
|
* with the subnet served by the device. Only "up" devices are considered
|
|
* (since a "down" device has no meaningful address).
|
|
*
|
|
* Parameters:
|
|
* ripaddr - Remote address of a connection to use in the lookup
|
|
*
|
|
* Returned Value:
|
|
* Pointer to driver on success; null on failure
|
|
*
|
|
* Assumptions:
|
|
* Called from normal user mode
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_NET_IPv4
|
|
static FAR struct net_driver_s *netdev_finddevice_ipv4addr(in_addr_t ripaddr)
|
|
{
|
|
FAR struct net_driver_s *dev;
|
|
|
|
/* Examine each registered network device */
|
|
|
|
net_lock();
|
|
for (dev = g_netdevices; dev; dev = dev->flink)
|
|
{
|
|
/* Is the interface in the "up" state? */
|
|
|
|
if ((dev->d_flags & IFF_UP) != 0)
|
|
{
|
|
/* Yes.. check for an address match (under the netmask) */
|
|
|
|
if (net_ipv4addr_maskcmp(dev->d_ipaddr, ripaddr,
|
|
dev->d_netmask))
|
|
{
|
|
/* Its a match */
|
|
|
|
net_unlock();
|
|
return dev;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* No device with the matching address found */
|
|
|
|
net_unlock();
|
|
return NULL;
|
|
}
|
|
#endif /* CONFIG_NET_IPv4 */
|
|
|
|
/****************************************************************************
|
|
* Name: netdev_finddevice_ipv6addr
|
|
*
|
|
* Description:
|
|
* Find a previously registered network device by matching a local address
|
|
* with the subnet served by the device. Only "up" devices are considered
|
|
* (since a "down" device has no meaningful address).
|
|
*
|
|
* Parameters:
|
|
* ripaddr - Remote address of a connection to use in the lookup
|
|
*
|
|
* Returned Value:
|
|
* Pointer to driver on success; null on failure
|
|
*
|
|
* Assumptions:
|
|
* Called from normal user mode
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_NET_IPv6
|
|
static FAR struct net_driver_s *
|
|
netdev_finddevice_ipv6addr(const net_ipv6addr_t ripaddr)
|
|
{
|
|
FAR struct net_driver_s *dev;
|
|
|
|
/* Examine each registered network device */
|
|
|
|
net_lock();
|
|
for (dev = g_netdevices; dev; dev = dev->flink)
|
|
{
|
|
/* Is the interface in the "up" state? */
|
|
|
|
if ((dev->d_flags & IFF_UP) != 0)
|
|
{
|
|
/* Yes.. check for an address match (under the netmask) */
|
|
|
|
if (net_ipv6addr_maskcmp(dev->d_ipv6addr, ripaddr,
|
|
dev->d_ipv6netmask))
|
|
{
|
|
/* Its a match */
|
|
|
|
net_unlock();
|
|
return dev;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* No device with the matching address found */
|
|
|
|
net_unlock();
|
|
return NULL;
|
|
}
|
|
#endif /* CONFIG_NET_IPv6 */
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: netdev_findby_ipv4addr
|
|
*
|
|
* Description:
|
|
* Find a previously registered network device by matching an arbitrary
|
|
* IPv4 address.
|
|
*
|
|
* Parameters:
|
|
* lipaddr - Local, bound address of a connection. Used only if ripaddr
|
|
* is the broadcast address. Used only if CONFIG_NETDEV_MULTINIC.
|
|
* ripaddr - Remote address of a connection to use in the lookup
|
|
*
|
|
* Returned Value:
|
|
* Pointer to driver on success; null on failure
|
|
*
|
|
* Assumptions:
|
|
* Called from normal user mode
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_NET_IPv4
|
|
#ifdef CONFIG_NETDEV_MULTINIC
|
|
FAR struct net_driver_s *netdev_findby_ipv4addr(in_addr_t lipaddr,
|
|
in_addr_t ripaddr)
|
|
#else
|
|
FAR struct net_driver_s *netdev_findby_ipv4addr(in_addr_t ripaddr)
|
|
#endif
|
|
{
|
|
struct net_driver_s *dev;
|
|
#ifdef CONFIG_NET_ROUTE
|
|
in_addr_t router;
|
|
int ret;
|
|
#endif
|
|
|
|
/* First, check if this is the broadcast IP address */
|
|
|
|
if (net_ipv4addr_cmp(ripaddr, INADDR_BROADCAST))
|
|
{
|
|
#ifdef CONFIG_NETDEV_MULTINIC
|
|
/* Yes.. Check the local, bound address. Is it INADDR_ANY? */
|
|
|
|
if (net_ipv4addr_cmp(lipaddr, INADDR_ANY))
|
|
{
|
|
/* Yes.. In this case, I think we are supposed to send the
|
|
* broadcast packet out ALL local networks. I am not sure
|
|
* of that and, in any event, there is nothing we can do
|
|
* about that here.
|
|
*
|
|
* REVISIT: For now, arbitrarily return the first network
|
|
* interface in the list of network devices. The broadcast
|
|
* will be sent on that device only.
|
|
*/
|
|
|
|
return g_netdevices;
|
|
}
|
|
else
|
|
{
|
|
/* Return the device associated with the local address */
|
|
|
|
return netdev_finddevice_ipv4addr(lipaddr);
|
|
}
|
|
#else
|
|
/* If there is only a single, registered network interface, then the
|
|
* decision is pretty easy.
|
|
*/
|
|
|
|
return g_netdevices;
|
|
#endif
|
|
}
|
|
|
|
/* Check if the address maps to a local network */
|
|
|
|
dev = netdev_finddevice_ipv4addr(ripaddr);
|
|
if (dev)
|
|
{
|
|
return dev;
|
|
}
|
|
|
|
/* No.. The address lies on an external network */
|
|
|
|
#ifdef CONFIG_NET_ROUTE
|
|
/* If we have a routing table, then perhaps we can find the local
|
|
* address of a router that can forward packets to the external network.
|
|
*/
|
|
|
|
ret = net_ipv4_router(ripaddr, &router);
|
|
if (ret >= 0)
|
|
{
|
|
/* Success... try to find the network device associated with the local
|
|
* router address
|
|
*/
|
|
|
|
dev = netdev_finddevice_ipv4addr(router);
|
|
if (dev)
|
|
{
|
|
return dev;
|
|
}
|
|
}
|
|
#endif /* CONFIG_NET_ROUTE */
|
|
|
|
/* The above lookup will fail if the packet is being sent out of our
|
|
* out subnet to a router and there is no routing information.
|
|
*/
|
|
|
|
#ifndef CONFIG_NETDEV_MULTINIC
|
|
/* If there is only a single, registered network interface, then the
|
|
* decision is pretty easy. Use that device and its default router
|
|
* address.
|
|
*/
|
|
|
|
dev = g_netdevices;
|
|
#endif
|
|
|
|
/* If we will did not find the network device, then we might as well fail
|
|
* because we are not configured properly to determine the route to the
|
|
* destination.
|
|
*/
|
|
|
|
return dev;
|
|
}
|
|
#endif /* CONFIG_NET_IPv4 */
|
|
|
|
/****************************************************************************
|
|
* Name: netdev_findby_ipv6addr
|
|
*
|
|
* Description:
|
|
* Find a previously registered network device by matching an arbitrary
|
|
* IPv6 address.
|
|
*
|
|
* Parameters:
|
|
* lipaddr - Local, bound address of a connection. Used only if ripaddr
|
|
* is the broadcast address. Used only if CONFIG_NETDEV_MULTINIC.
|
|
* ripaddr - Remote address of a connection to use in the lookup
|
|
*
|
|
* Returned Value:
|
|
* Pointer to driver on success; null on failure
|
|
*
|
|
* Assumptions:
|
|
* Called from normal user mode
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_NET_IPv6
|
|
#ifdef CONFIG_NETDEV_MULTINIC
|
|
FAR struct net_driver_s *netdev_findby_ipv6addr(const net_ipv6addr_t lipaddr,
|
|
const net_ipv6addr_t ripaddr)
|
|
#else
|
|
FAR struct net_driver_s *netdev_findby_ipv6addr(const net_ipv6addr_t ripaddr)
|
|
#endif
|
|
{
|
|
struct net_driver_s *dev;
|
|
#ifdef CONFIG_NET_ROUTE
|
|
net_ipv6addr_t router;
|
|
int ret;
|
|
#endif
|
|
|
|
/* First, check if this is the multicast IP address We should actually
|
|
* pick off certain multicast address (all hosts multicast address, and
|
|
* the solicited-node multicast address). We will cheat here and accept
|
|
* all multicast packets that are destined for the ff02::/16 addresses.
|
|
*/
|
|
|
|
if (ripaddr[0] == HTONS(0xff02))
|
|
{
|
|
#ifdef CONFIG_NETDEV_MULTINIC
|
|
/* Yes.. Check the local, bound address. Is it INADDR_ANY? */
|
|
|
|
if (net_ipv6addr_cmp(lipaddr, g_ipv6_allzeroaddr))
|
|
{
|
|
/* Yes.. In this case, I think we are supposed to send the
|
|
* broadcast packet out ALL local networks. I am not sure
|
|
* of that and, in any event, there is nothing we can do
|
|
* about that here.
|
|
*
|
|
* REVISIT: For now, arbitrarily return the first network
|
|
* interface in the list of network devices. The broadcast
|
|
* will be sent on that device only.
|
|
*/
|
|
|
|
return g_netdevices;
|
|
}
|
|
else
|
|
{
|
|
/* Return the device associated with the local address */
|
|
|
|
return netdev_finddevice_ipv6addr(lipaddr);
|
|
}
|
|
#else
|
|
/* If there is only a single, registered network interface, then the
|
|
* decision is pretty easy.
|
|
*/
|
|
|
|
return g_netdevices;
|
|
#endif
|
|
}
|
|
|
|
/* Check if the address maps to a local network */
|
|
|
|
dev = netdev_finddevice_ipv6addr(ripaddr);
|
|
if (dev)
|
|
{
|
|
return dev;
|
|
}
|
|
|
|
/* No.. The address lies on an external network */
|
|
|
|
#ifdef CONFIG_NET_ROUTE
|
|
/* If we have a routing table, then perhaps we can find the local
|
|
* address of a router that can forward packets to the external network.
|
|
*/
|
|
|
|
ret = net_ipv6_router(ripaddr, router);
|
|
if (ret >= 0)
|
|
{
|
|
/* Success... try to find the network device associated with the local
|
|
* router address
|
|
*/
|
|
|
|
dev = netdev_finddevice_ipv6addr(router);
|
|
if (dev)
|
|
{
|
|
return dev;
|
|
}
|
|
}
|
|
#endif /* CONFIG_NET_ROUTE */
|
|
|
|
/* The above lookup will fail if the packet is being sent out of our
|
|
* out subnet to a router and there is no routing information.
|
|
*/
|
|
|
|
#ifndef CONFIG_NETDEV_MULTINIC
|
|
/* If there is only a single, registered network interface, then the
|
|
* decision is pretty easy. Use that device and its default router
|
|
* address.
|
|
*/
|
|
|
|
dev = g_netdevices;
|
|
#endif
|
|
|
|
/* If we will did not find the network device, then we might as well fail
|
|
* because we are not configured properly to determine the route to the
|
|
* destination.
|
|
*/
|
|
|
|
return dev;
|
|
}
|
|
#endif /* CONFIG_NET_IPv6 */
|
|
|
|
#endif /* CONFIG_NET && CONFIG_NSOCKET_DESCRIPTORS */
|