Nino Der Kinderen / Mbed 2 deprecated InetTest

Embedded C project:18/12/2014

Dependencies:   DS1307 TextLCD mbed

NetServices/drv/eth/eth_drv.cpp@0:8d87bc453349, 2014-12-18 (annotated)

Committer:
ninoderkinderen
Date:
Thu Dec 18 09:35:49 2014 +0000
Revision:
0:8d87bc453349
Programma embedded C

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ninoderkinderen 0:8d87bc453349 1
ninoderkinderen 0:8d87bc453349 2 /*
ninoderkinderen 0:8d87bc453349 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
ninoderkinderen 0:8d87bc453349 4
ninoderkinderen 0:8d87bc453349 5 Permission is hereby granted, free of charge, to any person obtaining a copy
ninoderkinderen 0:8d87bc453349 6 of this software and associated documentation files (the "Software"), to deal
ninoderkinderen 0:8d87bc453349 7 in the Software without restriction, including without limitation the rights
ninoderkinderen 0:8d87bc453349 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
ninoderkinderen 0:8d87bc453349 9 copies of the Software, and to permit persons to whom the Software is
ninoderkinderen 0:8d87bc453349 10 furnished to do so, subject to the following conditions:
ninoderkinderen 0:8d87bc453349 11
ninoderkinderen 0:8d87bc453349 12 The above copyright notice and this permission notice shall be included in
ninoderkinderen 0:8d87bc453349 13 all copies or substantial portions of the Software.
ninoderkinderen 0:8d87bc453349 14
ninoderkinderen 0:8d87bc453349 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
ninoderkinderen 0:8d87bc453349 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
ninoderkinderen 0:8d87bc453349 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
ninoderkinderen 0:8d87bc453349 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
ninoderkinderen 0:8d87bc453349 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
ninoderkinderen 0:8d87bc453349 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
ninoderkinderen 0:8d87bc453349 21 THE SOFTWARE.
ninoderkinderen 0:8d87bc453349 22 */
ninoderkinderen 0:8d87bc453349 23
ninoderkinderen 0:8d87bc453349 24 #include "netCfg.h"
ninoderkinderen 0:8d87bc453349 25 #if NET_ETH
ninoderkinderen 0:8d87bc453349 26
ninoderkinderen 0:8d87bc453349 27 #include "mbed.h"
ninoderkinderen 0:8d87bc453349 28
ninoderkinderen 0:8d87bc453349 29 Ethernet *pEth = NULL;
ninoderkinderen 0:8d87bc453349 30 #ifdef __cplusplus
ninoderkinderen 0:8d87bc453349 31 extern "C" {
ninoderkinderen 0:8d87bc453349 32 #endif
ninoderkinderen 0:8d87bc453349 33
ninoderkinderen 0:8d87bc453349 34 #include "lwip/opt.h"
ninoderkinderen 0:8d87bc453349 35
ninoderkinderen 0:8d87bc453349 36 #include "lwip/def.h"
ninoderkinderen 0:8d87bc453349 37 #include "lwip/pbuf.h"
ninoderkinderen 0:8d87bc453349 38 #include "lwip/sys.h"
ninoderkinderen 0:8d87bc453349 39 #include "lwip/stats.h"
ninoderkinderen 0:8d87bc453349 40 #include "netif/etharp.h"
ninoderkinderen 0:8d87bc453349 41 #include "string.h"
ninoderkinderen 0:8d87bc453349 42
ninoderkinderen 0:8d87bc453349 43 //#include "eth_drv.h"
ninoderkinderen 0:8d87bc453349 44
ninoderkinderen 0:8d87bc453349 45 #define IFNAME0 'E'
ninoderkinderen 0:8d87bc453349 46 #define IFNAME1 'X'
ninoderkinderen 0:8d87bc453349 47
ninoderkinderen 0:8d87bc453349 48 #define min(x,y) (((x)<(y))?(x):(y))
ninoderkinderen 0:8d87bc453349 49
ninoderkinderen 0:8d87bc453349 50 struct netif* eth_netif;
ninoderkinderen 0:8d87bc453349 51
ninoderkinderen 0:8d87bc453349 52 static err_t eth_output(struct netif *netif, struct pbuf *p) {
ninoderkinderen 0:8d87bc453349 53 #if ETH_PAD_SIZE
ninoderkinderen 0:8d87bc453349 54 pbuf_header(p, -ETH_PAD_SIZE); /* drop the padding word */
ninoderkinderen 0:8d87bc453349 55 #endif
ninoderkinderen 0:8d87bc453349 56
ninoderkinderen 0:8d87bc453349 57 do {
ninoderkinderen 0:8d87bc453349 58 pEth->write((const char *)p->payload, p->len);
ninoderkinderen 0:8d87bc453349 59 } while((p = p->next)!=NULL);
ninoderkinderen 0:8d87bc453349 60
ninoderkinderen 0:8d87bc453349 61 pEth->send();
ninoderkinderen 0:8d87bc453349 62
ninoderkinderen 0:8d87bc453349 63 #if ETH_PAD_SIZE
ninoderkinderen 0:8d87bc453349 64 pbuf_header(p, ETH_PAD_SIZE); /* reclaim the padding word */
ninoderkinderen 0:8d87bc453349 65 #endif
ninoderkinderen 0:8d87bc453349 66
ninoderkinderen 0:8d87bc453349 67 LINK_STATS_INC(link.xmit);
ninoderkinderen 0:8d87bc453349 68 return ERR_OK;
ninoderkinderen 0:8d87bc453349 69 }
ninoderkinderen 0:8d87bc453349 70
ninoderkinderen 0:8d87bc453349 71 /*
ninoderkinderen 0:8d87bc453349 72 void show(char *buf, int size) {
ninoderkinderen 0:8d87bc453349 73 printf("Destination: %02hx:%02hx:%02hx:%02hx:%02hx:%02hx\n",
ninoderkinderen 0:8d87bc453349 74 buf[0], buf[1], buf[2], buf[3], buf[4], buf[5]);
ninoderkinderen 0:8d87bc453349 75 printf("Source: %02hx:%02hx:%02hx:%02hx:%02hx:%02hx\n",
ninoderkinderen 0:8d87bc453349 76 buf[6], buf[7], buf[8], buf[9], buf[10], buf[11]);
ninoderkinderen 0:8d87bc453349 77
ninoderkinderen 0:8d87bc453349 78 printf("Type %hd\n", htons((short)buf[12]));
ninoderkinderen 0:8d87bc453349 79
ninoderkinderen 0:8d87bc453349 80 // hexview(buf, size);
ninoderkinderen 0:8d87bc453349 81 }
ninoderkinderen 0:8d87bc453349 82 */
ninoderkinderen 0:8d87bc453349 83
ninoderkinderen 0:8d87bc453349 84 void eth_poll() {
ninoderkinderen 0:8d87bc453349 85 struct eth_hdr *ethhdr;
ninoderkinderen 0:8d87bc453349 86 struct pbuf *frame, *p;
ninoderkinderen 0:8d87bc453349 87 int len, read;
ninoderkinderen 0:8d87bc453349 88
ninoderkinderen 0:8d87bc453349 89 while((len = pEth->receive()) != 0) {
ninoderkinderen 0:8d87bc453349 90 frame = pbuf_alloc(PBUF_RAW, len, PBUF_POOL);
ninoderkinderen 0:8d87bc453349 91 if(frame == NULL) {
ninoderkinderen 0:8d87bc453349 92 return;
ninoderkinderen 0:8d87bc453349 93 }
ninoderkinderen 0:8d87bc453349 94 p = frame;
ninoderkinderen 0:8d87bc453349 95 /* no packet could be read, silently ignore this */
ninoderkinderen 0:8d87bc453349 96 if (p == NULL) return;
ninoderkinderen 0:8d87bc453349 97 do {
ninoderkinderen 0:8d87bc453349 98 read = pEth->read((char *)p->payload, p->len);
ninoderkinderen 0:8d87bc453349 99 p = p->next;
ninoderkinderen 0:8d87bc453349 100 } while(p != NULL && read != 0);
ninoderkinderen 0:8d87bc453349 101
ninoderkinderen 0:8d87bc453349 102 #if ETH_PAD_SIZE
ninoderkinderen 0:8d87bc453349 103 pbuf_header(p, ETH_PAD_SIZE);
ninoderkinderen 0:8d87bc453349 104 #endif
ninoderkinderen 0:8d87bc453349 105
ninoderkinderen 0:8d87bc453349 106 ethhdr = (struct eth_hdr *)(frame->payload);
ninoderkinderen 0:8d87bc453349 107
ninoderkinderen 0:8d87bc453349 108 // show((char*)ethhdr, 13);
ninoderkinderen 0:8d87bc453349 109
ninoderkinderen 0:8d87bc453349 110 /*
ninoderkinderen 0:8d87bc453349 111 switch(htons(ethhdr->type)) {
ninoderkinderen 0:8d87bc453349 112
ninoderkinderen 0:8d87bc453349 113 case ETHTYPE_IP:
ninoderkinderen 0:8d87bc453349 114 etharp_ip_input(gnetif, frame);
ninoderkinderen 0:8d87bc453349 115 pbuf_header(frame, -((s16_t) sizeof(struct eth_hdr)));
ninoderkinderen 0:8d87bc453349 116 gnetif->input(frame, gnetif);
ninoderkinderen 0:8d87bc453349 117 break;
ninoderkinderen 0:8d87bc453349 118
ninoderkinderen 0:8d87bc453349 119 case ETHTYPE_ARP:
ninoderkinderen 0:8d87bc453349 120 etharp_arp_input(gnetif, (struct eth_addr *)(gnetif->hwaddr), frame);
ninoderkinderen 0:8d87bc453349 121 break;
ninoderkinderen 0:8d87bc453349 122
ninoderkinderen 0:8d87bc453349 123 default:
ninoderkinderen 0:8d87bc453349 124 break;
ninoderkinderen 0:8d87bc453349 125 }*/
ninoderkinderen 0:8d87bc453349 126
ninoderkinderen 0:8d87bc453349 127
ninoderkinderen 0:8d87bc453349 128
ninoderkinderen 0:8d87bc453349 129 //ethernet_input(frame, gnetif);
ninoderkinderen 0:8d87bc453349 130
ninoderkinderen 0:8d87bc453349 131 switch (htons(ethhdr->type)) {
ninoderkinderen 0:8d87bc453349 132 /* IP or ARP packet? */
ninoderkinderen 0:8d87bc453349 133 case ETHTYPE_IP:
ninoderkinderen 0:8d87bc453349 134 case ETHTYPE_ARP:
ninoderkinderen 0:8d87bc453349 135 #if PPPOE_SUPPORT
ninoderkinderen 0:8d87bc453349 136 /* PPPoE packet? */
ninoderkinderen 0:8d87bc453349 137 case ETHTYPE_PPPOEDISC:
ninoderkinderen 0:8d87bc453349 138 case ETHTYPE_PPPOE:
ninoderkinderen 0:8d87bc453349 139 #endif /* PPPOE_SUPPORT */
ninoderkinderen 0:8d87bc453349 140 /* full packet send to tcpip_thread to process */
ninoderkinderen 0:8d87bc453349 141 //if (netif->input(p, gnetif)!=ERR_OK)
ninoderkinderen 0:8d87bc453349 142 if (ethernet_input(frame, eth_netif)!=ERR_OK)
ninoderkinderen 0:8d87bc453349 143 { LWIP_DEBUGF(NETIF_DEBUG, ("ethernetif_input: IP input error\n"));
ninoderkinderen 0:8d87bc453349 144 pbuf_free(frame);
ninoderkinderen 0:8d87bc453349 145 frame = NULL;
ninoderkinderen 0:8d87bc453349 146 }
ninoderkinderen 0:8d87bc453349 147 break;
ninoderkinderen 0:8d87bc453349 148
ninoderkinderen 0:8d87bc453349 149 default:
ninoderkinderen 0:8d87bc453349 150 pbuf_free(frame);
ninoderkinderen 0:8d87bc453349 151 frame = NULL;
ninoderkinderen 0:8d87bc453349 152 break;
ninoderkinderen 0:8d87bc453349 153 }
ninoderkinderen 0:8d87bc453349 154
ninoderkinderen 0:8d87bc453349 155 /* pbuf_free(frame); */
ninoderkinderen 0:8d87bc453349 156 }
ninoderkinderen 0:8d87bc453349 157
ninoderkinderen 0:8d87bc453349 158
ninoderkinderen 0:8d87bc453349 159
ninoderkinderen 0:8d87bc453349 160
ninoderkinderen 0:8d87bc453349 161 }
ninoderkinderen 0:8d87bc453349 162
ninoderkinderen 0:8d87bc453349 163 err_t eth_init(struct netif *netif) {
ninoderkinderen 0:8d87bc453349 164 LWIP_ASSERT("netif != NULL", (netif != NULL));
ninoderkinderen 0:8d87bc453349 165
ninoderkinderen 0:8d87bc453349 166 NETIF_INIT_SNMP(netif, snmp_ifType_ethernet_csmacd, 0x2EA);
ninoderkinderen 0:8d87bc453349 167
ninoderkinderen 0:8d87bc453349 168 /* maximum transfer unit */
ninoderkinderen 0:8d87bc453349 169 netif->mtu = 0x2EA;
ninoderkinderen 0:8d87bc453349 170
ninoderkinderen 0:8d87bc453349 171 /* device capabilities */
ninoderkinderen 0:8d87bc453349 172 /* don't set NETIF_FLAG_ETHARP if this device is not an ethernet one */
ninoderkinderen 0:8d87bc453349 173 netif->flags = NETIF_FLAG_BROADCAST | NETIF_FLAG_ETHARP | NETIF_FLAG_LINK_UP | NETIF_FLAG_IGMP;
ninoderkinderen 0:8d87bc453349 174
ninoderkinderen 0:8d87bc453349 175 netif->state = NULL;
ninoderkinderen 0:8d87bc453349 176 eth_netif = netif;
ninoderkinderen 0:8d87bc453349 177
ninoderkinderen 0:8d87bc453349 178 netif->name[0] = IFNAME0;
ninoderkinderen 0:8d87bc453349 179 netif->name[1] = IFNAME1;
ninoderkinderen 0:8d87bc453349 180
ninoderkinderen 0:8d87bc453349 181 /* We directly use etharp_output() here to save a function call.
ninoderkinderen 0:8d87bc453349 182 * You can instead declare your own function an call etharp_output()
ninoderkinderen 0:8d87bc453349 183 * from it if you have to do some checks before sending (e.g. if link
ninoderkinderen 0:8d87bc453349 184 * is available...) */
ninoderkinderen 0:8d87bc453349 185 netif->output = etharp_output;
ninoderkinderen 0:8d87bc453349 186 netif->linkoutput = eth_output;
ninoderkinderen 0:8d87bc453349 187
ninoderkinderen 0:8d87bc453349 188 if (!pEth) pEth = new Ethernet(); // only create Ethernet object if required
ninoderkinderen 0:8d87bc453349 189
ninoderkinderen 0:8d87bc453349 190 return ERR_OK;
ninoderkinderen 0:8d87bc453349 191 }
ninoderkinderen 0:8d87bc453349 192
ninoderkinderen 0:8d87bc453349 193 void eth_free()
ninoderkinderen 0:8d87bc453349 194 {
ninoderkinderen 0:8d87bc453349 195 if(pEth)
ninoderkinderen 0:8d87bc453349 196 delete pEth;
ninoderkinderen 0:8d87bc453349 197 pEth = NULL;
ninoderkinderen 0:8d87bc453349 198 }
ninoderkinderen 0:8d87bc453349 199
ninoderkinderen 0:8d87bc453349 200 void eth_address(char* mac) {
ninoderkinderen 0:8d87bc453349 201 pEth->address(mac);
ninoderkinderen 0:8d87bc453349 202 }
ninoderkinderen 0:8d87bc453349 203
ninoderkinderen 0:8d87bc453349 204 Ethernet* eth_interface() {
ninoderkinderen 0:8d87bc453349 205 return pEth;
ninoderkinderen 0:8d87bc453349 206 }
ninoderkinderen 0:8d87bc453349 207
ninoderkinderen 0:8d87bc453349 208 #ifdef __cplusplus
ninoderkinderen 0:8d87bc453349 209 };
ninoderkinderen 0:8d87bc453349 210 #endif
ninoderkinderen 0:8d87bc453349 211
ninoderkinderen 0:8d87bc453349 212 #endif