| /**************************************************************************** |
| * net/netdev/netdev_ioctl.c |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| * |
| * 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 <nuttx/config.h> |
| |
| #include <sys/socket.h> |
| #include <sys/ioctl.h> |
| |
| #include <assert.h> |
| #include <debug.h> |
| #include <errno.h> |
| #include <stdio.h> |
| #include <string.h> |
| |
| #include <nuttx/net/net.h> |
| #include <nuttx/net/ip.h> |
| |
| #include <net/if.h> |
| #include <net/route.h> |
| #include <net/ethernet.h> |
| #include <netinet/in.h> |
| |
| #include <nuttx/net/netdev.h> |
| #include <nuttx/net/radiodev.h> |
| |
| #ifdef CONFIG_NET_6LOWPAN |
| # include <nuttx/net/sixlowpan.h> |
| #endif |
| |
| #include <sys/sockio.h> |
| #include <nuttx/net/igmp.h> |
| |
| #ifdef CONFIG_NETDEV_WIRELESS_IOCTL |
| # include <nuttx/wireless/wireless.h> |
| #endif |
| |
| #ifdef CONFIG_WIRELESS_BLUETOOTH |
| # include <nuttx/wireless/bluetooth/bt_ioctl.h> |
| #endif |
| |
| #ifdef CONFIG_WIRELESS_IEEE802154 |
| # include <nuttx/wireless/ieee802154/ieee802154_mac.h> |
| #endif |
| |
| #ifdef CONFIG_WIRELESS_PKTRADIO |
| # include <nuttx/wireless/pktradio.h> |
| #endif |
| |
| #ifdef CONFIG_NET_CELLULAR |
| # include <nuttx/wireless/cellular/cellular.h> |
| #endif |
| |
| #ifdef CONFIG_NETDEV_MODEM_LTE_IOCTL |
| # include <nuttx/wireless/lte/lte_ioctl.h> |
| #endif |
| |
| #include "arp/arp.h" |
| #include "socket/socket.h" |
| #include "netdev/netdev.h" |
| #include "devif/devif.h" |
| #include "igmp/igmp.h" |
| #include "icmpv6/icmpv6.h" |
| #include "route/route.h" |
| #include "netlink/netlink.h" |
| #include "utils/utils.h" |
| |
| /**************************************************************************** |
| * Pre-processor Definitions |
| ****************************************************************************/ |
| |
| /* Configuration */ |
| |
| #undef HAVE_WRITABLE_IPv4ROUTE |
| #undef HAVE_WRITABLE_IPv6ROUTE |
| |
| #ifdef CONFIG_NET_ROUTE |
| # if defined(CONFIG_NET_IPv4) && !defined(CONFIG_ROUTE_IPv4_ROMROUTE) |
| # define HAVE_WRITABLE_IPv4ROUTE 1 |
| # endif |
| |
| # if defined(CONFIG_NET_IPv6) && !defined(CONFIG_ROUTE_IPv6_ROMROUTE) |
| # define HAVE_WRITABLE_IPv6ROUTE 1 |
| # endif |
| #endif |
| |
| #undef HAVE_IEEE802154_IOCTL |
| #undef HAVE_PKTRADIO_IOCTL |
| #undef HAVE_BLUETOOTH_IOCTL |
| |
| #ifdef CONFIG_NETDEV_IOCTL |
| /* IEEE 802.15.4 6LoWPAN or raw packet support */ |
| |
| #if defined(CONFIG_NET_IEEE802154) || (defined(CONFIG_NET_6LOWPAN) && \ |
| defined(CONFIG_WIRELESS_IEEE802154)) |
| # define HAVE_IEEE802154_IOCTL 1 |
| #endif |
| |
| /* pktradio raw packet support not implemented */ |
| |
| #if defined(CONFIG_NET_6LOWPAN) && defined(CONFIG_WIRELESS_PKTRADIO) |
| # define HAVE_PKTRADIO_IOCTL 1 |
| #endif |
| |
| /* Bluetooth 6LoWPAN support not implemented */ |
| |
| #if defined(CONFIG_NET_BLUETOOTH) |
| # define HAVE_BLUETOOTH_IOCTL 1 |
| #endif |
| #endif /* CONFIG_NETDEV_IOCTL */ |
| |
| /**************************************************************************** |
| * Private Functions |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Name: ioctl_add_ipv4route |
| * |
| * Description: |
| * Add an IPv4 route to the routing table. |
| * |
| * Input Parameters: |
| * rentry - Describes the route to be added |
| * |
| ****************************************************************************/ |
| |
| #ifdef HAVE_WRITABLE_IPv4ROUTE |
| static int ioctl_add_ipv4route(FAR struct rtentry *rtentry) |
| { |
| FAR struct sockaddr_in *addr; |
| in_addr_t target; |
| in_addr_t netmask; |
| in_addr_t router; |
| |
| addr = (FAR struct sockaddr_in *)&rtentry->rt_dst; |
| target = (in_addr_t)addr->sin_addr.s_addr; |
| |
| addr = (FAR struct sockaddr_in *)&rtentry->rt_genmask; |
| netmask = (in_addr_t)addr->sin_addr.s_addr; |
| |
| addr = (FAR struct sockaddr_in *)&rtentry->rt_gateway; |
| router = (in_addr_t)addr->sin_addr.s_addr; |
| |
| return net_addroute_ipv4(target, netmask, router); |
| } |
| #endif /* HAVE_WRITABLE_IPv4ROUTE */ |
| |
| /**************************************************************************** |
| * Name: ioctl_add_ipv6route |
| * |
| * Description: |
| * Add an IPv6 route to the routing table. |
| * |
| * Input Parameters: |
| * rentry - Describes the route to be added |
| * |
| ****************************************************************************/ |
| |
| #ifdef HAVE_WRITABLE_IPv6ROUTE |
| static int ioctl_add_ipv6route(FAR struct rtentry *rtentry) |
| { |
| FAR struct sockaddr_in6 *target; |
| FAR struct sockaddr_in6 *netmask; |
| FAR struct sockaddr_in6 *gateway; |
| net_ipv6addr_t router; |
| |
| target = (FAR struct sockaddr_in6 *)&rtentry->rt_dst; |
| netmask = (FAR struct sockaddr_in6 *)&rtentry->rt_genmask; |
| |
| /* The router is an optional argument */ |
| |
| gateway = (FAR struct sockaddr_in6 *)&rtentry->rt_gateway; |
| net_ipv6addr_copy(router, gateway->sin6_addr.s6_addr16); |
| |
| return net_addroute_ipv6(target->sin6_addr.s6_addr16, |
| netmask->sin6_addr.s6_addr16, router); |
| } |
| #endif /* HAVE_WRITABLE_IPv6ROUTE */ |
| |
| /**************************************************************************** |
| * Name: ioctl_del_ipv4route |
| * |
| * Description: |
| * Delete an IPv4 route to the routing table. |
| * |
| * Input Parameters: |
| * rentry - Describes the route to be deleted |
| * |
| ****************************************************************************/ |
| |
| #ifdef HAVE_WRITABLE_IPv4ROUTE |
| static int ioctl_del_ipv4route(FAR struct rtentry *rtentry) |
| { |
| FAR struct sockaddr_in *addr; |
| in_addr_t target; |
| in_addr_t netmask; |
| |
| addr = (FAR struct sockaddr_in *)&rtentry->rt_dst; |
| target = (in_addr_t)addr->sin_addr.s_addr; |
| |
| addr = (FAR struct sockaddr_in *)&rtentry->rt_genmask; |
| netmask = (in_addr_t)addr->sin_addr.s_addr; |
| |
| return net_delroute_ipv4(target, netmask); |
| } |
| #endif /* HAVE_WRITABLE_IPv4ROUTE */ |
| |
| /**************************************************************************** |
| * Name: ioctl_del_ipv6route |
| * |
| * Description: |
| * Delete an IPv6 route to the routing table. |
| * |
| * Input Parameters: |
| * rentry - Describes the route to be deleted |
| * |
| ****************************************************************************/ |
| |
| #ifdef HAVE_WRITABLE_IPv6ROUTE |
| static int ioctl_del_ipv6route(FAR struct rtentry *rtentry) |
| { |
| FAR struct sockaddr_in6 *target; |
| FAR struct sockaddr_in6 *netmask; |
| |
| target = (FAR struct sockaddr_in6 *)&rtentry->rt_dst; |
| netmask = (FAR struct sockaddr_in6 *)&rtentry->rt_genmask; |
| |
| return net_delroute_ipv6(target->sin6_addr.s6_addr16, |
| netmask->sin6_addr.s6_addr16); |
| } |
| #endif /* HAVE_WRITABLE_IPv6ROUTE */ |
| |
| /**************************************************************************** |
| * Name: ioctl_get_ipv4addr |
| * |
| * Description: |
| * Copy IP addresses from device structure to user memory. |
| * |
| * Input Parameters: |
| * outaddr - Pointer to the user-provided memory to receive the address. |
| * inaddr - The source IP address in the device structure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_IPv4 |
| static void ioctl_get_ipv4addr(FAR struct sockaddr *outaddr, |
| in_addr_t inaddr) |
| { |
| FAR struct sockaddr_in *dest = (FAR struct sockaddr_in *)outaddr; |
| dest->sin_family = AF_INET; |
| dest->sin_port = 0; |
| dest->sin_addr.s_addr = inaddr; |
| memset(dest->sin_zero, 0, sizeof(dest->sin_zero)); |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: ioctl_get_ipv4broadcast |
| * |
| * Description: |
| * Return the sub-net broadcast address to user memory. |
| * |
| * Input Parameters: |
| * outaddr - Pointer to the user-provided memory to receive the address. |
| * inaddr - The source IP address in the device structure. |
| * netmask - The netmask address mask in the device structure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_IPv4 |
| static void ioctl_get_ipv4broadcast(FAR struct sockaddr *outaddr, |
| in_addr_t inaddr, in_addr_t netmask) |
| { |
| FAR struct sockaddr_in *dest = (FAR struct sockaddr_in *)outaddr; |
| dest->sin_family = AF_INET; |
| dest->sin_port = 0; |
| dest->sin_addr.s_addr = net_ipv4addr_broadcast(inaddr, netmask); |
| memset(dest->sin_zero, 0, sizeof(dest->sin_zero)); |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: ioctl_get_ipv6addr |
| * |
| * Description: |
| * Copy IP addresses from device structure to user memory. |
| * |
| * Input Parameters: |
| * outaddr - Pointer to the user-provided memory to receive the address. |
| * inaddr - The source IP address in the device structure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_IPv6 |
| static void ioctl_get_ipv6addr(FAR struct sockaddr_storage *outaddr, |
| FAR const net_ipv6addr_t inaddr) |
| { |
| FAR struct sockaddr_in6 *dest = (FAR struct sockaddr_in6 *)outaddr; |
| dest->sin6_family = AF_INET6; |
| dest->sin6_port = 0; |
| memcpy(dest->sin6_addr.in6_u.u6_addr8, inaddr, 16); |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: ioctl_set_ipv4addr |
| * |
| * Description: |
| * Copy IP addresses from user memory into the device structure |
| * |
| * Input Parameters: |
| * outaddr - Pointer to the source IP address in the device structure. |
| * inaddr - Pointer to the user-provided memory to containing the new IP |
| * address. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_IPv4 |
| static void ioctl_set_ipv4addr(FAR in_addr_t *outaddr, |
| FAR const struct sockaddr *inaddr) |
| { |
| FAR const struct sockaddr_in *src = (FAR const struct sockaddr_in *)inaddr; |
| *outaddr = src->sin_addr.s_addr; |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: ioctl_set_ipv6addr |
| * |
| * Description: |
| * Copy IP addresses from user memory into the device structure |
| * |
| * Input Parameters: |
| * outaddr - Pointer to the source IP address in the device structure. |
| * inaddr - Pointer to the user-provided memory to containing the new IP |
| * address. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_IPv6 |
| static void ioctl_set_ipv6addr(FAR net_ipv6addr_t outaddr, |
| FAR const struct sockaddr_storage *inaddr) |
| { |
| FAR const struct sockaddr_in6 *src = |
| (FAR const struct sockaddr_in6 *)inaddr; |
| memcpy(outaddr, src->sin6_addr.in6_u.u6_addr8, 16); |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: netdev_bluetooth_ioctl |
| * |
| * Description: |
| * Perform Bluetooth network device specific operations. |
| * |
| * Input Parameters: |
| * psock - Socket structure |
| * dev - Ethernet driver device structure |
| * cmd - The ioctl command |
| * req - The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef HAVE_BLUETOOTH_IOCTL |
| static int netdev_bluetooth_ioctl(FAR struct socket *psock, int cmd, |
| unsigned long arg) |
| { |
| FAR struct net_driver_s *dev; |
| FAR char *ifname; |
| int ret = -EINVAL; |
| |
| if (arg != 0ul) |
| { |
| if (_BLUETOOTHIOCVALID(cmd)) |
| { |
| /* Get the name of the Bluetooth device to receive the IOCTL |
| * command |
| */ |
| |
| FAR struct btreq_s *btreq = |
| (FAR struct btreq_s *)((uintptr_t)arg); |
| |
| ifname = btreq->btr_name; |
| } |
| else |
| { |
| /* Not a Bluetooth IOCTL command */ |
| |
| return -ENOTTY; |
| } |
| |
| /* Find the device with this name */ |
| |
| dev = netdev_findbyname(ifname); |
| ret = -ENODEV; |
| |
| if (dev != NULL && dev->d_lltype == NET_LL_BLUETOOTH) |
| { |
| /* Perform the device IOCTL */ |
| |
| ret = dev->d_ioctl(dev, cmd, arg); |
| } |
| } |
| |
| return ret; |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: netdev_iee802154_ioctl |
| * |
| * Description: |
| * Perform IEEE802.15.4 network device specific operations. |
| * |
| * Input Parameters: |
| * psock - Socket structure |
| * dev - Ethernet driver device structure |
| * cmd - The ioctl command |
| * req - The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef HAVE_IEEE802154_IOCTL |
| static int netdev_iee802154_ioctl(FAR struct socket *psock, int cmd, |
| unsigned long arg) |
| { |
| FAR struct net_driver_s *dev; |
| FAR char *ifname; |
| int ret = -ENOTTY; |
| |
| if (arg != 0ul) |
| { |
| if (_MAC802154IOCVALID(cmd)) |
| { |
| /* Get the IEEE802.15.4 MAC device to receive the radio IOCTL |
| * command |
| */ |
| |
| FAR struct ieee802154_netmac_s *netmac = |
| (FAR struct ieee802154_netmac_s *)((uintptr_t)arg); |
| |
| ifname = netmac->ifr_name; |
| } |
| else |
| { |
| /* Not an EEE802.15.4 MAC IOCTL command */ |
| |
| return -ENOTTY; |
| } |
| |
| /* Find the device with this name */ |
| |
| dev = netdev_findbyname(ifname); |
| if (dev != NULL && dev->d_lltype == NET_LL_IEEE802154) |
| { |
| /* Perform the device IOCTL */ |
| |
| ret = dev->d_ioctl(dev, cmd, arg); |
| } |
| } |
| |
| return ret; |
| } |
| #endif /* HAVE_IEEE802154_IOCTL */ |
| |
| /**************************************************************************** |
| * Name: netdev_pktradio_ioctl |
| * |
| * Description: |
| * Perform non-IEEE802.15.4 packet radio network device specific operation. |
| * |
| * Input Parameters: |
| * psock - Socket structure |
| * dev - Ethernet driver device structure |
| * cmd - The ioctl command |
| * req - The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef HAVE_PKTRADIO_IOCTL |
| static int netdev_pktradio_ioctl(FAR struct socket *psock, int cmd, |
| unsigned long arg) |
| { |
| FAR struct net_driver_s *dev; |
| FAR char *ifname; |
| int ret = -ENOTTY; |
| |
| if (arg != 0ul) |
| { |
| if (_PKRADIOIOCVALID(cmd)) |
| { |
| /* Get the packet radio device to receive the radio IOCTL |
| * command |
| */ |
| |
| FAR struct pktradio_ifreq_s *cmddata = |
| (FAR struct pktradio_ifreq_s *)((uintptr_t)arg); |
| |
| ifname = cmddata->pifr_name; |
| } |
| else |
| { |
| /* Not a packet radio IOCTL command */ |
| |
| nwarn("WARNING: Not a packet radio IOCTL command: %d\n", cmd); |
| return -ENOTTY; |
| } |
| |
| /* Find the device with this name */ |
| |
| dev = netdev_findbyname(ifname); |
| if (dev != NULL && dev->d_lltype == NET_LL_PKTRADIO) |
| { |
| /* Perform the device IOCTL */ |
| |
| ret = dev->d_ioctl(dev, cmd, arg); |
| } |
| } |
| |
| return ret; |
| } |
| #endif /* HAVE_PKTRADIO_IOCTL */ |
| |
| /**************************************************************************** |
| * Name: netdev_cell_ioctl |
| * |
| * Description: |
| * Perform cell ioctl operations. |
| * |
| * Parameters: |
| * psock Socket structure |
| * cmd The ioctl command |
| * arg The argument of the ioctl cmd |
| * |
| * Return: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| #if defined(CONFIG_NETDEV_IOCTL) && defined(CONFIG_NET_CELLULAR) |
| static int netdev_cell_ioctl(FAR struct socket *psock, int cmd, |
| FAR struct icellreq *req) |
| { |
| FAR struct net_driver_s *dev = NULL; |
| int ret = -ENOTTY; |
| |
| ninfo("cmd: %d\n", cmd); |
| net_lock(); |
| |
| if (_CELLIOCVALID(cmd)) |
| { |
| dev = netdev_findbyname(req->ifr_name); |
| if (dev && dev->d_ioctl) |
| { |
| ret = dev->d_ioctl(dev, cmd, (unsigned long)(uintptr_t)req); |
| } |
| } |
| |
| net_unlock(); |
| return ret; |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: netdev_wifr_ioctl |
| * |
| * Description: |
| * Perform wireless network device specific operations. |
| * |
| * Input Parameters: |
| * psock Socket structure |
| * dev Ethernet driver device structure |
| * cmd The ioctl command |
| * req The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| #if defined(CONFIG_NETDEV_IOCTL) && defined(CONFIG_NETDEV_WIRELESS_IOCTL) |
| static int netdev_wifr_ioctl(FAR struct socket *psock, int cmd, |
| FAR struct iwreq *req) |
| { |
| FAR struct net_driver_s *dev; |
| int ret = -ENOTTY; |
| |
| /* Verify that this is a valid wireless network IOCTL command */ |
| |
| if (_WLIOCVALID(cmd)) |
| { |
| /* Get the wireless device associated with the IOCTL command */ |
| |
| dev = netdev_findbyname(req->ifr_name); |
| if (cmd == SIOCGIWNAME) |
| { |
| if (dev == NULL) |
| { |
| ret = -ENODEV; |
| } |
| else |
| { |
| strcpy((FAR char *)&req->u, "IEEE 802.11"); |
| ret = OK; |
| } |
| } |
| |
| if (dev != NULL && ret == -ENOTTY) |
| { |
| /* Just forward the IOCTL to the wireless driver */ |
| |
| ret = dev->d_ioctl(dev, cmd, (unsigned long)(uintptr_t)req); |
| } |
| } |
| |
| return ret; |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: netdev_ifr_split_idx |
| * |
| * Description: |
| * Split the address index from device name like 'eth0:0'. |
| * |
| * Input Parameters: |
| * req - The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * The address index from device name. |
| * |
| ****************************************************************************/ |
| |
| static unsigned int netdev_ifr_split_idx(FAR struct ifreq *req) |
| { |
| FAR char *colon = strchr(req->ifr_name, ':'); |
| int idx; |
| |
| if (colon) |
| { |
| *colon++ = '\0'; /* Remove suffix from device name */ |
| idx = atoi(colon); |
| return idx >= 0 ? idx + 1 : 0; /* eth0:0 represents the second addr */ |
| } |
| |
| return 0; |
| } |
| |
| /**************************************************************************** |
| * Name: net_ioctl_ifreq_arglen |
| * |
| * Description: |
| * Calculate the ioctl argument buffer length of ifreq. |
| * |
| * Input Parameters: |
| * domain The socket domain |
| * cmd The ioctl command |
| * |
| * Returned Value: |
| * The argument buffer length, or error code. |
| * |
| ****************************************************************************/ |
| |
| static ssize_t net_ioctl_ifreq_arglen(uint8_t domain, int cmd) |
| { |
| switch (cmd) |
| { |
| case SIOCGIFADDR: |
| case SIOCGIFDSTADDR: |
| case SIOCSIFDSTADDR: |
| case SIOCGIFBRDADDR: |
| case SIOCSIFBRDADDR: |
| case SIOCGIFNETMASK: |
| case SIOCSIFNETMASK: |
| case SIOCSIFMTU: |
| case SIOCGIFMTU: |
| case SIOCGIFHWADDR: |
| case SIOCSIFHWADDR: |
| case SIOCGIFCOUNT: |
| case SIOCSIFFLAGS: |
| case SIOCGIFFLAGS: |
| case SIOCMIINOTIFY: |
| case SIOCGMIIPHY: |
| case SIOCGMIIREG: |
| case SIOCSMIIREG: |
| case SIOCGCANBITRATE: |
| case SIOCSCANBITRATE: |
| case SIOCACANEXTFILTER: |
| case SIOCDCANEXTFILTER: |
| case SIOCACANSTDFILTER: |
| case SIOCDCANSTDFILTER: |
| case SIOCCANRECOVERY: |
| case SIOCSIFNAME: |
| case SIOCGIFNAME: |
| case SIOCGIFINDEX: |
| return sizeof(struct ifreq); |
| |
| case SIOCSIFADDR: |
| case SIOCDIFADDR: |
| return domain == PF_INET6 ? |
| sizeof(struct in6_ifreq) : sizeof(struct ifreq); |
| |
| case SIOCGLIFADDR: |
| case SIOCSLIFADDR: |
| case SIOCGLIFDSTADDR: |
| case SIOCSLIFDSTADDR: |
| case SIOCGLIFBRDADDR: |
| case SIOCSLIFBRDADDR: |
| case SIOCGLIFNETMASK: |
| case SIOCSLIFNETMASK: |
| case SIOCGLIFMTU: |
| case SIOCIFAUTOCONF: |
| return sizeof(struct lifreq); |
| default: |
| break; |
| } |
| |
| return -ENOTTY; |
| } |
| |
| /**************************************************************************** |
| * Name: netdev_ifr_ioctl |
| * |
| * Description: |
| * Perform network device specific operations. |
| * |
| * Input Parameters: |
| * psock Socket structure |
| * cmd The ioctl command |
| * req The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| static int netdev_ifr_ioctl(FAR struct socket *psock, int cmd, |
| FAR struct ifreq *req) |
| { |
| FAR struct net_driver_s *dev = NULL; |
| unsigned int idx = 0; |
| int ret = OK; |
| |
| ninfo("cmd: %d\n", cmd); |
| |
| net_lock(); |
| |
| /* Execute commands that do not need ifr_name or lifr_name */ |
| |
| switch (cmd) |
| { |
| case SIOCGIFCOUNT: /* Get number of devices */ |
| req->ifr_count = netdev_count(); |
| break; |
| |
| #ifdef CONFIG_NET_IPv4 |
| case SIOCGIFCONF: /* Return an interface list (IPv4) */ |
| ret = netdev_ipv4_ifconf((FAR struct ifconf *)req); |
| break; |
| #endif |
| |
| #ifdef CONFIG_NET_IPv6 |
| case SIOCGLIFCONF: /* Return an interface list (IPv6) */ |
| ret = netdev_ipv6_ifconf((FAR struct lifconf *)req); |
| break; |
| #endif |
| |
| #ifdef CONFIG_NETDEV_IFINDEX |
| case SIOCSIFNAME: /* Set interface name */ |
| { |
| FAR struct net_driver_s *tmpdev; |
| tmpdev = netdev_findbyindex(req->ifr_ifindex); |
| if (tmpdev != NULL) |
| { |
| strlcpy(tmpdev->d_ifname, req->ifr_name, IFNAMSIZ); |
| } |
| else |
| { |
| ret = -ENODEV; |
| } |
| } |
| break; |
| |
| case SIOCGIFNAME: /* Get interface name */ |
| { |
| FAR struct net_driver_s *tmpdev; |
| tmpdev = netdev_findbyindex(req->ifr_ifindex); |
| if (tmpdev != NULL) |
| { |
| strlcpy(req->ifr_name, tmpdev->d_ifname, IFNAMSIZ); |
| } |
| else |
| { |
| ret = -ENODEV; |
| } |
| } |
| break; |
| #endif |
| default: |
| if (req == NULL) |
| { |
| net_unlock(); |
| return -ENOTTY; |
| } |
| |
| if (net_ioctl_ifreq_arglen(psock->s_domain, cmd) |
| >= (ssize_t)sizeof(struct ifreq)) |
| { |
| idx = netdev_ifr_split_idx(req); |
| UNUSED(idx); |
| dev = netdev_findbyname(req->ifr_name); |
| } |
| else if (net_ioctl_ifreq_arglen(psock->s_domain, cmd) |
| == (ssize_t)sizeof(struct in6_ifreq)) |
| { |
| FAR struct in6_ifreq *ifr6 = (FAR struct in6_ifreq *)req; |
| dev = netdev_findbyindex(ifr6->ifr6_ifindex); |
| } |
| |
| if (dev == NULL) |
| { |
| ret = -ENOTTY; |
| } |
| break; |
| } |
| |
| if (dev == NULL) |
| { |
| net_unlock(); |
| return ret; |
| } |
| |
| /* Execute commands that need ifr_name or lifr_name */ |
| |
| switch (cmd) |
| { |
| #ifdef CONFIG_NET_IPv4 |
| case SIOCGIFADDR: /* Get IP address */ |
| ioctl_get_ipv4addr(&req->ifr_addr, dev->d_ipaddr); |
| break; |
| |
| case SIOCGIFDSTADDR: /* Get P-to-P address */ |
| ioctl_get_ipv4addr(&req->ifr_dstaddr, dev->d_draddr); |
| break; |
| |
| case SIOCSIFDSTADDR: /* Set P-to-P address */ |
| ioctl_set_ipv4addr(&dev->d_draddr, &req->ifr_dstaddr); |
| break; |
| |
| case SIOCGIFBRDADDR: /* Get broadcast IP address */ |
| ioctl_get_ipv4broadcast(&req->ifr_broadaddr, dev->d_ipaddr, |
| dev->d_netmask); |
| break; |
| |
| case SIOCSIFBRDADDR: /* Set broadcast IP address */ |
| ret = -ENOSYS; |
| break; |
| |
| case SIOCGIFNETMASK: /* Get network mask */ |
| ioctl_get_ipv4addr(&req->ifr_addr, dev->d_netmask); |
| break; |
| |
| case SIOCSIFNETMASK: /* Set network mask */ |
| ioctl_set_ipv4addr(&dev->d_netmask, &req->ifr_addr); |
| break; |
| #endif |
| |
| #ifdef CONFIG_NET_IPv6 |
| case SIOCGLIFADDR: /* Get IP address */ |
| { |
| FAR struct lifreq *lreq = (FAR struct lifreq *)req; |
| idx = MIN(idx, CONFIG_NETDEV_MAX_IPv6_ADDR - 1); |
| ioctl_get_ipv6addr(&lreq->lifr_addr, dev->d_ipv6[idx].addr); |
| } |
| break; |
| |
| case SIOCSLIFADDR: /* Set IP address */ |
| { |
| FAR struct lifreq *lreq = (FAR struct lifreq *)req; |
| idx = MIN(idx, CONFIG_NETDEV_MAX_IPv6_ADDR - 1); |
| |
| netdev_ipv6_removemcastmac(dev, dev->d_ipv6[idx].addr); |
| ioctl_set_ipv6addr(dev->d_ipv6[idx].addr, &lreq->lifr_addr); |
| netdev_ipv6_addmcastmac(dev, dev->d_ipv6[idx].addr); |
| |
| netlink_device_notify_ipaddr(dev, RTM_NEWADDR, AF_INET6, |
| dev->d_ipv6[idx].addr, net_ipv6_mask2pref(dev->d_ipv6[idx].mask)); |
| } |
| break; |
| |
| case SIOCGLIFDSTADDR: /* Get P-to-P address */ |
| { |
| FAR struct lifreq *lreq = (FAR struct lifreq *)req; |
| ioctl_get_ipv6addr(&lreq->lifr_dstaddr, dev->d_ipv6draddr); |
| } |
| break; |
| |
| case SIOCSLIFDSTADDR: /* Set P-to-P address */ |
| { |
| FAR struct lifreq *lreq = (FAR struct lifreq *)req; |
| ioctl_set_ipv6addr(dev->d_ipv6draddr, &lreq->lifr_dstaddr); |
| } |
| break; |
| |
| case SIOCGLIFBRDADDR: /* Get broadcast IP address */ |
| case SIOCSLIFBRDADDR: /* Set broadcast IP address */ |
| ret = -ENOSYS; |
| break; |
| |
| case SIOCGLIFNETMASK: /* Get network mask */ |
| { |
| FAR struct lifreq *lreq = (FAR struct lifreq *)req; |
| idx = MIN(idx, CONFIG_NETDEV_MAX_IPv6_ADDR - 1); |
| ioctl_get_ipv6addr(&lreq->lifr_addr, dev->d_ipv6[idx].mask); |
| } |
| break; |
| |
| case SIOCSLIFNETMASK: /* Set network mask */ |
| { |
| FAR struct lifreq *lreq = (FAR struct lifreq *)req; |
| idx = MIN(idx, CONFIG_NETDEV_MAX_IPv6_ADDR - 1); |
| ioctl_set_ipv6addr(dev->d_ipv6[idx].mask, &lreq->lifr_addr); |
| } |
| break; |
| #endif |
| |
| case SIOCGLIFMTU: /* Get MTU size */ |
| case SIOCGIFMTU: /* Get MTU size */ |
| req->ifr_mtu = NETDEV_PKTSIZE(dev) - dev->d_llhdrlen; |
| break; |
| case SIOCSIFMTU: /* Set MTU size */ |
| NETDEV_PKTSIZE(dev) = req->ifr_mtu + dev->d_llhdrlen; |
| break; |
| |
| #ifdef CONFIG_NET_ICMPv6_AUTOCONF |
| case SIOCIFAUTOCONF: /* Perform ICMPv6 auto-configuration */ |
| ret = icmpv6_autoconfig(dev); |
| break; |
| #endif |
| |
| case SIOCSIFFLAGS: /* Sets the interface flags */ |
| |
| /* Is this a request to bring the interface up? */ |
| |
| if ((req->ifr_flags & IFF_UP) != 0) |
| { |
| /* Yes.. bring the interface up */ |
| |
| ret = netdev_ifup(dev); |
| #ifdef CONFIG_NET_ARP_ACD |
| /* having address then start acd */ |
| |
| arp_acd_setup(dev); |
| #endif /* CONFIG_NET_ARP_ACD */ |
| } |
| else |
| { |
| /* Yes.. take the interface down */ |
| |
| ret = netdev_ifdown(dev); |
| } |
| break; |
| |
| case SIOCGIFFLAGS: /* Gets the interface flags */ |
| req->ifr_flags = dev->d_flags; |
| break; |
| |
| /* MAC address operations only make sense if Ethernet or 6LoWPAN are |
| * supported. |
| */ |
| |
| #if defined(CONFIG_NET_ETHERNET) || defined(CONFIG_NET_6LOWPAN) |
| case SIOCGIFHWADDR: /* Get hardware address */ |
| #ifdef CONFIG_NET_ETHERNET |
| if (dev->d_lltype == NET_LL_ETHERNET || |
| dev->d_lltype == NET_LL_IEEE80211) |
| { |
| req->ifr_hwaddr.sa_family = ARPHRD_ETHER; |
| memcpy(req->ifr_hwaddr.sa_data, |
| dev->d_mac.ether.ether_addr_octet, IFHWADDRLEN); |
| } |
| else |
| #endif |
| #ifdef CONFIG_NET_6LOWPAN |
| if (dev->d_lltype == NET_LL_IEEE802154 || |
| dev->d_lltype == NET_LL_PKTRADIO) |
| { |
| req->ifr_hwaddr.sa_family = ARPHRD_IEEE802154; |
| memcpy(req->ifr_hwaddr.sa_data, |
| dev->d_mac.radio.nv_addr, |
| dev->d_mac.radio.nv_addrlen); |
| } |
| else |
| #endif |
| { |
| nwarn("WARNING: Unsupported link layer\n"); |
| ret = -EAFNOSUPPORT; |
| } |
| break; |
| |
| case SIOCSIFHWADDR: /* Set hardware address -- will not take effect until ifup */ |
| #ifdef CONFIG_NET_ETHERNET |
| if (dev->d_lltype == NET_LL_ETHERNET || |
| dev->d_lltype == NET_LL_IEEE80211) |
| { |
| memcpy(dev->d_mac.ether.ether_addr_octet, |
| req->ifr_hwaddr.sa_data, IFHWADDRLEN); |
| } |
| else |
| #endif |
| #ifdef CONFIG_NET_6LOWPAN |
| if (dev->d_lltype == NET_LL_IEEE802154 || |
| dev->d_lltype == NET_LL_PKTRADIO) |
| { |
| FAR struct radio_driver_s *radio; |
| struct radiodev_properties_s properties; |
| |
| /* Get the radio properties */ |
| |
| radio = (FAR struct radio_driver_s *)dev; |
| DEBUGASSERT(radio->r_properties != NULL); |
| |
| ret = radio->r_properties(radio, &properties); |
| if (ret >= 0) |
| { |
| dev->d_mac.radio.nv_addrlen = properties.sp_addrlen; |
| |
| DEBUGASSERT(dev->d_mac.radio.nv_addrlen <= |
| sizeof(dev->d_mac.radio.nv_addr)); |
| DEBUGASSERT(dev->d_mac.radio.nv_addrlen <= |
| sizeof(req->ifr_hwaddr.sa_data)); |
| |
| memcpy(dev->d_mac.radio.nv_addr, |
| req->ifr_hwaddr.sa_data, dev->d_mac.radio.nv_addrlen); |
| } |
| } |
| else |
| #endif |
| { |
| nerr("Unsupported link layer\n"); |
| ret = -EAFNOSUPPORT; |
| } |
| break; |
| #endif |
| |
| case SIOCSIFADDR: /* Set IP address */ |
| #ifdef CONFIG_NET_IPv4 |
| if (psock->s_domain != PF_INET6) |
| { |
| if (net_ipv4addr_cmp(dev->d_ipaddr, |
| ((FAR struct sockaddr_in *)&req->ifr_addr)->sin_addr.s_addr)) |
| { |
| break; |
| } |
| |
| ioctl_set_ipv4addr(&dev->d_ipaddr, &req->ifr_addr); |
| netlink_device_notify_ipaddr(dev, RTM_NEWADDR, AF_INET, |
| &dev->d_ipaddr, net_ipv4_mask2pref(dev->d_netmask)); |
| |
| #ifdef CONFIG_NET_ARP_ACD |
| arp_acd_set_addr(dev); |
| #endif /* CONFIG_NET_ARP_ACD */ |
| } |
| #endif |
| |
| #ifdef CONFIG_NET_IPv6 |
| if (psock->s_domain == PF_INET6) |
| { |
| FAR struct in6_ifreq *ifr6 = (FAR struct in6_ifreq *)req; |
| ret = netdev_ipv6_add(dev, ifr6->ifr6_addr.in6_u.u6_addr16, |
| ifr6->ifr6_prefixlen); |
| if (ret == OK) |
| { |
| netlink_device_notify_ipaddr(dev, RTM_NEWADDR, AF_INET6, |
| ifr6->ifr6_addr.in6_u.u6_addr16, ifr6->ifr6_prefixlen); |
| } |
| } |
| #endif |
| break; |
| |
| case SIOCDIFADDR: /* Delete IP address */ |
| #ifdef CONFIG_NET_IPv4 |
| if (psock->s_domain != PF_INET6) |
| { |
| netlink_device_notify_ipaddr(dev, RTM_DELADDR, AF_INET, |
| &dev->d_ipaddr, net_ipv4_mask2pref(dev->d_netmask)); |
| dev->d_ipaddr = 0; |
| } |
| #endif |
| |
| #ifdef CONFIG_NET_IPv6 |
| if (psock->s_domain == PF_INET6) |
| { |
| FAR struct in6_ifreq *ifr6 = (FAR struct in6_ifreq *)req; |
| ret = netdev_ipv6_del(dev, ifr6->ifr6_addr.in6_u.u6_addr16, |
| ifr6->ifr6_prefixlen); |
| if (ret == OK) |
| { |
| netlink_device_notify_ipaddr(dev, RTM_DELADDR, AF_INET6, |
| ifr6->ifr6_addr.in6_u.u6_addr16, ifr6->ifr6_prefixlen); |
| } |
| } |
| #endif |
| break; |
| |
| #if defined(CONFIG_NETDEV_IOCTL) && defined(CONFIG_NETDEV_PHY_IOCTL) |
| #ifdef CONFIG_ARCH_PHY_INTERRUPT |
| case SIOCMIINOTIFY: /* Set up for PHY event notifications */ |
| if (dev->d_ioctl) |
| { |
| FAR struct mii_ioctl_notify_s *notify = |
| &req->ifr_ifru.ifru_mii_notify; |
| ret = dev->d_ioctl(dev, cmd, (unsigned long)(uintptr_t)notify); |
| } |
| else |
| { |
| ret = -ENOSYS; |
| } |
| break; |
| #endif |
| |
| case SIOCGMIIPHY: /* Get address of MII PHY in use */ |
| case SIOCGMIIREG: /* Get MII register via MDIO */ |
| case SIOCSMIIREG: /* Set MII register via MDIO */ |
| if (dev->d_ioctl) |
| { |
| FAR struct mii_ioctl_data_s *mii_data = |
| &req->ifr_ifru.ifru_mii_data; |
| ret = dev->d_ioctl(dev, cmd, |
| (unsigned long)(uintptr_t)mii_data); |
| } |
| else |
| { |
| ret = -ENOSYS; |
| } |
| break; |
| #endif |
| |
| #if defined(CONFIG_NETDEV_IOCTL) && defined(CONFIG_NETDEV_CAN_BITRATE_IOCTL) |
| case SIOCGCANBITRATE: /* Get bitrate from a CAN controller */ |
| case SIOCSCANBITRATE: /* Set bitrate of a CAN controller */ |
| if (dev->d_ioctl) |
| { |
| FAR struct can_ioctl_data_s *can_bitrate_data = |
| &req->ifr_ifru.ifru_can_data; |
| ret = dev->d_ioctl(dev, cmd, |
| (unsigned long)(uintptr_t)can_bitrate_data); |
| } |
| else |
| { |
| ret = -ENOSYS; |
| } |
| break; |
| #endif |
| |
| #if defined(CONFIG_NETDEV_IOCTL) && defined(CONFIG_NETDEV_CAN_FILTER_IOCTL) |
| case SIOCACANEXTFILTER: /* Add an extended-ID filter */ |
| case SIOCDCANEXTFILTER: /* Delete an extended-ID filter */ |
| case SIOCACANSTDFILTER: /* Add a standard-ID filter */ |
| case SIOCDCANSTDFILTER: /* Delete a standard-ID filter */ |
| case SIOCCANRECOVERY: /* Recovery can controller when bus-off */ |
| if (dev->d_ioctl) |
| { |
| FAR struct can_ioctl_filter_s *can_filter = |
| &req->ifr_ifru.ifru_can_filter; |
| ret = dev->d_ioctl(dev, cmd, |
| (unsigned long)(uintptr_t)can_filter); |
| } |
| else |
| { |
| ret = -ENOSYS; |
| } |
| break; |
| #endif |
| |
| #ifdef CONFIG_NETDEV_IFINDEX |
| case SIOCGIFINDEX: /* Index to name mapping */ |
| req->ifr_ifindex = dev->d_ifindex; |
| break; |
| #endif |
| |
| default: |
| ret = -ENOTTY; |
| break; |
| } |
| |
| net_unlock(); |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: netdev_imsfdev |
| * |
| * Description: |
| * Verify the struct ip_msfilter and get the Ethernet device. |
| * |
| * Input Parameters: |
| * req - The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * A pointer to the driver structure on success; NULL on failure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_IGMP |
| static FAR struct net_driver_s *netdev_imsfdev(FAR struct ip_msfilter *imsf) |
| { |
| if (imsf == NULL) |
| { |
| return NULL; |
| } |
| |
| /* Find the network device associated with the address of the IP address |
| * of the local device. |
| */ |
| |
| return netdev_findby_lipv4addr(imsf->imsf_interface.s_addr); |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: netdev_imsf_ioctl |
| * |
| * Description: |
| * Perform network device specific operations. |
| * |
| * Input Parameters: |
| * psock Socket structure |
| * dev Ethernet driver device structure |
| * cmd The ioctl command |
| * imsf The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_IGMP |
| static int netdev_imsf_ioctl(FAR struct socket *psock, int cmd, |
| FAR struct ip_msfilter *imsf) |
| { |
| FAR struct net_driver_s *dev; |
| int ret = -EINVAL; |
| |
| ninfo("cmd: %d\n", cmd); |
| |
| net_lock(); |
| |
| /* Execute the command */ |
| |
| switch (cmd) |
| { |
| case SIOCSIPMSFILTER: /* Set source filter content */ |
| { |
| dev = netdev_imsfdev(imsf); |
| if (dev) |
| { |
| if (imsf->imsf_fmode == MCAST_INCLUDE) |
| { |
| ret = igmp_joingroup(dev, &imsf->imsf_multiaddr); |
| } |
| else |
| { |
| DEBUGASSERT(imsf->imsf_fmode == MCAST_EXCLUDE); |
| ret = igmp_leavegroup(dev, &imsf->imsf_multiaddr); |
| } |
| } |
| } |
| break; |
| |
| case SIOCGIPMSFILTER: /* Retrieve source filter addresses */ |
| default: |
| ret = -ENOTTY; |
| break; |
| } |
| |
| net_unlock(); |
| return ret; |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: ioctl_arpreq_parse |
| * |
| * Description: |
| * Parse arpreq into netdev and sockaddr. |
| * |
| * Input Parameters: |
| * req The argument of the ioctl cmd |
| * dev The pointer to get ethernet driver device structure |
| * addr The pointer to get address in the request |
| * |
| * Returned Value: |
| * true on success and false on failure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_ARP |
| static bool ioctl_arpreq_parse(FAR struct arpreq *req, |
| FAR struct net_driver_s **dev, |
| FAR struct sockaddr_in **addr) |
| { |
| if (req != NULL) |
| { |
| *addr = (FAR struct sockaddr_in *)&req->arp_pa; |
| *dev = req->arp_dev[0] != '\0' ? |
| netdev_findbyname((FAR const char *)req->arp_dev) : |
| netdev_findby_ripv4addr(INADDR_ANY, (*addr)->sin_addr.s_addr); |
| return true; |
| } |
| |
| return false; |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: netdev_arp_ioctl |
| * |
| * Description: |
| * Perform ARP table specific operations. |
| * |
| * Input Parameters: |
| * psock Socket structure |
| * dev Ethernet driver device structure |
| * cmd The ioctl command |
| * req The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_ARP |
| static int netdev_arp_ioctl(FAR struct socket *psock, int cmd, |
| FAR struct arpreq *req) |
| { |
| FAR struct net_driver_s *dev; |
| FAR struct sockaddr_in *addr; |
| int ret; |
| |
| /* Execute the command */ |
| |
| switch (cmd) |
| { |
| case SIOCSARP: /* Set an ARP mapping */ |
| { |
| if (ioctl_arpreq_parse(req, &dev, &addr) && dev != NULL && |
| req->arp_pa.sa_family == AF_INET && |
| req->arp_ha.sa_family == ARPHRD_ETHER) |
| { |
| /* Update any existing ARP table entry for this protocol |
| * address -OR- add a new ARP table entry if there is not. |
| */ |
| |
| ret = arp_update(dev, addr->sin_addr.s_addr, |
| (FAR const uint8_t *)req->arp_ha.sa_data); |
| } |
| else |
| { |
| ret = -EINVAL; |
| } |
| } |
| break; |
| |
| case SIOCDARP: /* Delete an ARP mapping */ |
| { |
| if (ioctl_arpreq_parse(req, &dev, &addr) && dev != NULL && |
| req->arp_pa.sa_family == AF_INET) |
| { |
| /* Delete the ARP entry for this protocol address. */ |
| |
| ret = arp_delete(addr->sin_addr.s_addr, dev); |
| } |
| else |
| { |
| ret = -EINVAL; |
| } |
| } |
| break; |
| |
| case SIOCGARP: /* Get an ARP mapping */ |
| { |
| if (ioctl_arpreq_parse(req, &dev, &addr) && |
| req->arp_pa.sa_family == AF_INET) |
| { |
| ret = arp_find(addr->sin_addr.s_addr, |
| (FAR uint8_t *)req->arp_ha.sa_data, dev); |
| if (ret >= 0) |
| { |
| /* Return the mapped hardware address. */ |
| |
| req->arp_ha.sa_family = ARPHRD_ETHER; |
| ret = OK; |
| } |
| } |
| else |
| { |
| ret = -EINVAL; |
| } |
| } |
| break; |
| |
| default: |
| ret = -ENOTTY; |
| break; |
| } |
| |
| return ret; |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: netdev_rt_ioctl |
| * |
| * Description: |
| * Perform routing table specific operations. |
| * |
| * Input Parameters: |
| * psock Socket structure |
| * dev Ethernet driver device structure |
| * cmd The ioctl command |
| * rtentry The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_NET_ROUTE |
| static int netdev_rt_ioctl(FAR struct socket *psock, int cmd, |
| FAR struct rtentry *rtentry) |
| { |
| int ret = -EAFNOSUPPORT; |
| |
| /* Execute the command */ |
| |
| switch (cmd) |
| { |
| case SIOCADDRT: /* Add an entry to the routing table */ |
| { |
| /* The target address and the netmask are required values */ |
| |
| if (rtentry == NULL) |
| { |
| return -EINVAL; |
| } |
| |
| #ifdef CONFIG_NET_IPv4 |
| #ifdef CONFIG_NET_IPv6 |
| if (rtentry->rt_dst.ss_family == AF_INET) |
| #endif |
| { |
| #ifdef HAVE_WRITABLE_IPv4ROUTE |
| ret = ioctl_add_ipv4route(rtentry); |
| #else |
| ret = -EACCES; |
| #endif |
| } |
| #endif /* CONFIG_NET_IPv4 */ |
| |
| #ifdef CONFIG_NET_IPv6 |
| #ifdef CONFIG_NET_IPv4 |
| else |
| #endif |
| { |
| #ifdef HAVE_WRITABLE_IPv6ROUTE |
| ret = ioctl_add_ipv6route(rtentry); |
| #else |
| ret = -EACCES; |
| #endif |
| } |
| #endif /* CONFIG_NET_IPv6 */ |
| } |
| break; |
| |
| case SIOCDELRT: /* Delete an entry from the routing table */ |
| { |
| /* The target address and the netmask are required values */ |
| |
| if (rtentry == NULL) |
| { |
| return -EINVAL; |
| } |
| |
| #ifdef CONFIG_NET_IPv4 |
| #ifdef CONFIG_NET_IPv6 |
| if (rtentry->rt_dst.ss_family == AF_INET) |
| #endif |
| { |
| #ifdef HAVE_WRITABLE_IPv4ROUTE |
| ret = ioctl_del_ipv4route(rtentry); |
| #else |
| ret = -EACCES; |
| #endif |
| } |
| #endif /* CONFIG_NET_IPv4 */ |
| |
| #ifdef CONFIG_NET_IPv6 |
| #ifdef CONFIG_NET_IPv4 |
| else |
| #endif |
| { |
| #ifdef HAVE_WRITABLE_IPv6ROUTE |
| ret = ioctl_del_ipv6route(rtentry); |
| #else |
| ret = -EACCES; |
| #endif |
| } |
| #endif /* CONFIG_NET_IPv6 */ |
| } |
| break; |
| |
| default: |
| ret = -ENOTTY; |
| break; |
| } |
| |
| return ret; |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: netdev_ioctl |
| * |
| * Description: |
| * Perform user private ioctl operations. |
| * |
| * Parameters: |
| * psock Socket structure |
| * cmd The ioctl command |
| * arg The argument of the ioctl cmd |
| * |
| * Return: |
| * >=0 on success (positive non-zero values are cmd-specific) |
| * Negated errno returned on failure. |
| * |
| ****************************************************************************/ |
| |
| static int netdev_ioctl(FAR struct socket *psock, int cmd, |
| unsigned long arg) |
| { |
| int ret = -ENOTTY; |
| |
| if (psock->s_sockif && psock->s_sockif->si_ioctl) |
| { |
| ret = psock->s_sockif->si_ioctl(psock, cmd, arg); |
| } |
| |
| if (ret != OK && ret != -ENOTTY) |
| { |
| return ret; |
| } |
| |
| switch (cmd) |
| { |
| case FIONBIO: |
| { |
| FAR struct socket_conn_s *conn = psock->s_conn; |
| FAR int *nonblock = (FAR int *)(uintptr_t)arg; |
| sockcaps_t sockcaps; |
| |
| /* Non-blocking is the only configurable option. And it applies |
| * only Unix domain sockets and to read operations on TCP/IP |
| * and UDP/IP sockets when read-ahead is enabled. |
| */ |
| |
| DEBUGASSERT(psock->s_sockif != NULL && |
| psock->s_sockif->si_sockcaps != NULL); |
| sockcaps = psock->s_sockif->si_sockcaps(psock); |
| |
| if ((sockcaps & SOCKCAP_NONBLOCKING) != 0) |
| { |
| if (nonblock && *nonblock) |
| { |
| conn->s_flags |= _SF_NONBLOCK; |
| } |
| else |
| { |
| conn->s_flags &= ~_SF_NONBLOCK; |
| } |
| |
| ret = OK; |
| } |
| else |
| { |
| nerr("ERROR: Non-blocking not supported for this socket\n"); |
| ret = -ENOSYS; |
| } |
| } |
| |
| break; |
| |
| case FIOC_FILEPATH: |
| if (ret == -ENOTTY) |
| { |
| snprintf((FAR char *)(uintptr_t)arg, PATH_MAX, "socket:[" |
| "domain %" PRIu8 ", type %" PRIu8 ", proto %" PRIu8 "]", |
| psock->s_domain, psock->s_type, psock->s_proto); |
| ret = OK; |
| } |
| |
| break; |
| |
| default: |
| break; |
| } |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Public Functions |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Name: net_ioctl_arglen |
| * |
| * Description: |
| * Calculate the ioctl argument buffer length. |
| * |
| * Input Parameters: |
| * domain The socket domain |
| * cmd The ioctl command |
| * |
| * Returned Value: |
| * The argument buffer length, or error code. |
| * |
| ****************************************************************************/ |
| |
| ssize_t net_ioctl_arglen(uint8_t domain, int cmd) |
| { |
| ssize_t arglen; |
| |
| arglen = net_ioctl_ifreq_arglen(domain, cmd); |
| if (arglen > 0) |
| { |
| return arglen; |
| } |
| |
| switch (cmd) |
| { |
| case FIONBIO: |
| case FIONSPACE: |
| case FIONREAD: |
| return sizeof(int); |
| |
| case FIOC_FILEPATH: |
| return PATH_MAX; |
| |
| case SIOCGIFCONF: |
| return sizeof(struct ifconf); |
| |
| case SIOCGLIFCONF: |
| return sizeof(struct lifconf); |
| |
| case SIOCGIPMSFILTER: |
| case SIOCSIPMSFILTER: |
| return sizeof(struct ip_msfilter); |
| |
| case SIOCSARP: |
| case SIOCDARP: |
| case SIOCGARP: |
| return sizeof(struct arpreq); |
| |
| case SIOCADDRT: |
| case SIOCDELRT: |
| return sizeof(struct rtentry); |
| |
| case SIOCDENYINETSOCK: |
| return sizeof(uint8_t); |
| |
| default: |
| #ifdef CONFIG_NETDEV_IOCTL |
| # ifdef CONFIG_NETDEV_WIRELESS_IOCTL |
| if (_WLIOCVALID(cmd)) |
| { |
| return sizeof(struct iwreq); |
| } |
| # endif |
| |
| # ifdef CONFIG_WIRELESS_IEEE802154 |
| if (_MAC802154IOCVALID(cmd)) |
| { |
| return sizeof(struct ieee802154_netmac_s); |
| } |
| # endif |
| |
| # ifdef CONFIG_WIRELESS_PKTRADIO |
| if (_PKRADIOIOCVALID(cmd)) |
| { |
| return sizeof(struct pktradio_ifreq_s); |
| } |
| # endif |
| |
| # ifdef CONFIG_WIRELESS_BLUETOOTH |
| if (_BLUETOOTHIOCVALID(cmd)) |
| { |
| return sizeof(struct btreq_s); |
| } |
| # endif |
| |
| # ifdef CONFIG_NETDEV_MODEM_LTE_IOCTL |
| if (_LTEIOCVALID(cmd)) |
| { |
| switch (cmd) |
| { |
| case SIOCLTECMD: |
| return sizeof(struct lte_ioctl_data_s); |
| |
| default: |
| return sizeof(struct lte_smsreq_s); |
| } |
| } |
| # endif |
| #endif |
| |
| return -ENOTTY; |
| } |
| } |
| |
| /**************************************************************************** |
| * Name: psock_ioctl and psock_vioctl |
| * |
| * Description: |
| * Perform network device specific operations. |
| * |
| * Input Parameters: |
| * psock A pointer to a NuttX-specific, internal socket structure |
| * cmd The ioctl command |
| * arg The argument of the ioctl cmd |
| * |
| * Returned Value: |
| * A non-negative value is returned on success; a negated errno value is |
| * returned on any failure to indicate the nature of the failure: |
| * |
| * EBADF |
| * 'psock' is not a valid, connected socket structure. |
| * EFAULT |
| * 'arg' references an inaccessible memory area. |
| * ENOTTY |
| * 'cmd' not valid. |
| * EINVAL |
| * 'arg' is not valid. |
| * ENOTTY |
| * 'sockfd' is not associated with a network device. |
| * ENOTTY |
| * The specified request does not apply to the kind of object that the |
| * descriptor 'sockfd' references. |
| * |
| ****************************************************************************/ |
| |
| int psock_vioctl(FAR struct socket *psock, int cmd, va_list ap) |
| { |
| unsigned long arg; |
| int ret; |
| |
| /* Verify that the psock corresponds to valid, allocated socket */ |
| |
| if (psock == NULL || psock->s_conn == NULL) |
| { |
| return -EBADF; |
| } |
| |
| arg = va_arg(ap, unsigned long); |
| |
| /* Check for socket specific ioctl command */ |
| |
| ret = netdev_ioctl(psock, cmd, arg); |
| |
| /* Check for a standard network IOCTL command. */ |
| |
| if (ret == -ENOTTY) |
| { |
| ret = netdev_ifr_ioctl(psock, cmd, (FAR struct ifreq *)(uintptr_t)arg); |
| } |
| |
| #if defined(CONFIG_NETDEV_IOCTL) && defined(CONFIG_NETDEV_WIRELESS_IOCTL) |
| /* Check for a wireless network command */ |
| |
| if (ret == -ENOTTY) |
| { |
| FAR struct iwreq *wifrreq; |
| |
| wifrreq = (FAR struct iwreq *)((uintptr_t)arg); |
| ret = netdev_wifr_ioctl(psock, cmd, wifrreq); |
| } |
| #endif |
| |
| #if defined(CONFIG_NETDEV_IOCTL) && defined(CONFIG_NET_CELLULAR) |
| /* Check for a cellular network command */ |
| |
| if (ret == -ENOTTY) |
| { |
| ret = netdev_cell_ioctl(psock, cmd, |
| (FAR struct icellreq *)(uintptr_t)arg); |
| } |
| #endif |
| |
| #ifdef HAVE_IEEE802154_IOCTL |
| /* Check for a IEEE802.15.4 network device IOCTL command */ |
| |
| if (ret == -ENOTTY) |
| { |
| ret = netdev_iee802154_ioctl(psock, cmd, arg); |
| } |
| #endif |
| |
| #ifdef HAVE_PKTRADIO_IOCTL |
| /* Check for a non-IEEE802.15.4 packet radio network device IOCTL command */ |
| |
| if (ret == -ENOTTY) |
| { |
| ret = netdev_pktradio_ioctl(psock, cmd, arg); |
| } |
| #endif |
| |
| #ifdef HAVE_BLUETOOTH_IOCTL |
| /* Check for Bluetooth network device IOCTL command */ |
| |
| if (ret == -ENOTTY) |
| { |
| ret = netdev_bluetooth_ioctl(psock, cmd, arg); |
| } |
| #endif |
| |
| #ifdef CONFIG_NET_IGMP |
| /* Check for address filtering commands */ |
| |
| if (ret == -ENOTTY) |
| { |
| ret = netdev_imsf_ioctl(psock, cmd, |
| (FAR struct ip_msfilter *)(uintptr_t)arg); |
| } |
| #endif |
| |
| #ifdef CONFIG_NET_ARP |
| /* Check for ARP table IOCTL commands */ |
| |
| if (ret == -ENOTTY) |
| { |
| ret = netdev_arp_ioctl(psock, cmd, |
| (FAR struct arpreq *)(uintptr_t)arg); |
| } |
| #endif |
| |
| #ifdef CONFIG_NET_ROUTE |
| /* Check for Routing table IOCTL commands */ |
| |
| if (ret == -ENOTTY) |
| { |
| ret = netdev_rt_ioctl(psock, cmd, |
| (FAR struct rtentry *)(uintptr_t)arg); |
| } |
| #endif |
| |
| return ret; |
| } |
| |
| int psock_ioctl(FAR struct socket *psock, int cmd, ...) |
| { |
| va_list ap; |
| int ret; |
| |
| /* Setup to access the variable argument list */ |
| |
| va_start(ap, cmd); |
| |
| /* Let psock_vfcntl() do the real work. The errno is not set on |
| * failures. |
| */ |
| |
| ret = psock_vioctl(psock, cmd, ap); |
| |
| va_end(ap); |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: netdev_ifup / netdev_ifdown |
| * |
| * Description: |
| * Bring the interface up/down |
| * |
| ****************************************************************************/ |
| |
| int netdev_ifup(FAR struct net_driver_s *dev) |
| { |
| int ret = -ENOSYS; |
| |
| /* Make sure that the device supports the d_ifup() method */ |
| |
| if (dev->d_ifup != NULL) |
| { |
| /* Is the interface already up? */ |
| |
| if ((dev->d_flags & IFF_UP) == 0) |
| { |
| /* No, bring the interface up now */ |
| |
| if ((ret = dev->d_ifup(dev)) == OK) |
| { |
| /* Mark the interface as up */ |
| |
| dev->d_flags |= IFF_UP; |
| |
| /* Update the driver status */ |
| |
| netlink_device_notify(dev); |
| } |
| } |
| else |
| { |
| ret = OK; |
| } |
| } |
| |
| return ret; |
| } |
| |
| int netdev_ifdown(FAR struct net_driver_s *dev) |
| { |
| int ret = -ENOSYS; |
| |
| /* Check sure that the device supports the d_ifdown() method */ |
| |
| if (dev->d_ifdown != NULL) |
| { |
| /* Is the interface already down? */ |
| |
| if ((dev->d_flags & IFF_UP) != 0) |
| { |
| /* No, take the interface down now */ |
| |
| if ((ret = dev->d_ifdown(dev)) == OK) |
| { |
| /* Mark the interface as down */ |
| |
| dev->d_flags &= ~(IFF_UP | IFF_RUNNING); |
| |
| /* Update the driver status */ |
| |
| netlink_device_notify(dev); |
| |
| /* Notify clients that the network has been taken down */ |
| |
| devif_dev_event(dev, NETDEV_DOWN); |
| |
| #ifdef CONFIG_NETDOWN_NOTIFIER |
| /* Provide signal notifications to threads that want to be |
| * notified of the network down state via signal. |
| */ |
| |
| netdown_notifier_signal(dev); |
| #endif |
| } |
| } |
| else |
| { |
| ret = OK; |
| } |
| } |
| |
| return ret; |
| } |