diff options
author | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2017-06-21 14:35:19 +0200 |
---|---|---|
committer | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2017-10-23 09:24:06 +0200 |
commit | e846288593f42b90aa4b726badafc747a5ecdbf4 (patch) | |
tree | 40518df299a5a185f981a22477aefb3d7c6372a9 /rtemsbsd | |
parent | 07c868087282cbe8462f8da296b94acd7fe6fe54 (diff) |
Add rtems_bsd_set_if_input()
Diffstat (limited to 'rtemsbsd')
-rw-r--r-- | rtemsbsd/include/rtems/bsd/zerocopy.h | 25 | ||||
-rw-r--r-- | rtemsbsd/rtems/rtems-bsd-set-if-input.c | 71 |
2 files changed, 95 insertions, 1 deletions
diff --git a/rtemsbsd/include/rtems/bsd/zerocopy.h b/rtemsbsd/include/rtems/bsd/zerocopy.h index 2916c5ba..b15333c4 100644 --- a/rtemsbsd/include/rtems/bsd/zerocopy.h +++ b/rtemsbsd/include/rtems/bsd/zerocopy.h @@ -7,7 +7,7 @@ */ /* - * Copyright (c) 2015 embedded brains GmbH. All rights reserved. + * Copyright (c) 2015, 2017 embedded brains GmbH. All rights reserved. * * embedded brains GmbH * Dornierstr. 4 @@ -61,6 +61,29 @@ void rtems_bsd_m_free(struct mbuf *m); int rtems_bsd_sendto(int socket, struct mbuf *m, int flags, const struct sockaddr *dest_addr); +struct ifnet; + +typedef void (*rtems_bsd_if_input_init)(struct ifnet *, void *); + +typedef void (*rtems_bsd_if_input)(struct ifnet *, struct mbuf *); + +/** + * @brief Sets the interface input handler of the specified network interface. + * + * @param ifname The network interface name. + * @param init Initialization routine called right before the new interface + * input handler is registered in the context of the executing thread. + * @param if_input The new interface input handler. + * @param arg The interface input handler argument available via struct + * ifnet::if_input_arg. + * + * @retval NULL An error occurred. + * @retval other The old interface input handler. + */ +rtems_bsd_if_input rtems_bsd_set_if_input(const char *ifname, + rtems_bsd_if_input_init init, rtems_bsd_if_input if_input, + void *arg); + #ifdef __cplusplus } #endif /* __cplusplus */ diff --git a/rtemsbsd/rtems/rtems-bsd-set-if-input.c b/rtemsbsd/rtems/rtems-bsd-set-if-input.c new file mode 100644 index 00000000..f864ae99 --- /dev/null +++ b/rtemsbsd/rtems/rtems-bsd-set-if-input.c @@ -0,0 +1,71 @@ +/* + * Copyright (c) 2017 embedded brains GmbH. All rights reserved. + * + * embedded brains GmbH + * Dornierstr. 4 + * 82178 Puchheim + * Germany + * <rtems@embedded-brains.de> + * + * 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. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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. + */ + +#include <sys/types.h> +#include <sys/ioctl.h> +#include <sys/socket.h> + +#include <net/if.h> +#include <net/if_var.h> + +#include <string.h> +#include <unistd.h> + +#include <rtems/bsd/zerocopy.h> + +rtems_bsd_if_input +rtems_bsd_set_if_input(const char *ifname, + rtems_bsd_if_input_init init, rtems_bsd_if_input if_input, void *arg) +{ + struct rtems_ifinputreq ifr; + int s; + int rv; + + s = socket(AF_INET, SOCK_DGRAM, 0); + if (s < 0) { + return (NULL); + } + + memset(&ifr, 0, sizeof(ifr)); + strlcpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name)); + ifr.arg = arg; + ifr.init = init; + ifr.new_if_input = if_input; + + rv = ioctl(s, RTEMS_SIOSIFINPUT, (caddr_t)&ifr); + close(s); + + if (rv != 0) { + return (NULL); + } + + return (ifr.old_if_input); +} |