/**************************************************************************** * net/ipforward/ipfwd_forward.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 "devif/devif.h" #include "netdev/netdev.h" #include "arp/arp.h" #include "neighbor/neighbor.h" #include "ipforward/ipforward.h" #ifdef CONFIG_NET_IPFORWARD /**************************************************************************** * Public Functions ****************************************************************************/ /**************************************************************************** * Name: forward_ipselect * * Description: * If both IPv4 and IPv6 support are enabled, then we will need to select * which one to use when generating the outgoing packet. If only one * domain is selected, then the setup is already in place and we need do * nothing. * * Input Parameters: * fwd - The forwarding state structure * * Returned Value: * None * * Assumptions: * The network is locked. * ****************************************************************************/ #if defined(CONFIG_NET_IPv4) && defined(CONFIG_NET_IPv6) static inline void forward_ipselect(FAR struct forward_s *fwd) { FAR struct net_driver_s *dev = fwd->f_dev; /* Select IPv4 or IPv6 */ if (fwd->f_domain == PF_INET) { /* Clear a bit in the d_flags to distinguish this from an IPv6 packet */ IFF_SET_IPv4(dev->d_flags); /* Set the offset to the beginning of the UDP data payload */ dev->d_appdata = &dev->d_buf[IPv4UDP_HDRLEN + NET_LL_HDRLEN(dev)]; } else { /* Set a bit in the d_flags to distinguish this from an IPv6 packet */ IFF_SET_IPv6(dev->d_flags); /* Set the offset to the beginning of the UDP data payload */ dev->d_appdata = &dev->d_buf[IPv6_HDRLEN + NET_LL_HDRLEN(dev)]; } } #endif /**************************************************************************** * Name: ipfwd_eventhandler * * Description: * This function is called with the network locked to perform the actual * send operation when polled by the lower, device interfacing layer. * * Input Parameters: * dev The structure of the network driver that generated the * event * conn An instance of the forwarding structure cast to (void *) * pvpriv An instance of struct forward_s cast to (void *) * flags Set of events describing why the callback was invoked * * Returned Value: * Modified value of the input flags * * Assumptions: * The network is locked * ****************************************************************************/ static uint16_t ipfwd_eventhandler(FAR struct net_driver_s *dev, FAR void *conn, FAR void *pvpriv, uint16_t flags) { FAR struct forward_s *fwd = (FAR struct forward_s *)pvpriv; ninfo("flags: %04x\n", flags); DEBUGASSERT(fwd != NULL && fwd->f_iob != NULL && fwd->f_dev != NULL); /* Make sure that this is from the forwarding device */ if (dev == fwd->f_dev) { /* If the network device has gone down, then we will have terminate * the wait now with an error. */ if ((flags & NETDEV_DOWN) != 0) { /* Terminate the transfer with an error. */ nwarn("WARNING: Network is down... Dropping\n"); ipfwd_dropstats(fwd); } /* Check if the outgoing packet is available. It may have been claimed * by a sendto event handler serving a different thread -OR- if the * output buffer currently contains unprocessed incoming data. In * these cases we will just have to wait for the next polling cycle. */ else if (dev->d_sndlen > 0 || (flags & IPFWD_NEWDATA) != 0) { /* Another thread has beat us sending data or the buffer is busy, * Wait for the next polling cycle and check again. */ return flags; } /* It looks like we are good to forward the data */ else { #if defined(CONFIG_NET_IPv4) && defined(CONFIG_NET_IPv6) /* If both IPv4 and IPv6 support are enabled, then we will need to * select which one to use when generating the outgoing packet. * If only one domain is selected, then the setup is already in * place and we need do nothing. */ forward_ipselect(fwd); #endif /* Copy the user data into d_appdata and send it. */ devif_forward(fwd); flags &= ~DEVPOLL_MASK; } /* Free the allocated callback structure */ fwd->f_cb->flags = 0; fwd->f_cb->priv = NULL; fwd->f_cb->event = NULL; ipfwd_callback_free(dev, fwd->f_cb); /* Free any IOBs */ if (fwd->f_iob != NULL) { iob_free_chain(fwd->f_iob, IOBUSER_NET_IPFORWARD); } /* And release the forwarding state structure */ ipfwd_free(fwd); } return flags; } /**************************************************************************** * Public Functions ****************************************************************************/ /**************************************************************************** * Name: ipfwd_forward * * Description: * Called by the IP forwarding logic when a packet is received on one * network device, but must be forwarded on another network device. * * Set up to forward the packet on the specified device. This function * will set up a send event handler that will perform the actual send * asynchronously and must return without waiting for the send to * complete. * * Input Parameters: * fwd - An initialized instance of the common forwarding structure that * includes everything needed to perform the forwarding operation. * * Returned Value: * Zero is returned if the packet was successfully forwarded; A negated * errno value is returned if the packet is not forwardable. In that * latter case, the caller should free the IOB list and drop the packet. * ****************************************************************************/ int ipfwd_forward(FAR struct forward_s *fwd) { DEBUGASSERT(fwd != NULL && fwd->f_iob != NULL && fwd->f_dev != NULL); /* Set up the callback in the connection */ fwd->f_cb = ipfwd_callback_alloc(fwd->f_dev); if (fwd->f_cb != NULL) { fwd->f_cb->flags = (IPFWD_POLL | NETDEV_DOWN); fwd->f_cb->priv = (FAR void *)fwd; fwd->f_cb->event = ipfwd_eventhandler; /* Notify the device driver of the availability of TX data */ netdev_txnotify_dev(fwd->f_dev); return OK; } return -EBUSY; } #endif /* CONFIG_NET_IPFORWARD */