diff options
Diffstat (limited to 'rtemsbsd/rtems')
-rw-r--r-- | rtemsbsd/rtems/rtems-bsd-set-if-input.c | 71 |
1 files changed, 71 insertions, 0 deletions
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); +} |