EthernetInterface.cpp

00001 /* EthernetInterface.cpp */
00002 /* Copyright (C) 2012 mbed.org, MIT License
00003  *
00004  * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
00005  * and associated documentation files (the "Software"), to deal in the Software without restriction,
00006  * including without limitation the rights to use, copy, modify, merge, publish, distribute,
00007  * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
00008  * furnished to do so, subject to the following conditions:
00009  *
00010  * The above copyright notice and this permission notice shall be included in all copies or
00011  * substantial portions of the Software.
00012  *
00013  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
00014  * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
00015  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
00016  * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
00017  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
00018  */
00019 #include "EthernetInterface.h"
00020 
00021 #include "lwip/inet.h"
00022 #include "lwip/netif.h"
00023 #include "netif/etharp.h"
00024 #include "lwip/dhcp.h"
00025 #include "eth_arch.h"
00026 #include "lwip/tcpip.h"
00027 #include "mbed.h"
00028 #include "demo.h"
00029 
00030 /* TCP/IP and Network Interface Initialisation */
00031 static struct netif netif;
00032 
00033 static char mac_addr[19];
00034 static char ip_addr[17] = "\0";
00035 static char gateway[17] = "\0";
00036 static char networkmask[17] = "\0";
00037 static bool use_dhcp = false;
00038 
00039 static Semaphore tcpip_inited(0);
00040 static Semaphore netif_linked(0);
00041 static Semaphore netif_up(0);
00042 
00043 static void tcpip_init_done(void *arg) {
00044     tcpip_inited.release();
00045 }
00046 
00047 static void netif_link_callback(struct netif *netif) {
00048   
00049     eth_cmd_t *cmd;
00050     cmd = ethernet_status_q.alloc();   
00051     if (netif_is_link_up(netif)) 
00052     {
00053         //netif_linked.release();
00054         cmd->cmd = ETHERNET_LINK_UP;  
00055         ethernet_status_q.put(cmd);
00056     }    
00057     else
00058     {
00059         cmd->cmd = ETHERNET_LINK_DOWN;  
00060         ethernet_status_q.put(cmd);
00061     }
00062 }
00063 
00064 static void netif_status_callback(struct netif *netif) {
00065     if (netif_is_up(netif)) {
00066         strcpy(ip_addr, inet_ntoa(netif->ip_addr));
00067         strcpy(gateway, inet_ntoa(netif->gw));
00068         strcpy(networkmask, inet_ntoa(netif->netmask));
00069         netif_up.release();
00070     }
00071 }
00072 
00073 static void init_netif(ip_addr_t *ipaddr, ip_addr_t *netmask, ip_addr_t *gw) {
00074     tcpip_init(tcpip_init_done, NULL);
00075     tcpip_inited.wait();
00076     
00077     memset((void*) &netif, 0, sizeof(netif));
00078     netif_add(&netif, ipaddr, netmask, gw, NULL, eth_arch_enetif_init, tcpip_input);
00079     netif_set_default(&netif);
00080     
00081     netif_set_link_callback  (&netif, netif_link_callback);
00082     netif_set_status_callback(&netif, netif_status_callback);
00083 }
00084 
00085 static void set_mac_address(void) {
00086 #if (MBED_MAC_ADDRESS_SUM != MBED_MAC_ADDR_INTERFACE)
00087     snprintf(mac_addr, 19, "%02x:%02x:%02x:%02x:%02x:%02x", MBED_MAC_ADDR_0, MBED_MAC_ADDR_1, MBED_MAC_ADDR_2,
00088              MBED_MAC_ADDR_3, MBED_MAC_ADDR_4, MBED_MAC_ADDR_5);
00089 #else
00090     char mac[6];
00091     mbed_mac_address(mac);
00092     snprintf(mac_addr, 19, "%02x:%02x:%02x:%02x:%02x:%02x", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
00093 #endif
00094 }
00095 
00096 int EthernetInterface::init() {
00097     use_dhcp = true;
00098     set_mac_address();
00099     init_netif(NULL, NULL, NULL);
00100     return 0;
00101 }
00102 
00103 int EthernetInterface::init(const char* ip, const char* mask, const char* gateway) {
00104     use_dhcp = false;
00105     
00106     set_mac_address();
00107     strcpy(ip_addr, ip);
00108     
00109     ip_addr_t ip_n, mask_n, gateway_n;
00110     inet_aton(ip, &ip_n);
00111     inet_aton(mask, &mask_n);
00112     inet_aton(gateway, &gateway_n);
00113     init_netif(&ip_n, &mask_n, &gateway_n);
00114     
00115     return 0;
00116 }
00117 
00118 int EthernetInterface::connect(unsigned int timeout_ms) {
00119     eth_arch_enable_interrupts();
00120 
00121     int inited;
00122     if (use_dhcp) {
00123         dhcp_start(&netif);
00124         
00125         // Wait for an IP Address
00126         // -1: error, 0: timeout
00127         inited = netif_up.wait(timeout_ms);
00128     } else {
00129         netif_set_up(&netif);
00130         
00131         // Wait for the link up
00132         //inited = netif_linked.wait(timeout_ms);
00133         inited = 1;
00134     }
00135     
00136     return (inited > 0) ? (0) : (-1);
00137 }
00138 
00139 int EthernetInterface::disconnect() {
00140     if (use_dhcp) {
00141         dhcp_release(&netif);
00142         dhcp_stop(&netif);
00143     } else {
00144         netif_set_down(&netif);
00145     }
00146     
00147     eth_arch_disable_interrupts();
00148     
00149     return 0;
00150 }
00151 
00152     
00153        
00154     
00155 
00156 char* EthernetInterface::getMACAddress() {
00157     return mac_addr;
00158 }
00159 
00160 char* EthernetInterface::getIPAddress() {
00161     return ip_addr;
00162 }
00163 
00164 char* EthernetInterface::getGateway() {
00165     return gateway;
00166 }
00167 
00168 char* EthernetInterface::getNetworkMask() {
00169     return networkmask;
00170 }
00171 
00172