summaryrefslogtreecommitdiff
path: root/components/net/netdev/src
diff options
context:
space:
mode:
Diffstat (limited to 'components/net/netdev/src')
-rw-r--r--components/net/netdev/src/netdev.c1232
-rw-r--r--components/net/netdev/src/netdev_ipaddr.c614
2 files changed, 1846 insertions, 0 deletions
diff --git a/components/net/netdev/src/netdev.c b/components/net/netdev/src/netdev.c
new file mode 100644
index 0000000000..aa43d8d3db
--- /dev/null
+++ b/components/net/netdev/src/netdev.c
@@ -0,0 +1,1232 @@
+/*
+ * Copyright (c) 2006-2019, RT-Thread Development Team
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date Author Notes
+ * 2019-03-18 ChenYong First version
+ */
+
+#include <stdio.h>
+#include <string.h>
+
+#include <rtthread.h>
+#include <rthw.h>
+
+#include <netdev_ipaddr.h>
+#include <netdev.h>
+
+#ifdef RT_USING_SAL
+#include <sal_netdb.h>
+#include <sal.h>
+#endif /* RT_USING_SAL */
+
+#define DBG_TAG "netdev"
+#define DBG_LVL DBG_INFO
+#include <rtdbg.h>
+
+/* The list of network interface device */
+struct netdev *netdev_list;
+/* The default network interface device */
+struct netdev *netdev_default;
+
+/**
+ * This function will register network interface device and
+ * add it to network interface device list.
+ *
+ * @param netdev the network interface device object
+ * @param name the network interface device name
+ * @param user_data user-specific data
+ *
+ * @return 0: registered successfully
+ * -1: registered failed
+ */
+int netdev_register(struct netdev *netdev, const char *name, void *user_data)
+{
+ rt_base_t level;
+ uint16_t flags_mask;
+ int index;
+
+ RT_ASSERT(netdev);
+ RT_ASSERT(name);
+
+ /* clean network interface device */
+ flags_mask = NETDEV_FLAG_UP | NETDEV_FLAG_LINK_UP | NETDEV_FLAG_INTERNET_UP | NETDEV_FLAG_DHCP;
+ netdev->flags &= ~flags_mask;
+
+ ip_addr_set_zero(&(netdev->ip_addr));
+ ip_addr_set_zero(&(netdev->netmask));
+ ip_addr_set_zero(&(netdev->gw));
+
+ IP_SET_TYPE_VAL(netdev->ip_addr, IPADDR_TYPE_V4);
+ IP_SET_TYPE_VAL(netdev->netmask, IPADDR_TYPE_V4);
+ IP_SET_TYPE_VAL(netdev->gw, IPADDR_TYPE_V4);
+#if NETDEV_IPV6
+ for (index = 0; index < NETDEV_IPV6_NUM_ADDRESSES; index++)
+ {
+ ip_addr_set_zero(&(netdev->ip6_addr[index]));
+ IP_SET_TYPE_VAL(netdev->ip_addr, IPADDR_TYPE_V6);
+ }
+#endif /* NETDEV_IPV6 */
+ for (index = 0; index < NETDEV_DNS_SERVERS_NUM; index++)
+ {
+ ip_addr_set_zero(&(netdev->dns_servers[index]));
+ IP_SET_TYPE_VAL(netdev->ip_addr, IPADDR_TYPE_V4);
+ }
+ netdev->status_callback = RT_NULL;
+ netdev->addr_callback = RT_NULL;
+
+ /* fill network interface device */
+ rt_strncpy(netdev->name, name, rt_strlen(name));
+ netdev->user_data = user_data;
+
+ /* initialize current network interface device single list */
+ rt_slist_init(&(netdev->list));
+
+ level = rt_hw_interrupt_disable();
+
+ if (netdev_list == RT_NULL)
+ {
+ netdev_list = netdev;
+ netdev_default = netdev;
+ }
+ else
+ {
+ /* tail insertion */
+ rt_slist_append(&(netdev_list->list), &(netdev->list));
+ }
+
+ rt_hw_interrupt_enable(level);
+
+ return RT_EOK;
+}
+
+/**
+ * This function will unregister network interface device and
+ * delete it from network interface device list.
+ *
+ * @param netdev the network interface device object
+ *
+ * @return 0: unregistered successfully
+ * -1: unregistered failed
+ */
+int netdev_unregister(struct netdev *netdev)
+{
+ rt_base_t level;
+ rt_slist_t *node = RT_NULL;
+ struct netdev *cur_netdev = RT_NULL;
+
+ RT_ASSERT(netdev);
+
+ if (netdev_list == RT_NULL)
+ {
+ return -RT_ERROR;
+ }
+
+ level = rt_hw_interrupt_disable();
+
+ for (node = &(netdev_list->list); node; node = rt_slist_next(node))
+ {
+ cur_netdev = rt_slist_entry(node, struct netdev, list);
+ if (cur_netdev == netdev)
+ {
+ /* find this network interface device in network interface device list */
+ if (netdev_list == netdev && rt_slist_next(&netdev_list->list) == RT_NULL)
+ {
+ netdev_list = RT_NULL;
+ }
+ else
+ {
+ rt_slist_remove(&(netdev_list->list), &(cur_netdev->list));
+ }
+ if (netdev_default == netdev)
+ {
+ netdev_default = netdev_list;
+ }
+ break;
+ }
+ }
+ rt_hw_interrupt_enable(level);
+
+ if (cur_netdev == netdev)
+ {
+#ifdef RT_USING_SAL
+ extern int sal_netdev_cleanup(struct netdev *netdev);
+ sal_netdev_cleanup(netdev);
+#endif
+ rt_memset(netdev, 0, sizeof(*netdev));
+ }
+
+ return -RT_ERROR;
+}
+
+/**
+ * This function will get the first network interface device
+ * with the flags in network interface device list.
+ *
+ * @param flags the network interface device flags
+ *
+ * @return != NULL: network interface device object
+ * NULL: get failed
+ */
+struct netdev *netdev_get_first_by_flags(uint16_t flags)
+{
+ rt_base_t level;
+ rt_slist_t *node = RT_NULL;
+ struct netdev *netdev = RT_NULL;
+
+ if (netdev_list == RT_NULL)
+ {
+ return RT_NULL;
+ }
+
+ level = rt_hw_interrupt_disable();
+
+ for (node = &(netdev_list->list); node; node = rt_slist_next(node))
+ {
+ netdev = rt_slist_entry(node, struct netdev, list);
+ if (netdev && (netdev->flags & flags) != 0)
+ {
+ rt_hw_interrupt_enable(level);
+ return netdev;
+ }
+ }
+
+ rt_hw_interrupt_enable(level);
+
+ return RT_NULL;
+}
+
+/**
+ * This function will get the first network interface device
+ * in network interface device list by IP address.
+ *
+ * @param addr the network interface device IP address
+ *
+ * @return != NULL: network interface device object
+ * NULL: get failed
+ */
+struct netdev *netdev_get_by_ipaddr(ip_addr_t *ip_addr)
+{
+ rt_base_t level;
+ rt_slist_t *node = RT_NULL;
+ struct netdev *netdev = RT_NULL;
+
+ if (netdev_list == RT_NULL)
+ {
+ return RT_NULL;
+ }
+
+ level = rt_hw_interrupt_disable();
+
+ for (node = &(netdev_list->list); node; node = rt_slist_next(node))
+ {
+ netdev = rt_slist_entry(node, struct netdev, list);
+ if (netdev && ip_addr_cmp(&(netdev->ip_addr), ip_addr))
+ {
+ rt_hw_interrupt_enable(level);
+ return netdev;
+ }
+ }
+
+ rt_hw_interrupt_enable(level);
+
+ return RT_NULL;
+}
+
+/**
+ * This function will get network interface device
+ * in network interface device list by netdev name.
+ *
+ * @param name the network interface device name
+ *
+ * @return != NULL: network interface device object
+ * NULL: get failed
+ */
+struct netdev *netdev_get_by_name(const char *name)
+{
+ rt_base_t level;
+ rt_slist_t *node = RT_NULL;
+ struct netdev *netdev = RT_NULL;
+
+ if (netdev_list == RT_NULL)
+ {
+ return RT_NULL;
+ }
+
+ level = rt_hw_interrupt_disable();
+
+ for (node = &(netdev_list->list); node; node = rt_slist_next(node))
+ {
+ netdev = rt_slist_entry(node, struct netdev, list);
+ if (netdev && (rt_strncmp(netdev->name, name, rt_strlen(netdev->name)) == 0))
+ {
+ rt_hw_interrupt_enable(level);
+ return netdev;
+ }
+ }
+
+ rt_hw_interrupt_enable(level);
+
+ return RT_NULL;
+}
+
+#ifdef RT_USING_SAL
+/**
+ * This function will get the first network interface device
+ * in network interface device list by protocol family type.
+ *
+ * @param family the network interface device protocol family type
+ *
+ * @return != NULL: network interface device object
+ * NULL: get failed
+ */
+struct netdev *netdev_get_by_family(int family)
+{
+ rt_base_t level;
+ rt_slist_t *node = RT_NULL;
+ struct netdev *netdev = RT_NULL;
+ struct sal_proto_family *pf = RT_NULL;
+
+ if (netdev_list == RT_NULL)
+ {
+ return RT_NULL;
+ }
+
+ level = rt_hw_interrupt_disable();
+
+ for (node = &(netdev_list->list); node; node = rt_slist_next(node))
+ {
+ netdev = rt_slist_entry(node, struct netdev, list);
+ pf = (struct sal_proto_family *) netdev->sal_user_data;
+ if (pf && pf->skt_ops && pf->family == family && netdev_is_up(netdev))
+ {
+ rt_hw_interrupt_enable(level);
+ return netdev;
+ }
+ }
+
+ for (node = &(netdev_list->list); node; node = rt_slist_next(node))
+ {
+ netdev = rt_slist_entry(node, struct netdev, list);
+ pf = (struct sal_proto_family *) netdev->sal_user_data;
+ if (pf && pf->skt_ops && pf->sec_family == family && netdev_is_up(netdev))
+ {
+ rt_hw_interrupt_enable(level);
+ return netdev;
+ }
+ }
+
+ rt_hw_interrupt_enable(level);
+
+ return RT_NULL;
+}
+
+/**
+ * This function will get the family type from network interface device
+ *
+ * @param netdev network interface device object
+ *
+ * @return the network interface device family type
+ */
+int netdev_family_get(struct netdev *netdev)
+{
+ RT_ASSERT(netdev);
+
+ return ((struct sal_proto_family *)netdev->sal_user_data)->family;
+}
+
+#endif /* RT_USING_SAL */
+
+/**
+ * This function will set default network interface device.
+ *
+ * @param netdev the network interface device to change
+ */
+void netdev_set_default(struct netdev *netdev)
+{
+ if (netdev)
+ {
+ netdev_default = netdev;
+
+ if (netdev->ops->set_default)
+ {
+ /* set default network interface device in the current network stack */
+ netdev->ops->set_default(netdev);
+ }
+ LOG_D("Setting default network interface device name(%s) successfully.", netdev->name);
+ }
+}
+
+/**
+ * This function will enable network interface device .
+ *
+ * @param netdev the network interface device to change
+ *
+ * @return 0: set status successfully
+ * -1: set status failed
+ */
+int netdev_set_up(struct netdev *netdev)
+{
+ RT_ASSERT(netdev);
+
+ if (!netdev->ops || !netdev->ops->set_up)
+ {
+ LOG_E("The network interface device(%s) not support to set status.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ /* network interface device status flags check */
+ if (netdev_is_up(netdev))
+ {
+ return RT_EOK;
+ }
+
+ /* execute enable network interface device operations by network interface device driver */
+ return netdev->ops->set_up(netdev);
+}
+/**
+ * This function will disable network interface device.
+ *
+ * @param netdev the network interface device to change
+ *
+ * @return 0: set status successfully
+ * -1: set sttaus failed
+ */
+int netdev_set_down(struct netdev *netdev)
+{
+ RT_ASSERT(netdev);
+
+ if (!netdev->ops || !netdev->ops->set_down)
+ {
+ LOG_E("The network interface device(%s) not support to set status.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ /* network interface device status flags check */
+ if (!netdev_is_up(netdev))
+ {
+ return RT_EOK;
+ }
+
+ /* execute disable network interface device operations by network interface driver */
+ return netdev->ops->set_down(netdev);
+}
+
+/**
+ * This function will control network interface device DHCP capability enable or disable.
+ *
+ * @param netdev the network interface device device to change
+ * @param is_enable the new DHCP status
+ *
+ * @return 0: set DHCP status successfully
+ * -1: set DHCP status failed
+ */
+int netdev_dhcp_enabled(struct netdev *netdev, rt_bool_t is_enabled)
+{
+ RT_ASSERT(netdev);
+
+ if (!netdev->ops || !netdev->ops->set_dhcp)
+ {
+ LOG_E("The network interface device(%s) not support to set DHCP status.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ /* network interface device DHCP flags check */
+ if (netdev_is_dhcp_enabled(netdev) == is_enabled)
+ {
+ return RT_EOK;
+ }
+
+ /* execute network interface device DHCP capability control operations */
+ return netdev->ops->set_dhcp(netdev, is_enabled);
+}
+
+/**
+ * This function will set network interface device IP address.
+ *
+ * @param netdev the network interface device to change
+ * @param ipaddr the new IP address
+ *
+ * @return 0: set IP address successfully
+ * -1: set IP address failed
+ */
+int netdev_set_ipaddr(struct netdev *netdev, const ip_addr_t *ip_addr)
+{
+ RT_ASSERT(netdev);
+ RT_ASSERT(ip_addr);
+
+ if (!netdev->ops || !netdev->ops->set_addr_info)
+ {
+ LOG_E("The network interface device(%s) not support to set IP address.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ if (netdev_is_dhcp_enabled(netdev))
+ {
+ LOG_E("The network interface device(%s) DHCP capability is enable, not support set IP address.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ /* execute network interface device set IP address operations */
+ return netdev->ops->set_addr_info(netdev, (ip_addr_t *)ip_addr, RT_NULL, RT_NULL);
+}
+
+/**
+ * This function will set network interface device netmask address.
+ *
+ * @param netdev the network interface device to change
+ * @param netmask the new netmask address
+ *
+ * @return 0: set netmask address successfully
+ * -1: set netmask address failed
+ */
+int netdev_set_netmask(struct netdev *netdev, const ip_addr_t *netmask)
+{
+ RT_ASSERT(netdev);
+ RT_ASSERT(netmask);
+
+ if (!netdev->ops || !netdev->ops->set_addr_info)
+ {
+ LOG_E("The network interface device(%s) not support to set netmask address.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ if (netdev_is_dhcp_enabled(netdev))
+ {
+ LOG_E("The network interface device(%s) DHCP capability is enable, not support set netmask address.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ /* execute network interface device set netmask address operations */
+ return netdev->ops->set_addr_info(netdev, RT_NULL, (ip_addr_t *)netmask, RT_NULL);
+}
+
+/**
+ * This function will set network interface device gateway address.
+ *
+ * @param netdev the network interface device to change
+ * @param gateway the new gateway address
+ *
+ * @return 0: set gateway address successfully
+ * -1: set gateway address failed
+ */
+int netdev_set_gw(struct netdev *netdev, const ip_addr_t *gw)
+{
+ RT_ASSERT(netdev);
+ RT_ASSERT(gw);
+
+ if (!netdev->ops || !netdev->ops->set_addr_info)
+ {
+ LOG_E("The network interface device(%s) not support to set gateway address.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ if (netdev_is_dhcp_enabled(netdev))
+ {
+ LOG_E("The network interface device(%s) DHCP capability is enable, not support set gateway address.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ /* execute network interface device set gateway address operations */
+ return netdev->ops->set_addr_info(netdev, RT_NULL, RT_NULL, (ip_addr_t *)gw);
+}
+
+/**
+ * This function will set network interface device DNS server address.
+ *
+ * @param netdev the network interface device to change
+ * @param dns_server the new DNS server address
+ *
+ * @return 0: set netmask address successfully
+ * -1: set netmask address failed
+ */
+int netdev_set_dns_server(struct netdev *netdev, uint8_t dns_num, const ip_addr_t *dns_server)
+{
+ RT_ASSERT(netdev);
+ RT_ASSERT(dns_server);
+
+ if (dns_num >= NETDEV_DNS_SERVERS_NUM)
+ {
+ LOG_E("The number of DNS servers(%d) set exceeds the maximum number(%d).", dns_num + 1, NETDEV_DNS_SERVERS_NUM);
+ return -RT_ERROR;
+ }
+
+ if (!netdev->ops || !netdev->ops->set_dns_server)
+ {
+ LOG_E("The network interface device(%s) not support to set DNS server address.", netdev->name);
+ return -RT_ERROR;
+ }
+
+ /* execute network interface device set DNS server address operations */
+ return netdev->ops->set_dns_server(netdev, dns_num, (ip_addr_t *)dns_server);
+}
+
+/**
+ * This function will set callback to be called when the network interface device status has been changed.
+ *
+ * @param netdev the network interface device to change
+ * @param status_callback the callback be called when the status has been changed.
+ */
+void netdev_set_status_callback(struct netdev *netdev, netdev_callback_fn status_callback)
+{
+ RT_ASSERT(netdev);
+ RT_ASSERT(status_callback);
+
+ netdev->status_callback = status_callback;
+}
+
+/**
+ * This function will set callback to be called when the network interface device address has been changed.
+ *
+ * @param netdev the network interface device to change
+ * @param addr_callback the callback be called when the address has been changed.
+ */
+void netdev_set_addr_callback(struct netdev *netdev, netdev_callback_fn addr_callback)
+{
+ RT_ASSERT(netdev);
+ RT_ASSERT(addr_callback);
+
+ netdev->addr_callback = addr_callback;
+}
+
+
+/**
+ * This function will set network interface device IP address.
+ * @NOTE it can only be called in the network interface device driver.
+ *
+ * @param netdev the network interface device to change
+ * @param ipaddr the new IP address
+ */
+void netdev_low_level_set_ipaddr(struct netdev *netdev, const ip_addr_t *ip_addr)
+{
+ RT_ASSERT(ip_addr);
+
+ if (netdev && ip_addr_cmp(&(netdev->ip_addr), ip_addr) == 0)
+ {
+ ip_addr_copy(netdev->ip_addr, *ip_addr);
+
+#ifdef RT_USING_SAL
+ /* set network interface device flags to internet up */
+ if (netdev_is_up(netdev) && netdev_is_link_up(netdev))
+ {
+ sal_check_netdev_internet_up(netdev);
+ }
+#endif /* RT_USING_SAL */
+
+ /* execute IP address change callback function */
+ if (netdev->addr_callback)
+ {
+ netdev->addr_callback(netdev, NETDEV_CB_ADDR_IP);
+ }
+ }
+}
+
+/**
+ * This function will set network interface device netmask address.
+ * @NOTE it can only be called in the network interface device driver.
+ *
+ * @param netdev the network interface device to change
+ * @param netmask the new netmask address
+ */
+void netdev_low_level_set_netmask(struct netdev *netdev, const ip_addr_t *netmask)
+{
+ RT_ASSERT(netmask);
+
+ if (netdev && ip_addr_cmp(&(netdev->netmask), netmask) == 0)
+ {
+ ip_addr_copy(netdev->netmask, *netmask);
+
+#ifdef RT_USING_SAL
+ /* set network interface device flags to internet up */
+ if (netdev_is_up(netdev) && netdev_is_link_up(netdev) &&
+ !ip_addr_isany(&(netdev->ip_addr)))
+ {
+ sal_check_netdev_internet_up(netdev);
+ }
+#endif /* RT_USING_SAL */
+
+ /* execute netmask address change callback function */
+ if (netdev->addr_callback)
+ {
+ netdev->addr_callback(netdev, NETDEV_CB_ADDR_NETMASK);
+ }
+ }
+}
+
+/**
+ * This function will set network interface device gateway address.
+ * @NOTE it can only be called in the network interface device driver.
+ *
+ * @param netdev the network interface device to change
+ * @param gateway the new gateway address
+ */
+void netdev_low_level_set_gw(struct netdev *netdev, const ip_addr_t *gw)
+{
+ RT_ASSERT(gw);
+
+ if (netdev && ip_addr_cmp(&(netdev->gw), gw) == 0)
+ {
+ ip_addr_copy(netdev->gw, *gw);
+
+#ifdef RT_USING_SAL
+ /* set network interface device flags to internet up */
+ if (netdev_is_up(netdev) && netdev_is_link_up(netdev) &&
+ !ip_addr_isany(&(netdev->ip_addr)))
+ {
+ sal_check_netdev_internet_up(netdev);
+ }
+#endif /* RT_USING_SAL */
+
+ /* execute gateway address change callback function */
+ if (netdev->addr_callback)
+ {
+ netdev->addr_callback(netdev, NETDEV_CB_ADDR_GATEWAY);
+ }
+ }
+}
+
+/**
+ * This function will set network interface device DNS server address.
+ * @NOTE it can only be called in the network interface device driver.
+ *
+ * @param netdev the network interface device to change
+ * @param dns_server the new DNS server address
+ *
+ */
+void netdev_low_level_set_dns_server(struct netdev *netdev, uint8_t dns_num, const ip_addr_t *dns_server)
+{
+ int index;
+
+ RT_ASSERT(dns_server);
+
+ if (netdev == RT_NULL)
+ {
+ return;
+ }
+ /* check DNS servers is exist */
+ for (index = 0; index < NETDEV_DNS_SERVERS_NUM; index++)
+ {
+ if (ip_addr_cmp(&(netdev->dns_servers[index]), dns_server))
+ {
+ return;
+ }
+ }
+
+ if (dns_num < NETDEV_DNS_SERVERS_NUM)
+ {
+ ip_addr_copy(netdev->dns_servers[dns_num], *dns_server);
+
+ /* execute DNS servers address change callback function */
+ if (netdev->addr_callback)
+ {
+ netdev->addr_callback(netdev, NETDEV_CB_ADDR_DNS_SERVER);
+ }
+ }
+}
+
+#ifdef NETDEV_USING_AUTO_DEFAULT
+/* Change to the first link_up network interface device automatically */
+static void netdev_auto_change_default(struct netdev *netdev)
+{
+ struct netdev *new_netdev = RT_NULL;
+
+ if (rt_memcmp(netdev, netdev_default, sizeof(struct netdev)) == 0)
+ {
+ new_netdev = netdev_get_first_by_flags(NETDEV_FLAG_LINK_UP);
+ if (new_netdev)
+ {
+ netdev_set_default(new_netdev);
+ }
+ }
+}
+#endif /* NETDEV_USING_AUTO_DEFAULT */
+
+/**
+ * This function will set network interface device status.
+ * @NOTE it can only be called in the network interface device driver.
+ *
+ * @param netdev the network interface device to change
+ * @param is_up the new status
+ */
+void netdev_low_level_set_status(struct netdev *netdev, rt_bool_t is_up)
+{
+ if (netdev && netdev_is_up(netdev) != is_up)
+ {
+ if (is_up)
+ {
+ netdev->flags |= NETDEV_FLAG_UP;
+ }
+ else
+ {
+ netdev->flags &= ~NETDEV_FLAG_UP;
+
+#ifdef NETDEV_USING_AUTO_DEFAULT
+ /* change to the first link_up network interface device automatically */
+ netdev_auto_change_default(netdev);
+#endif /* NETDEV_USING_AUTO_DEFAULT */
+ }
+
+ /* execute network interface device status change callback function */
+ if (netdev->status_callback)
+ {
+ netdev->status_callback(netdev, is_up ? NETDEV_CB_STATUS_UP : NETDEV_CB_STATUS_DOWN);
+ }
+ }
+}
+
+/**
+ * This function will set network interface device active link status.
+ * @NOTE it can only be called in the network interface device driver.
+ *
+ * @param netdev the network interface device to change
+ * @param is_up the new link status
+ */
+void netdev_low_level_set_link_status(struct netdev *netdev, rt_bool_t is_up)
+{
+ if (netdev && netdev_is_link_up(netdev) != is_up)
+ {
+ if (is_up)
+ {
+ netdev->flags |= NETDEV_FLAG_LINK_UP;
+
+#ifdef RT_USING_SAL
+ /* set network interface device flags to internet up */
+ if (netdev_is_up(netdev) && !ip_addr_isany(&(netdev->ip_addr)))
+ {
+ sal_check_netdev_internet_up(netdev);
+ }
+#endif /* RT_USING_SAL */
+ }
+ else
+ {
+ netdev->flags &= ~NETDEV_FLAG_LINK_UP;
+
+ /* set network interface device flags to internet down */
+ netdev->flags &= ~NETDEV_FLAG_INTERNET_UP;
+
+#ifdef NETDEV_USING_AUTO_DEFAULT
+ /* change to the first link_up network interface device automatically */
+ netdev_auto_change_default(netdev);
+#endif /* NETDEV_USING_AUTO_DEFAULT */
+ }
+
+ /* execute link status change callback function */
+ if (netdev->status_callback)
+ {
+ netdev->status_callback(netdev, is_up ? NETDEV_CB_STATUS_LINK_UP : NETDEV_CB_STATUS_LINK_DOWN);
+ }
+ }
+}
+
+/**
+ * This function will set network interface device DHCP status.
+ * @NOTE it can only be called in the network interface device driver.
+ *
+ * @param netdev the network interface device to change
+ * @param is_up the new DHCP status
+ */
+void netdev_low_level_set_dhcp_status(struct netdev *netdev, rt_bool_t is_enable)
+{
+ if (netdev && netdev_is_dhcp_enabled(netdev) != is_enable)
+ {
+ if (is_enable)
+ {
+ netdev->flags |= NETDEV_FLAG_DHCP;
+ }
+ else
+ {
+ netdev->flags &= ~NETDEV_FLAG_DHCP;
+ }
+
+ /* execute DHCP status change callback function */
+ if (netdev->status_callback)
+ {
+ netdev->status_callback(netdev, is_enable ? NETDEV_CB_STATUS_DHCP_ENABLE : NETDEV_CB_STATUS_DHCP_DISABLE);
+ }
+ }
+}
+
+#ifdef RT_USING_FINSH
+
+#include <finsh.h>
+
+#ifdef NETDEV_USING_IFCONFIG
+static void netdev_list_if(void)
+{
+#define NETDEV_IFCONFIG_MAC_MAX_LEN 6
+#define NETDEV_IFCONFIG_IEMI_MAX_LEN 8
+
+ rt_ubase_t index;
+ rt_slist_t *node = RT_NULL;
+ struct netdev *netdev = RT_NULL;
+ struct netdev *cur_netdev_list = netdev_list;
+
+ if (cur_netdev_list == RT_NULL)
+ {
+ rt_kprintf("ifconfig: network interface device list error.\n");
+ return;
+ }
+
+ for (node = &(cur_netdev_list->list); node; node = rt_slist_next(node))
+ {
+ netdev = rt_list_entry(node, struct netdev, list);
+
+ rt_kprintf("network interface device: %.*s%s\n",
+ RT_NAME_MAX, netdev->name,
+ (netdev == netdev_default) ? " (Default)" : "");
+ rt_kprintf("MTU: %d\n", netdev->mtu);
+
+ /* 6 - MAC address, 8 - IEMI */
+ if (netdev->hwaddr_len == NETDEV_IFCONFIG_MAC_MAX_LEN)
+ {
+ rt_kprintf("MAC: ");
+ for (index = 0; index < netdev->hwaddr_len; index++)
+ {
+ rt_kprintf("%02x ", netdev->hwaddr[index]);
+ }
+ }
+ else if (netdev->hwaddr_len == NETDEV_IFCONFIG_IEMI_MAX_LEN)
+ {
+ rt_kprintf("IMEI: ");
+ for (index = 0; index < netdev->hwaddr_len; index++)
+ {
+ /* two numbers are displayed at one time*/
+ if (netdev->hwaddr[index] < 10 && index != netdev->hwaddr_len - 1)
+ rt_kprintf("0");
+
+ rt_kprintf("%d", netdev->hwaddr[index]);
+ }
+ }
+
+ rt_kprintf("\nFLAGS:");
+ if (netdev->flags & NETDEV_FLAG_UP) rt_kprintf(" UP");
+ else rt_kprintf(" DOWN");
+ if (netdev->flags & NETDEV_FLAG_LINK_UP) rt_kprintf(" LINK_UP");
+ else rt_kprintf(" LINK_DOWN");
+ if (netdev->flags & NETDEV_FLAG_INTERNET_UP) rt_kprintf(" INTERNET_UP");
+ else rt_kprintf(" INTERNET_DOWN");
+ if (netdev->flags & NETDEV_FLAG_DHCP) rt_kprintf(" DHCP_ENABLE");
+ else rt_kprintf(" DHCP_DISABLE");
+ if (netdev->flags & NETDEV_FLAG_ETHARP) rt_kprintf(" ETHARP");
+ if (netdev->flags & NETDEV_FLAG_BROADCAST) rt_kprintf(" BROADCAST");
+ if (netdev->flags & NETDEV_FLAG_IGMP) rt_kprintf(" IGMP");
+ rt_kprintf("\n");
+ rt_kprintf("ip address: %s\n", inet_ntoa(netdev->ip_addr));
+ rt_kprintf("gw address: %s\n", inet_ntoa(netdev->gw));
+ rt_kprintf("net mask : %s\n", inet_ntoa(netdev->netmask));
+
+#if NETDEV_IPV6
+ {
+ ip_addr_t *addr;
+ int i;
+
+ addr = &netdev->ip6_addr[0];
+
+ if (!ip_addr_isany(addr))
+ {
+ rt_kprintf("ipv6 link-local: %s %s\n", inet_ntoa(*addr),
+ !ip_addr_isany(addr) ? "VALID" : "INVALID");
+
+ for (i = 1; i < NETDEV_IPV6_NUM_ADDRESSES; i++)
+ {
+ addr = &netdev->ip6_addr[i];
+ rt_kprintf("ipv6[%d] address: %s %s\n", i, inet_ntoa(*addr),
+ !ip_addr_isany(addr) ? "VALID" : "INVALID");
+ }
+ }
+ }
+#endif /* NETDEV_IPV6 */
+
+ for (index = 0; index < NETDEV_DNS_SERVERS_NUM; index++)
+ {
+ rt_kprintf("dns server #%d: %s\n", index, inet_ntoa(netdev->dns_servers[index]));
+ }
+
+ if (rt_slist_next(node))
+ {
+ rt_kprintf("\n");
+ }
+ }
+}
+
+static void netdev_set_if(char* netdev_name, char* ip_addr, char* gw_addr, char* nm_addr)
+{
+ struct netdev *netdev = RT_NULL;
+ ip_addr_t addr;
+
+ netdev = netdev_get_by_name(netdev_name);
+ if (netdev == RT_NULL)
+ {
+ rt_kprintf("bad network interface device name(%s).\n", netdev_name);
+ return;
+ }
+
+ /* set IP address */
+ if ((ip_addr != RT_NULL) && inet_aton(ip_addr, &addr))
+ {
+ netdev_set_ipaddr(netdev, &addr);
+ }
+
+ /* set gateway address */
+ if ((gw_addr != RT_NULL) && inet_aton(gw_addr, &addr))
+ {
+ netdev_set_gw(netdev, &addr);
+ }
+
+ /* set netmask address */
+ if ((nm_addr != RT_NULL) && inet_aton(nm_addr, &addr))
+ {
+ netdev_set_netmask(netdev, &addr);
+ }
+}
+
+int netdev_ifconfig(int argc, char **argv)
+{
+ if (argc == 1)
+ {
+ netdev_list_if();
+ }
+ else if (argc == 5)
+ {
+ rt_kprintf("config : %s\n", argv[1]);
+ rt_kprintf("IP addr: %s\n", argv[2]);
+ rt_kprintf("Gateway: %s\n", argv[3]);
+ rt_kprintf("netmask: %s\n", argv[4]);
+ netdev_set_if(argv[1], argv[2], argv[3], argv[4]);
+ }
+ else
+ {
+ rt_kprintf("bad parameter! e.g: ifconfig e0 192.168.1.30 192.168.1.1 255.255.255.0\n");
+ }
+
+ return 0;
+}
+FINSH_FUNCTION_EXPORT_ALIAS(netdev_ifconfig, __cmd_ifconfig, list the information of all network interfaces);
+#endif /* NETDEV_USING_IFCONFIG */
+
+#ifdef NETDEV_USING_PING
+int netdev_cmd_ping(char* target_name, rt_uint32_t times, rt_size_t size)
+{
+#define NETDEV_PING_DATA_SIZE 32
+/** ping receive timeout - in milliseconds */
+#define NETDEV_PING_RECV_TIMEO (2 * RT_TICK_PER_SECOND)
+/** ping delay - in milliseconds */
+#define NETDEV_PING_DELAY (1 * RT_TICK_PER_SECOND)
+/* check netdev ping options */
+#define NETDEV_PING_IS_COMMONICABLE(netdev) \
+ ((netdev) && (netdev)->ops && (netdev)->ops->ping && \
+ netdev_is_up(netdev) && netdev_is_link_up(netdev)) \
+
+ struct netdev *netdev = RT_NULL;
+ struct netdev_ping_resp ping_resp;
+ int index, ret = 0;
+
+ if (size == 0)
+ {
+ size = NETDEV_PING_DATA_SIZE;
+ }
+
+ if (NETDEV_PING_IS_COMMONICABLE(netdev_default))
+ {
+ /* using default network interface device for ping */
+ netdev = netdev_default;
+ }
+ else
+ {
+ /* using first internet up status network interface device */
+ netdev = netdev_get_first_by_flags(NETDEV_FLAG_LINK_UP);
+ if (netdev == RT_NULL)
+ {
+ rt_kprintf("ping: not found available network interface device.\n");
+ return -RT_ERROR;
+ }
+ else if (netdev->ops == RT_NULL || netdev->ops->ping == RT_NULL)
+ {
+ rt_kprintf("ping: network interface device(%s) not support ping feature.\n", netdev->name);
+ return -RT_ERROR;
+ }
+ else if (!netdev_is_up(netdev) || !netdev_is_link_up(netdev))
+ {
+ rt_kprintf("ping: network interface device(%s) status error.\n", netdev->name);
+ return -RT_ERROR;
+ }
+ }
+
+ for (index = 0; index < times; index++)
+ {
+ int delay_tick = 0;
+ rt_tick_t start_tick = 0;
+
+ rt_memset(&ping_resp, 0x00, sizeof(struct netdev_ping_resp));
+ start_tick = rt_tick_get();
+ ret = netdev->ops->ping(netdev, (const char *)target_name, size, NETDEV_PING_RECV_TIMEO, &ping_resp);
+ if (ret == -RT_ETIMEOUT)
+ {
+ rt_kprintf("ping: from %s icmp_seq=%d timeout\n",
+ (ip_addr_isany(&(ping_resp.ip_addr))) ? target_name : inet_ntoa(ping_resp.ip_addr), index);
+ }
+ else if (ret == -RT_ERROR)
+ {
+ rt_kprintf("ping: unknown %s %s\n",
+ (ip_addr_isany(&(ping_resp.ip_addr))) ? "host" : "address",
+ (ip_addr_isany(&(ping_resp.ip_addr))) ? target_name : inet_ntoa(ping_resp.ip_addr));
+ }
+ else
+ {
+ if (ping_resp.ttl == 0)
+ {
+ rt_kprintf("%d bytes from %s icmp_seq=%d time=%d ms\n",
+ ping_resp.data_len, inet_ntoa(ping_resp.ip_addr), index, ping_resp.ticks);
+ }
+ else
+ {
+ rt_kprintf("%d bytes from %s icmp_seq=%d ttl=%d time=%d ms\n",
+ ping_resp.data_len, inet_ntoa(ping_resp.ip_addr), index, ping_resp.ttl, ping_resp.ticks);
+ }
+ }
+
+ /* if the response time is more than NETDEV_PING_DELAY, no need to delay */
+ delay_tick = ((rt_tick_get() - start_tick) > NETDEV_PING_DELAY) || (index == times) ? 0 : NETDEV_PING_DELAY;
+ rt_thread_delay(delay_tick);
+ }
+
+ return RT_EOK;
+}
+
+int netdev_ping(int argc, char **argv)
+{
+ if (argc == 1)
+ {
+ rt_kprintf("Please input: ping <host address>\n");
+ }
+ else
+ {
+ netdev_cmd_ping(argv[1], 4, 0);
+ }
+
+ return 0;
+}
+FINSH_FUNCTION_EXPORT_ALIAS(netdev_ping, __cmd_ping, ping network host);
+#endif /* NETDEV_USING_IFCONFIG */
+
+static void netdev_list_dns(void)
+{
+ int index = 0;
+ struct netdev *netdev = RT_NULL;
+ rt_slist_t *node = RT_NULL;
+
+ for (node = &(netdev_list->list); node; node = rt_slist_next(node))
+ {
+ netdev = rt_list_entry(node, struct netdev, list);
+
+ rt_kprintf("network interface device: %.*s%s\n",
+ RT_NAME_MAX, netdev->name,
+ (netdev == netdev_default)?" (Default)":"");
+
+ for(index = 0; index < NETDEV_DNS_SERVERS_NUM; index++)
+ {
+ rt_kprintf("dns server #%d: %s\n", index, inet_ntoa(netdev->dns_servers[index]));
+ }
+
+ if (rt_slist_next(node))
+ {
+ rt_kprintf("\n");
+ }
+ }
+}
+
+static void netdev_set_dns(char *netdev_name, uint8_t dns_num, char *dns_server)
+{
+ struct netdev *netdev = RT_NULL;
+ ip_addr_t dns_addr;
+
+ netdev = netdev_get_by_name(netdev_name);
+ if (netdev == RT_NULL)
+ {
+ rt_kprintf("bad network interface device name(%s).\n", netdev_name);
+ return;
+ }
+
+ inet_aton(dns_server, &dns_addr);
+ if (netdev_set_dns_server(netdev, dns_num, &dns_addr) == RT_EOK)
+ {
+ rt_kprintf("set network interface device(%s) dns server #%d: %s\n", netdev_name, dns_num, dns_server);
+ }
+}
+
+int netdev_dns(int argc, char **argv)
+{
+ if (argc == 1)
+ {
+ netdev_list_dns();
+ }
+ else if (argc == 3)
+ {
+ netdev_set_dns(argv[1], 0, argv[2]);
+ }
+ else if (argc == 4)
+ {
+ netdev_set_dns(argv[1], atoi(argv[2]), argv[3]);
+ }
+ else
+ {
+ rt_kprintf("bad parameter! input: dns <netdev_name> [dns_num] <dns_server>\n");
+ return -1;
+ }
+
+ return 0;
+}
+FINSH_FUNCTION_EXPORT_ALIAS(netdev_dns, __cmd_dns, list and set the information of dns);
+
+#ifdef NETDEV_USING_NETSTAT
+static void netdev_cmd_netstat(void)
+{
+ rt_slist_t *node = RT_NULL;
+ struct netdev *netdev = RT_NULL;
+ struct netdev *cur_netdev_list = netdev_list;
+
+ if (cur_netdev_list == RT_NULL)
+ {
+ rt_kprintf("netstat: network interface device list error.\n");
+ return;
+ }
+
+ for (node = &(cur_netdev_list->list); node; node = rt_slist_next(node))
+ {
+ netdev = rt_list_entry(node, struct netdev, list);
+
+ if (netdev && netdev->ops && netdev->ops->netstat)
+ {
+ break;
+ }
+ }
+
+ if (netdev->ops->netstat != RT_NULL)
+ {
+ netdev->ops->netstat(netdev);
+ }
+ else
+ {
+ rt_kprintf("netstat: this command is not supported!\n");
+ }
+}
+
+int netdev_netstat(int argc, char **argv)
+{
+ if (argc != 1)
+ {
+ rt_kprintf("Please input: netstat \n");
+ }
+ else
+ {
+ netdev_cmd_netstat();
+ }
+
+ return 0;
+}
+FINSH_FUNCTION_EXPORT_ALIAS(netdev_netstat, __cmd_netstat, list the information of TCP / IP);
+#endif /* NETDEV_USING_NETSTAT */
+
+#endif /* RT_USING_FINSH */
diff --git a/components/net/netdev/src/netdev_ipaddr.c b/components/net/netdev/src/netdev_ipaddr.c
new file mode 100644
index 0000000000..a70a90bb75
--- /dev/null
+++ b/components/net/netdev/src/netdev_ipaddr.c
@@ -0,0 +1,614 @@
+/*
+ * Copyright (c) 2006-2018, RT-Thread Development Team
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date Author Notes
+ * 2018-05-18 ChenYong First version
+ */
+
+#include <rtthread.h>
+#include <netdev_ipaddr.h>
+
+/* Here for now until needed in other places in lwIP */
+#ifndef isprint
+#define in_range(c, lo, up) ((uint8_t)c >= lo && (uint8_t)c <= up)
+#define isprint(c) in_range(c, 0x20, 0x7f)
+#define isdigit(c) in_range(c, '0', '9')
+#define isxdigit(c) (isdigit(c) || in_range(c, 'a', 'f') || in_range(c, 'A', 'F'))
+#define islower(c) in_range(c, 'a', 'z')
+#define isspace(c) (c == ' ' || c == '\f' || c == '\n' || c == '\r' || c == '\t' || c == '\v')
+#define xchar(i) ((i) < 10 ? '0' + (i) : 'A' + (i) - 10)
+#endif
+
+#if NETDEV_IPV4
+
+/**
+ * Check whether "cp" is a valid ascii representation
+ * of an Internet address and convert to a binary address.
+ * Returns 1 if the address is valid, 0 if not.
+ * This replaces inet_addr, the return value from which
+ * cannot distinguish between failure and a local broadcast address.
+ *
+ * @param cp IP address in ascii representation (e.g. "127.0.0.1")
+ * @param addr pointer to which to save the ip address in network order
+ * @return 1 if cp could be converted to addr, 0 on failure
+ */
+int netdev_ip4addr_aton(const char *cp, ip4_addr_t *addr)
+{
+ uint32_t val;
+ uint8_t base;
+ char c;
+ uint32_t parts[4];
+ uint32_t *pp = parts;
+
+ c = *cp;
+ for (;;)
+ {
+ /*
+ * Collect number up to ``.''.
+ * Values are specified as for C:
+ * 0x=hex, 0=octal, 1-9=decimal.
+ */
+ if (!isdigit(c))
+ {
+ return 0;
+ }
+ val = 0;
+ base = 10;
+ if (c == '0')
+ {
+ c = *++cp;
+ if (c == 'x' || c == 'X')
+ {
+ base = 16;
+ c = *++cp;
+ }
+ else
+ {
+ base = 8;
+ }
+ }
+ for (;;)
+ {
+ if (isdigit(c))
+ {
+ val = (val * base) + (uint32_t) (c - '0');
+ c = *++cp;
+ }
+ else if (base == 16 && isxdigit(c))
+ {
+ val = (val << 4) | (uint32_t) (c + 10 - (islower(c) ? 'a' : 'A'));
+ c = *++cp;
+ }
+ else
+ {
+ break;
+ }
+ }
+ if (c == '.')
+ {
+ /*
+ * Internet format:
+ * a.b.c.d
+ * a.b.c (with c treated as 16 bits)
+ * a.b (with b treated as 24 bits)
+ */
+ if (pp >= parts + 3)
+ {
+ return 0;
+ }
+ *pp++ = val;
+ c = *++cp;
+ }
+ else
+ {
+ break;
+ }
+ }
+ /*
+ * Check for trailing characters.
+ */
+ if (c != '\0' && !isspace(c))
+ {
+ return 0;
+ }
+ /*
+ * Concoct the address according to
+ * the number of parts specified.
+ */
+ switch (pp - parts + 1)
+ {
+
+ case 0:
+ return 0; /* initial nondigit */
+
+ case 1: /* a -- 32 bits */
+ break;
+
+ case 2: /* a.b -- 8.24 bits */
+ if (val > 0xffffffUL)
+ {
+ return 0;
+ }
+ if (parts[0] > 0xff)
+ {
+ return 0;
+ }
+ val |= parts[0] << 24;
+ break;
+
+ case 3: /* a.b.c -- 8.8.16 bits */
+ if (val > 0xffff)
+ {
+ return 0;
+ }
+ if ((parts[0] > 0xff) || (parts[1] > 0xff))
+ {
+ return 0;
+ }
+ val |= (parts[0] << 24) | (parts[1] << 16);
+ break;
+
+ case 4: /* a.b.c.d -- 8.8.8.8 bits */
+ if (val > 0xff)
+ {
+ return 0;
+ }
+ if ((parts[0] > 0xff) || (parts[1] > 0xff) || (parts[2] > 0xff))
+ {
+ return 0;
+ }
+ val |= (parts[0] << 24) | (parts[1] << 16) | (parts[2] << 8);
+ break;
+ default:
+ RT_ASSERT(0);
+ break;
+ }
+ if (addr)
+ {
+ ip4_addr_set_u32(addr, htonl(val));
+ }
+ return 1;
+}
+
+/**
+ * Same as ipaddr_ntoa, but reentrant since a user-supplied buffer is used.
+ *
+ * @param addr ip address in network order to convert
+ * @param buf target buffer where the string is stored
+ * @param buflen length of buf
+ * @return either pointer to buf which now holds the ASCII
+ * representation of addr or NULL if buf was too small
+ */
+char *netdev_ip4addr_ntoa_r(const ip4_addr_t *addr, char *buf, int buflen)
+{
+ uint32_t s_addr;
+ char inv[3];
+ char *rp;
+ uint8_t *ap;
+ uint8_t rem;
+ uint8_t n;
+ uint8_t i;
+ int len = 0;
+
+ s_addr = ip4_addr_get_u32(addr);
+
+ rp = buf;
+ ap = (uint8_t *) &s_addr;
+ for (n = 0; n < 4; n++)
+ {
+ i = 0;
+ do
+ {
+ rem = *ap % (uint8_t) 10;
+ *ap /= (uint8_t) 10;
+ inv[i++] = (char) ('0' + rem);
+ } while (*ap);
+ while (i--)
+ {
+ if (len++ >= buflen)
+ {
+ return NULL;
+ }
+ *rp++ = inv[i];
+ }
+ if (len++ >= buflen)
+ {
+ return NULL;
+ }
+ *rp++ = '.';
+ ap++;
+ }
+ *--rp = 0;
+ return buf;
+}
+
+
+/**
+ * Convert numeric IP address into decimal dotted ASCII representation.
+ * returns ptr to static buffer; not reentrant!
+ *
+ * @param addr ip address in network order to convert
+ * @return pointer to a global static (!) buffer that holds the ASCII
+ * representation of addr
+ */
+char *netdev_ip4addr_ntoa(const ip4_addr_t *addr)
+{
+ static char str[IP4ADDR_STRLEN_MAX];
+ return netdev_ip4addr_ntoa_r(addr, str, IP4ADDR_STRLEN_MAX);
+}
+
+
+/**
+ * Ascii internet address interpretation routine.
+ * The value returned is in network order.
+ *
+ * @param cp IP address in ascii representation (e.g. "127.0.0.1")
+ * @return ip address in network order
+ */
+in_addr_t netdev_ipaddr_addr(const char *cp)
+{
+ ip4_addr_t val;
+
+ if (netdev_ip4addr_aton(cp, &val)) {
+ return ip4_addr_get_u32(&val);
+ }
+ return (IPADDR_NONE);
+}
+
+#endif /* NETDEV_IPV4 */
+
+
+#if NETDEV_IPV6
+
+RT_WEAK const struct in6_addr in6addr_any = IN6ADDR_ANY_INIT;
+
+/**
+ * Check whether "cp" is a valid ascii representation
+ * of an IPv6 address and convert to a binary address.
+ * Returns 1 if the address is valid, 0 if not.
+ *
+ * @param cp IPv6 address in ascii representation (e.g. "FF01::1")
+ * @param addr pointer to which to save the ip address in network order
+ * @return 1 if cp could be converted to addr, 0 on failure
+ */
+int
+netdev_ip6addr_aton(const char *cp, ip6_addr_t *addr)
+{
+ uint32_t addr_index, zero_blocks, current_block_index, current_block_value;
+ const char *s;
+
+ /* Count the number of colons, to count the number of blocks in a "::" sequence
+ zero_blocks may be 1 even if there are no :: sequences */
+ zero_blocks = 8;
+ for (s = cp; *s != 0; s++)
+ {
+ if (*s == ':')
+ {
+ zero_blocks--;
+ }
+ else if (!isxdigit(*s))
+ {
+ break;
+ }
+ }
+
+ /* parse each block */
+ addr_index = 0;
+ current_block_index = 0;
+ current_block_value = 0;
+ for (s = cp; *s != 0; s++)
+ {
+ if (*s == ':')
+ {
+ if (addr)
+ {
+ if (current_block_index & 0x1)
+ {
+ addr->addr[addr_index++] |= current_block_value;
+ }
+ else
+ {
+ addr->addr[addr_index] = current_block_value << 16;
+ }
+ }
+ current_block_index++;
+ current_block_value = 0;
+ if (current_block_index > 7)
+ {
+ /* address too long! */
+ return 0;
+ }
+ if (s[1] == ':')
+ {
+ if (s[2] == ':')
+ {
+ /* invalid format: three successive colons */
+ return 0;
+ }
+ s++;
+ /* "::" found, set zeros */
+ while (zero_blocks > 0)
+ {
+ zero_blocks--;
+ if (current_block_index & 0x1)
+ {
+ addr_index++;
+ }
+ else
+ {
+ if (addr)
+ {
+ addr->addr[addr_index] = 0;
+ }
+ }
+ current_block_index++;
+ if (current_block_index > 7)
+ {
+ /* address too long! */
+ return 0;
+ }
+ }
+ }
+ }
+ else if (isxdigit(*s))
+ {
+ /* add current digit */
+ current_block_value = (current_block_value << 4) +
+ (isdigit(*s) ? (uint32_t)(*s - '0') : (uint32_t)(10 + (islower(*s) ? *s - 'a' : *s - 'A')));
+ }
+ else
+ {
+ /* unexpected digit, space? CRLF? */
+ break;
+ }
+ }
+
+ if (addr)
+ {
+ if (current_block_index & 0x1)
+ {
+ addr->addr[addr_index++] |= current_block_value;
+ }
+ else
+ {
+ addr->addr[addr_index] = current_block_value << 16;
+ }
+ }
+
+ /* convert to network byte order. */
+ if (addr)
+ {
+ for (addr_index = 0; addr_index < 4; addr_index++)
+ {
+ addr->addr[addr_index] = htonl(addr->addr[addr_index]);
+ }
+ }
+
+ if (current_block_index != 7)
+ {
+ return 0;
+ }
+
+ return 1;
+}
+
+/**
+ * Same as ipaddr_ntoa, but reentrant since a user-supplied buffer is used.
+ *
+ * @param addr ip6 address in network order to convert
+ * @param buf target buffer where the string is stored
+ * @param buflen length of buf
+ * @return either pointer to buf which now holds the ASCII
+ * representation of addr or NULL if buf was too small
+ */
+char *
+netdev_ip6addr_ntoa_r(const ip6_addr_t *addr, char *buf, int buflen)
+{
+ uint32_t current_block_index, current_block_value, next_block_value;
+ int32_t i;
+ uint8_t zero_flag, empty_block_flag;
+
+ i = 0;
+ empty_block_flag = 0; /* used to indicate a zero chain for "::' */
+
+ for (current_block_index = 0; current_block_index < 8; current_block_index++)
+ {
+ /* get the current 16-bit block */
+ current_block_value = htonl(addr->addr[current_block_index >> 1]);
+ if ((current_block_index & 0x1) == 0)
+ {
+ current_block_value = current_block_value >> 16;
+ }
+ current_block_value &= 0xffff;
+
+ /* Check for empty block. */
+ if (current_block_value == 0)
+ {
+ if (current_block_index == 7 && empty_block_flag == 1)
+ {
+ /* special case, we must render a ':' for the last block. */
+ buf[i++] = ':';
+ if (i >= buflen)
+ {
+ return NULL;
+ }
+ break;
+ }
+ if (empty_block_flag == 0)
+ {
+ /* generate empty block "::", but only if more than one contiguous zero block,
+ * according to current formatting suggestions RFC 5952. */
+ next_block_value = htonl(addr->addr[(current_block_index + 1) >> 1]);
+ if ((current_block_index & 0x1) == 0x01)
+ {
+ next_block_value = next_block_value >> 16;
+ }
+ next_block_value &= 0xffff;
+ if (next_block_value == 0)
+ {
+ empty_block_flag = 1;
+ buf[i++] = ':';
+ if (i >= buflen)
+ {
+ return NULL;
+ }
+ continue; /* move on to next block. */
+ }
+ }
+ else if (empty_block_flag == 1)
+ {
+ /* move on to next block. */
+ continue;
+ }
+ }
+ else if (empty_block_flag == 1)
+ {
+ /* Set this flag value so we don't produce multiple empty blocks. */
+ empty_block_flag = 2;
+ }
+
+ if (current_block_index > 0)
+ {
+ buf[i++] = ':';
+ if (i >= buflen)
+ {
+ return NULL;
+ }
+ }
+
+ if ((current_block_value & 0xf000) == 0)
+ {
+ zero_flag = 1;
+ }
+ else
+ {
+ buf[i++] = xchar(((current_block_value & 0xf000) >> 12));
+ zero_flag = 0;
+ if (i >= buflen)
+ {
+ return NULL;
+ }
+ }
+
+ if (((current_block_value & 0xf00) == 0) && (zero_flag))
+ {
+ /* do nothing */
+ }
+ else
+ {
+ buf[i++] = xchar(((current_block_value & 0xf00) >> 8));
+ zero_flag = 0;
+ if (i >= buflen)
+ {
+ return NULL;
+ }
+ }
+
+ if (((current_block_value & 0xf0) == 0) && (zero_flag))
+ {
+ /* do nothing */
+ }
+ else
+ {
+ buf[i++] = xchar(((current_block_value & 0xf0) >> 4));
+ zero_flag = 0;
+ if (i >= buflen)
+ {
+ return NULL;
+ }
+ }
+
+ buf[i++] = xchar((current_block_value & 0xf));
+ if (i >= buflen)
+ {
+ return NULL;
+ }
+ }
+
+ buf[i] = 0;
+
+ return buf;
+}
+
+/**
+ * Convert numeric IPv6 address into ASCII representation.
+ * returns ptr to static buffer; not reentrant!
+ *
+ * @param addr ip6 address in network order to convert
+ * @return pointer to a global static (!) buffer that holds the ASCII
+ * representation of addr
+ */
+char *
+netdev_ip6addr_ntoa(const ip6_addr_t *addr)
+{
+ static char str[40];
+ return netdev_ip6addr_ntoa_r(addr, str, 40);
+}
+
+#endif /* NETDEV_IPV6 */
+
+const char *
+netdev_inet_ntop(int af, const void *src, char *dst, int32_t size)
+{
+#define AF_INET 2
+#define AF_INET6 10
+
+ const char *ret = NULL;
+ int size_int = (int)size;
+ if (size_int < 0)
+ {
+ return NULL;
+ }
+ switch (af)
+ {
+#if NETDEV_IPV4
+ case AF_INET:
+ return netdev_ip4addr_ntoa_r((const ip4_addr_t *)src, dst, size_int);
+#endif
+#if NETDEV_IPV6
+ case AF_INET6:
+ return netdev_ip6addr_ntoa_r((const ip6_addr_t *)src, dst, size_int);
+#endif
+ default:
+ break;
+ }
+ return ret;
+}
+
+int
+netdev_inet_pton(int af, const char *src, void *dst)
+{
+#define AF_INET 2
+#define AF_INET6 10
+
+ int err;
+ switch (af)
+ {
+#if NETDEV_IPV4
+ case AF_INET:
+ err = netdev_ip4addr_aton(src, (ip4_addr_t *)dst);
+ break;
+#endif
+#if NETDEV_IPV6
+ case AF_INET6:
+ {
+ /* convert into temporary variable since ip6_addr_t might be larger
+ than in6_addr when scopes are enabled */
+ ip6_addr_t addr;
+ err = netdev_ip6addr_aton(src, &addr);
+ if (err)
+ {
+ rt_memcpy(dst, &addr.addr, sizeof(addr.addr));
+ }
+ break;
+ }
+#endif
+ default:
+ err = -1;
+ break;
+ }
+ return err;
+}