LWIPInterfaceEMAC.cpp

00001 /* mbed Microcontroller Library
00002  * Copyright (c) 2016 ARM Limited
00003  *
00004  * Licensed under the Apache License, Version 2.0 (the "License");
00005  * you may not use this file except in compliance with the License.
00006  * You may obtain a copy of the License at
00007  *
00008  *     http://www.apache.org/licenses/LICENSE-2.0
00009  *
00010  * Unless required by applicable law or agreed to in writing, software
00011  * distributed under the License is distributed on an "AS IS" BASIS,
00012  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
00013  * See the License for the specific language governing permissions and
00014  * limitations under the License.
00015  */
00016 
00017 #include "lwip/tcpip.h"
00018 #include "lwip/tcp.h"
00019 #include "lwip/ip.h"
00020 #include "netif/etharp.h"
00021 #include "lwip/ethip6.h"
00022 #include "netsocket/nsapi_types.h"
00023 #include "netsocket/EMAC.h"
00024 
00025 #include "LWIPStack.h"
00026 
00027 #if LWIP_ETHERNET
00028 
00029 err_t LWIP::Interface::emac_low_level_output(struct netif *netif, struct pbuf *p)
00030 {
00031     /* Increase reference counter since lwip stores handle to pbuf and frees
00032        it after output */
00033     pbuf_ref(p);
00034 
00035     LWIP::Interface *mbed_if = static_cast<LWIP::Interface *>(netif->state);
00036     bool ret = mbed_if->emac->link_out(p);
00037     return ret ? ERR_OK : ERR_IF;
00038 }
00039 
00040 void LWIP::Interface::emac_input(emac_mem_buf_t *buf)
00041 {
00042     struct pbuf *p = static_cast<struct pbuf *>(buf);
00043 
00044     /* pass all packets to ethernet_input, which decides what packets it supports */
00045     if (netif.input(p, &netif) != ERR_OK) {
00046         LWIP_DEBUGF(NETIF_DEBUG, ("Emac LWIP: IP input error\n"));
00047 
00048         pbuf_free(p);
00049     }
00050 }
00051 
00052 void LWIP::Interface::emac_state_change(bool up)
00053 {
00054     if (up) {
00055         tcpip_callback_with_block((tcpip_callback_fn)netif_set_link_up, &netif, 1);
00056     } else {
00057         tcpip_callback_with_block((tcpip_callback_fn)netif_set_link_down, &netif, 1);
00058     }
00059 }
00060 
00061 #if LWIP_IGMP
00062 
00063 #include "lwip/igmp.h"
00064 /**
00065  * IPv4 address filtering setup.
00066  *
00067  * \param[in] netif the lwip network interface structure
00068  * \param[in] group IPv4 group to modify
00069  * \param[in] action
00070  * \return ERR_OK or error code
00071  */
00072 err_t LWIP::Interface::emac_igmp_mac_filter(struct netif *netif, const ip4_addr_t *group, enum netif_mac_filter_action action)
00073 {
00074     LWIP::Interface *mbed_if = static_cast<LWIP::Interface *>(netif->state);
00075 
00076     switch (action) {
00077         case NETIF_ADD_MAC_FILTER: {
00078             uint32_t group23 = ntohl(group->addr) & 0x007FFFFF;
00079             uint8_t addr[6];
00080             addr[0] = LL_IP4_MULTICAST_ADDR_0;
00081             addr[1] = LL_IP4_MULTICAST_ADDR_1;
00082             addr[2] = LL_IP4_MULTICAST_ADDR_2;
00083             addr[3] = group23 >> 16;
00084             addr[4] = group23 >> 8;
00085             addr[5] = group23;
00086             mbed_if->emac->add_multicast_group(addr);
00087             return ERR_OK;
00088         }
00089         case NETIF_DEL_MAC_FILTER:
00090             /* As we don't reference count, silently ignore delete requests */
00091             return ERR_OK;
00092         default:
00093             return ERR_ARG;
00094     }
00095 }
00096 #endif
00097 
00098 #if LWIP_IPV6_MLD
00099 
00100 #include "lwip/mld6.h"
00101 /**
00102  * IPv6 address filtering setup.
00103  *
00104  * \param[in] netif the lwip network interface structure
00105  * \param[in] group IPv6 group to modify
00106  * \param[in] action
00107  * \return ERR_OK or error code
00108  */
00109 err_t LWIP::Interface::emac_mld_mac_filter(struct netif *netif, const ip6_addr_t *group, enum netif_mac_filter_action action)
00110 {
00111     LWIP::Interface *mbed_if = static_cast<LWIP::Interface *>(netif->state);
00112 
00113     switch (action) {
00114         case NETIF_ADD_MAC_FILTER: {
00115             uint32_t group32 = ntohl(group->addr[3]);
00116             uint8_t addr[6];
00117             addr[0] = LL_IP6_MULTICAST_ADDR_0;
00118             addr[1] = LL_IP6_MULTICAST_ADDR_1;
00119             addr[2] = group32 >> 24;
00120             addr[3] = group32 >> 16;
00121             addr[4] = group32 >> 8;
00122             addr[5] = group32;
00123             mbed_if->emac->add_multicast_group(addr);
00124             return ERR_OK;
00125         }
00126         case NETIF_DEL_MAC_FILTER:
00127             /* As we don't reference count, silently ignore delete requests */
00128             return ERR_OK;
00129         default:
00130             return ERR_ARG;
00131     }
00132 }
00133 #endif
00134 
00135 err_t LWIP::Interface::emac_if_init(struct netif *netif)
00136 {
00137     int err = ERR_OK;
00138     LWIP::Interface *mbed_if = static_cast<LWIP::Interface *>(netif->state);
00139 
00140     mbed_if->emac->set_memory_manager(*mbed_if->memory_manager);
00141     mbed_if->emac->set_link_input_cb(mbed::callback(mbed_if, &LWIP::Interface::emac_input));
00142     mbed_if->emac->set_link_state_cb(mbed::callback(mbed_if, &LWIP::Interface::emac_state_change));
00143 
00144     /* Interface capabilities */
00145     netif->flags = NETIF_FLAG_BROADCAST | NETIF_FLAG_ETHARP | NETIF_FLAG_ETHERNET;
00146 
00147     if (!mbed_if->emac->power_up()) {
00148         err = ERR_IF;
00149     }
00150 
00151     netif->mtu = mbed_if->emac->get_mtu_size();
00152     /* We have a default MAC address, so do don't force them to supply one */
00153     netif->hwaddr_len = mbed_if->emac->get_hwaddr_size();
00154     /* They may or may not update hwaddr with their address */
00155     mbed_if->emac->get_hwaddr(netif->hwaddr);
00156     /* Then we write back either what they gave us, or our default */
00157     mbed_if->emac->set_hwaddr(netif->hwaddr);
00158 
00159     mbed_if->emac->get_ifname(netif->name, NSAPI_INTERFACE_PREFIX_SIZE);
00160 
00161 #if LWIP_IPV4
00162     netif->output = etharp_output;
00163 #if LWIP_IGMP
00164     netif->igmp_mac_filter = &LWIP::Interface::emac_igmp_mac_filter;
00165     netif->flags |= NETIF_FLAG_IGMP;
00166 #endif /* LWIP_IGMP */
00167 #endif /* LWIP_IPV4 */
00168 #if LWIP_IPV6
00169     netif->output_ip6 = ethip6_output;
00170 #if LWIP_IPV6_MLD
00171     netif->mld_mac_filter = &LWIP::Interface::emac_mld_mac_filter;
00172     netif->flags |= NETIF_FLAG_MLD6;
00173 #else
00174 // Would need to enable all multicasts here - no API in fsl_enet to do that
00175 #error "IPv6 multicasts won't be received if LWIP_IPV6_MLD is disabled, breaking the system"
00176 #endif
00177 #endif
00178 
00179     netif->linkoutput = &LWIP::Interface::emac_low_level_output;
00180 
00181     return err;
00182 }
00183 
00184 #endif
00185