[undi] Fill in ProtType correctly in PXENV_UNDI_ISR
[people/balajirrao/gpxe.git] / src / net / ethernet.c
1 /*
2  * Copyright (C) 2006 Michael Brown <mbrown@fensystems.co.uk>.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License as
6  * published by the Free Software Foundation; either version 2 of the
7  * License, or any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but
10  * WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License
15  * along with this program; if not, write to the Free Software
16  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
17  */
18
19 #include <stdint.h>
20 #include <stdio.h>
21 #include <string.h>
22 #include <byteswap.h>
23 #include <errno.h>
24 #include <assert.h>
25 #include <gpxe/if_arp.h>
26 #include <gpxe/if_ether.h>
27 #include <gpxe/netdevice.h>
28 #include <gpxe/iobuf.h>
29 #include <gpxe/ethernet.h>
30
31 /** @file
32  *
33  * Ethernet protocol
34  *
35  */
36
37 /** Ethernet broadcast MAC address */
38 static uint8_t eth_broadcast[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
39
40 /**
41  * Add Ethernet link-layer header
42  *
43  * @v iobuf             I/O buffer
44  * @v netdev            Network device
45  * @v net_protocol      Network-layer protocol
46  * @v ll_dest           Link-layer destination address
47  */
48 static int eth_push ( struct io_buffer *iobuf, struct net_device *netdev,
49                       struct net_protocol *net_protocol,
50                       const void *ll_dest ) {
51         struct ethhdr *ethhdr = iob_push ( iobuf, sizeof ( *ethhdr ) );
52
53         /* Build Ethernet header */
54         memcpy ( ethhdr->h_dest, ll_dest, ETH_ALEN );
55         memcpy ( ethhdr->h_source, netdev->ll_addr, ETH_ALEN );
56         ethhdr->h_protocol = net_protocol->net_proto;
57
58         return 0;
59 }
60
61 /**
62  * Remove Ethernet link-layer header
63  *
64  * @v iobuf             I/O buffer
65  * @v netdev            Network device
66  * @v net_proto         Network-layer protocol, in network-byte order
67  * @v ll_source         Source link-layer address
68  * @ret rc              Return status code
69  */
70 static int eth_pull ( struct io_buffer *iobuf,
71                       struct net_device *netdev __unused,
72                       uint16_t *net_proto, const void **ll_source ) {
73         struct ethhdr *ethhdr = iobuf->data;
74
75         /* Sanity check */
76         if ( iob_len ( iobuf ) < sizeof ( *ethhdr ) ) {
77                 DBG ( "Ethernet packet too short (%zd bytes)\n",
78                       iob_len ( iobuf ) );
79                 return -EINVAL;
80         }
81
82         /* Strip off Ethernet header */
83         iob_pull ( iobuf, sizeof ( *ethhdr ) );
84
85         /* Fill in required fields */
86         *net_proto = ethhdr->h_protocol;
87         *ll_source = ethhdr->h_source;
88
89         return 0;
90 }
91
92 /**
93  * Transcribe Ethernet address
94  *
95  * @v ll_addr   Link-layer address
96  * @ret string  Link-layer address in human-readable format
97  */
98 const char * eth_ntoa ( const void *ll_addr ) {
99         static char buf[18]; /* "00:00:00:00:00:00" */
100         const uint8_t *eth_addr = ll_addr;
101
102         sprintf ( buf, "%02x:%02x:%02x:%02x:%02x:%02x",
103                   eth_addr[0], eth_addr[1], eth_addr[2],
104                   eth_addr[3], eth_addr[4], eth_addr[5] );
105         return buf;
106 }
107
108 /** Ethernet protocol */
109 struct ll_protocol ethernet_protocol __ll_protocol = {
110         .name           = "Ethernet",
111         .ll_proto       = htons ( ARPHRD_ETHER ),
112         .ll_addr_len    = ETH_ALEN,
113         .ll_header_len  = ETH_HLEN,
114         .ll_broadcast   = eth_broadcast,
115         .push           = eth_push,
116         .pull           = eth_pull,
117         .ntoa           = eth_ntoa,
118 };