50a548bb7fe2f701ab97d9b526e2f760dd2f02fe
[people/meteger/gpxe.git] / src / net / icmpv6.c
1 #include <stdint.h>
2 #include <string.h>
3 #include <byteswap.h>
4 #include <errno.h>
5 #include <gpxe/in.h>
6 #include <gpxe/ip6.h>
7 #include <gpxe/if_ether.h>
8 #include <gpxe/iobuf.h>
9 #include <gpxe/ndp.h>
10 #include <gpxe/icmp6.h>
11 #include <gpxe/tcpip.h>
12 #include <gpxe/netdevice.h>
13
14 struct tcpip_protocol icmp6_protocol;
15
16 /**
17  * Send neighbour solicitation packet
18  *
19  * @v netdev    Network device
20  * @v src       Source address
21  * @v dest      Destination address
22  *
23  * This function prepares a neighbour solicitation packet and sends it to the
24  * network layer.
25  */
26 int icmp6_send_solicit ( struct net_device *netdev, struct in6_addr *src __unused,
27                          struct in6_addr *dest ) {
28         union {
29                 struct sockaddr_in6 sin6;
30                 struct sockaddr_tcpip st;
31         } st_dest;
32         struct ll_protocol *ll_protocol = netdev->ll_protocol;
33         struct neighbour_solicit *nsolicit;
34         struct io_buffer *iobuf = alloc_iob ( sizeof ( *nsolicit ) + MIN_IOB_LEN );
35         iob_reserve ( iobuf, MAX_HDR_LEN );
36         nsolicit = iob_put ( iobuf, sizeof ( *nsolicit ) );
37
38         /* Fill up the headers */
39         memset ( nsolicit, 0, sizeof ( *nsolicit ) );
40         nsolicit->type = ICMP6_NSOLICIT;
41         nsolicit->code = 0;
42         nsolicit->target = *dest;
43         nsolicit->opt_type = 1;
44         nsolicit->opt_len = ( 2 + ll_protocol->ll_addr_len ) / 8;
45         memcpy ( nsolicit->opt_ll_addr, netdev->ll_addr,
46                                 netdev->ll_protocol->ll_addr_len );
47         /* Partial checksum */
48         nsolicit->csum = 0;
49         nsolicit->csum = tcpip_chksum ( nsolicit, sizeof ( *nsolicit ) );
50
51         /* Solicited multicast address - FF02::1 (all stations on local network) */
52         memset(&st_dest.sin6, 0, sizeof(st_dest.sin6));
53         st_dest.sin6.sin_family = AF_INET6;
54         st_dest.sin6.sin6_addr.in6_u.u6_addr8[0] = 0xff;
55         st_dest.sin6.sin6_addr.in6_u.u6_addr8[1] = 0x2;
56         st_dest.sin6.sin6_addr.in6_u.u6_addr8[15] = 0x1;
57
58         /* Send packet over IP6 */
59         return tcpip_tx ( iobuf, &icmp6_protocol, NULL, &st_dest.st,
60                           NULL, &nsolicit->csum );
61 }
62
63 /**
64  * Process ICMP6 headers
65  *
66  * @v iobuf     I/O buffer
67  * @v st_src    Source address
68  * @v st_dest   Destination address
69  */
70 int icmp6_rx ( struct io_buffer *iobuf, struct sockaddr_tcpip *st_src,
71                struct sockaddr_tcpip *st_dest, struct net_device *netdev __unused,
72                uint16_t pshdr_csum __unused ) {
73         struct icmp6_header *icmp6hdr = iobuf->data;
74
75         /* Sanity check */
76         if ( iob_len ( iobuf ) < sizeof ( *icmp6hdr ) ) {
77                 DBG ( "Packet too short (%zd bytes)\n", iob_len ( iobuf ) );
78                 free_iob ( iobuf );
79                 return -EINVAL;
80         }
81
82         /* TODO: Verify checksum */
83
84         /* Process the ICMP header */
85         switch ( icmp6hdr->type ) {
86         case ICMP6_NADVERT:
87                 return ndp_process_advert ( iobuf, st_src, st_dest );
88         }
89         return -ENOSYS;
90 }
91
92 #if 0
93 void icmp6_test_nadvert (struct net_device *netdev, struct sockaddr_in6 *server_p, char *ll_addr) {
94
95                 struct sockaddr_in6 server;
96                 memcpy ( &server, server_p, sizeof ( server ) );
97                 struct io_buffer *rxiobuf = alloc_iob ( 500 );
98                 iob_reserve ( rxiobuf, MAX_HDR_LEN );
99                 struct neighbour_advert *nadvert = iob_put ( rxiobuf, sizeof ( *nadvert ) );
100                 nadvert->type = 136;
101                 nadvert->code = 0;
102                 nadvert->flags = ICMP6_FLAGS_SOLICITED;
103                 nadvert->csum = 0xffff;
104                 nadvert->target = server.sin6_addr;
105                 nadvert->opt_type = 2;
106                 nadvert->opt_len = 1;
107                 memcpy ( nadvert->opt_ll_addr, ll_addr, 6 );
108                 struct ip6_header *ip6hdr = iob_push ( rxiobuf, sizeof ( *ip6hdr ) );
109                 ip6hdr->ver_traffic_class_flow_label = htonl ( 0x60000000 );
110                 ip6hdr->hop_limit = 255;
111                 ip6hdr->nxt_hdr = 58;
112                 ip6hdr->payload_len = htons ( sizeof ( *nadvert ) );
113                 ip6hdr->src = server.sin6_addr;
114                 ip6hdr->dest = server.sin6_addr;
115                 hex_dump ( rxiobuf->data, iob_len ( rxiobuf ) );
116                 net_rx ( rxiobuf, netdev, htons ( ETH_P_IPV6 ), ll_addr );
117 }
118 #endif
119
120 /** ICMP6 protocol (needed for ipv6_tx) */
121 struct tcpip_protocol icmp6_protocol __tcpip_protocol = {
122         .name = "ICMP6",
123         .rx = NULL, /* icmp6_rx if tcpip passes netdev in future */
124         .tcpip_proto = IP_ICMP6, // 58
125 };
126