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