Michael Spencer / Mbed 2 deprecated LaOS

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

NetServices/drv/eth/eth_drv.cpp@1:f5ac63519541, 2014-03-05 (annotated)

Committer:
Michael J. Spencer
Date:
Wed Mar 05 06:14:02 2014 -0800
Revision:
1:f5ac63519541
Initial commit.

Who changed what in which revision?

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