]>
Commit | Line | Data |
---|---|---|
0d6ff71a GS |
1 | /* |
2 | * Copyright (c) 2013 | |
3 | * Guillaume Subiron, Yann Bordenave, Serigne Modou Wagne. | |
4 | */ | |
5 | ||
6 | #include "qemu/osdep.h" | |
7 | #include "slirp.h" | |
8 | #include "ip6_icmp.h" | |
9 | #include "qemu/timer.h" | |
10 | #include "qemu/error-report.h" | |
11 | #include "qemu/log.h" | |
0d6ff71a GS |
12 | |
13 | #define NDP_Interval g_rand_int_range(slirp->grand, \ | |
14 | NDP_MinRtrAdvInterval, NDP_MaxRtrAdvInterval) | |
15 | ||
16 | static void ra_timer_handler(void *opaque) | |
17 | { | |
18 | Slirp *slirp = opaque; | |
19 | timer_mod(slirp->ra_timer, | |
20 | qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + NDP_Interval); | |
21 | ndp_send_ra(slirp); | |
22 | } | |
23 | ||
24 | void icmp6_init(Slirp *slirp) | |
25 | { | |
0b11c036 ST |
26 | if (!slirp->in6_enabled) { |
27 | return; | |
28 | } | |
29 | ||
0d6ff71a GS |
30 | slirp->ra_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL, ra_timer_handler, slirp); |
31 | timer_mod(slirp->ra_timer, | |
32 | qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + NDP_Interval); | |
33 | } | |
34 | ||
35 | void icmp6_cleanup(Slirp *slirp) | |
36 | { | |
0b11c036 ST |
37 | if (!slirp->in6_enabled) { |
38 | return; | |
39 | } | |
40 | ||
0d6ff71a GS |
41 | timer_del(slirp->ra_timer); |
42 | timer_free(slirp->ra_timer); | |
43 | } | |
44 | ||
45 | static void icmp6_send_echoreply(struct mbuf *m, Slirp *slirp, struct ip6 *ip, | |
46 | struct icmp6 *icmp) | |
47 | { | |
48 | struct mbuf *t = m_get(slirp); | |
49 | t->m_len = sizeof(struct ip6) + ntohs(ip->ip_pl); | |
50 | memcpy(t->m_data, m->m_data, t->m_len); | |
51 | ||
52 | /* IPv6 Packet */ | |
53 | struct ip6 *rip = mtod(t, struct ip6 *); | |
54 | rip->ip_dst = ip->ip_src; | |
55 | rip->ip_src = ip->ip_dst; | |
56 | ||
57 | /* ICMPv6 packet */ | |
58 | t->m_data += sizeof(struct ip6); | |
59 | struct icmp6 *ricmp = mtod(t, struct icmp6 *); | |
60 | ricmp->icmp6_type = ICMP6_ECHO_REPLY; | |
61 | ricmp->icmp6_cksum = 0; | |
62 | ||
63 | /* Checksum */ | |
64 | t->m_data -= sizeof(struct ip6); | |
65 | ricmp->icmp6_cksum = ip6_cksum(t); | |
66 | ||
67 | ip6_output(NULL, t, 0); | |
68 | } | |
69 | ||
fc6c9257 YB |
70 | void icmp6_send_error(struct mbuf *m, uint8_t type, uint8_t code) |
71 | { | |
72 | Slirp *slirp = m->slirp; | |
73 | struct mbuf *t; | |
74 | struct ip6 *ip = mtod(m, struct ip6 *); | |
75 | ||
76 | DEBUG_CALL("icmp6_send_error"); | |
77 | DEBUG_ARGS((dfd, " type = %d, code = %d\n", type, code)); | |
78 | ||
79 | if (IN6_IS_ADDR_MULTICAST(&ip->ip_src) || | |
80 | IN6_IS_ADDR_UNSPECIFIED(&ip->ip_src)) { | |
81 | /* TODO icmp error? */ | |
82 | return; | |
83 | } | |
84 | ||
85 | t = m_get(slirp); | |
86 | ||
87 | /* IPv6 packet */ | |
88 | struct ip6 *rip = mtod(t, struct ip6 *); | |
89 | rip->ip_src = (struct in6_addr)LINKLOCAL_ADDR; | |
90 | rip->ip_dst = ip->ip_src; | |
91 | #if !defined(_WIN32) || (_WIN32_WINNT >= 0x0600) | |
92 | char addrstr[INET6_ADDRSTRLEN]; | |
93 | inet_ntop(AF_INET6, &rip->ip_dst, addrstr, INET6_ADDRSTRLEN); | |
94 | DEBUG_ARG("target = %s", addrstr); | |
95 | #endif | |
96 | ||
97 | rip->ip_nh = IPPROTO_ICMPV6; | |
98 | const int error_data_len = min(m->m_len, | |
99 | IF_MTU - (sizeof(struct ip6) + ICMP6_ERROR_MINLEN)); | |
100 | rip->ip_pl = htons(ICMP6_ERROR_MINLEN + error_data_len); | |
101 | t->m_len = sizeof(struct ip6) + ntohs(rip->ip_pl); | |
102 | ||
103 | /* ICMPv6 packet */ | |
104 | t->m_data += sizeof(struct ip6); | |
105 | struct icmp6 *ricmp = mtod(t, struct icmp6 *); | |
106 | ricmp->icmp6_type = type; | |
107 | ricmp->icmp6_code = code; | |
108 | ricmp->icmp6_cksum = 0; | |
109 | ||
110 | switch (type) { | |
111 | case ICMP6_UNREACH: | |
112 | case ICMP6_TIMXCEED: | |
113 | ricmp->icmp6_err.unused = 0; | |
114 | break; | |
115 | case ICMP6_TOOBIG: | |
116 | ricmp->icmp6_err.mtu = htonl(IF_MTU); | |
117 | break; | |
118 | case ICMP6_PARAMPROB: | |
119 | /* TODO: Handle this case */ | |
120 | break; | |
121 | default: | |
122 | g_assert_not_reached(); | |
123 | break; | |
124 | } | |
125 | t->m_data += ICMP6_ERROR_MINLEN; | |
126 | memcpy(t->m_data, m->m_data, error_data_len); | |
127 | ||
128 | /* Checksum */ | |
129 | t->m_data -= ICMP6_ERROR_MINLEN; | |
130 | t->m_data -= sizeof(struct ip6); | |
131 | ricmp->icmp6_cksum = ip6_cksum(t); | |
132 | ||
133 | ip6_output(NULL, t, 0); | |
134 | } | |
135 | ||
0d6ff71a GS |
136 | /* |
137 | * Send NDP Router Advertisement | |
138 | */ | |
139 | void ndp_send_ra(Slirp *slirp) | |
140 | { | |
141 | DEBUG_CALL("ndp_send_ra"); | |
142 | ||
143 | /* Build IPv6 packet */ | |
144 | struct mbuf *t = m_get(slirp); | |
145 | struct ip6 *rip = mtod(t, struct ip6 *); | |
146 | rip->ip_src = (struct in6_addr)LINKLOCAL_ADDR; | |
147 | rip->ip_dst = (struct in6_addr)ALLNODES_MULTICAST; | |
148 | rip->ip_nh = IPPROTO_ICMPV6; | |
149 | rip->ip_pl = htons(ICMP6_NDP_RA_MINLEN | |
150 | + NDPOPT_LINKLAYER_LEN | |
151 | + NDPOPT_PREFIXINFO_LEN); | |
152 | t->m_len = sizeof(struct ip6) + ntohs(rip->ip_pl); | |
153 | ||
154 | /* Build ICMPv6 packet */ | |
155 | t->m_data += sizeof(struct ip6); | |
156 | struct icmp6 *ricmp = mtod(t, struct icmp6 *); | |
157 | ricmp->icmp6_type = ICMP6_NDP_RA; | |
158 | ricmp->icmp6_code = 0; | |
159 | ricmp->icmp6_cksum = 0; | |
160 | ||
161 | /* NDP */ | |
162 | ricmp->icmp6_nra.chl = NDP_AdvCurHopLimit; | |
163 | ricmp->icmp6_nra.M = NDP_AdvManagedFlag; | |
164 | ricmp->icmp6_nra.O = NDP_AdvOtherConfigFlag; | |
165 | ricmp->icmp6_nra.reserved = 0; | |
166 | ricmp->icmp6_nra.lifetime = htons(NDP_AdvDefaultLifetime); | |
167 | ricmp->icmp6_nra.reach_time = htonl(NDP_AdvReachableTime); | |
168 | ricmp->icmp6_nra.retrans_time = htonl(NDP_AdvRetransTime); | |
169 | ||
170 | /* Source link-layer address (NDP option) */ | |
171 | t->m_data += ICMP6_NDP_RA_MINLEN; | |
172 | struct ndpopt *opt = mtod(t, struct ndpopt *); | |
173 | opt->ndpopt_type = NDPOPT_LINKLAYER_SOURCE; | |
174 | opt->ndpopt_len = NDPOPT_LINKLAYER_LEN / 8; | |
175 | in6_compute_ethaddr(rip->ip_src, opt->ndpopt_linklayer); | |
176 | ||
177 | /* Prefix information (NDP option) */ | |
178 | t->m_data += NDPOPT_LINKLAYER_LEN; | |
179 | struct ndpopt *opt2 = mtod(t, struct ndpopt *); | |
180 | opt2->ndpopt_type = NDPOPT_PREFIX_INFO; | |
181 | opt2->ndpopt_len = NDPOPT_PREFIXINFO_LEN / 8; | |
182 | opt2->ndpopt_prefixinfo.prefix_length = slirp->vprefix_len; | |
183 | opt2->ndpopt_prefixinfo.L = 1; | |
184 | opt2->ndpopt_prefixinfo.A = 1; | |
185 | opt2->ndpopt_prefixinfo.reserved1 = 0; | |
186 | opt2->ndpopt_prefixinfo.valid_lt = htonl(NDP_AdvValidLifetime); | |
187 | opt2->ndpopt_prefixinfo.pref_lt = htonl(NDP_AdvPrefLifetime); | |
188 | opt2->ndpopt_prefixinfo.reserved2 = 0; | |
189 | opt2->ndpopt_prefixinfo.prefix = slirp->vprefix_addr6; | |
190 | ||
191 | /* ICMPv6 Checksum */ | |
192 | t->m_data -= NDPOPT_LINKLAYER_LEN; | |
193 | t->m_data -= ICMP6_NDP_RA_MINLEN; | |
194 | t->m_data -= sizeof(struct ip6); | |
195 | ricmp->icmp6_cksum = ip6_cksum(t); | |
196 | ||
197 | ip6_output(NULL, t, 0); | |
198 | } | |
199 | ||
200 | /* | |
201 | * Send NDP Neighbor Solitication | |
202 | */ | |
203 | void ndp_send_ns(Slirp *slirp, struct in6_addr addr) | |
204 | { | |
205 | DEBUG_CALL("ndp_send_ns"); | |
206 | #if !defined(_WIN32) || (_WIN32_WINNT >= 0x0600) | |
207 | char addrstr[INET6_ADDRSTRLEN]; | |
208 | inet_ntop(AF_INET6, &addr, addrstr, INET6_ADDRSTRLEN); | |
209 | DEBUG_ARG("target = %s", addrstr); | |
210 | #endif | |
211 | ||
212 | /* Build IPv6 packet */ | |
213 | struct mbuf *t = m_get(slirp); | |
214 | struct ip6 *rip = mtod(t, struct ip6 *); | |
215 | rip->ip_src = slirp->vhost_addr6; | |
216 | rip->ip_dst = (struct in6_addr)SOLICITED_NODE_PREFIX; | |
217 | memcpy(&rip->ip_dst.s6_addr[13], &addr.s6_addr[13], 3); | |
218 | rip->ip_nh = IPPROTO_ICMPV6; | |
219 | rip->ip_pl = htons(ICMP6_NDP_NS_MINLEN + NDPOPT_LINKLAYER_LEN); | |
220 | t->m_len = sizeof(struct ip6) + ntohs(rip->ip_pl); | |
221 | ||
222 | /* Build ICMPv6 packet */ | |
223 | t->m_data += sizeof(struct ip6); | |
224 | struct icmp6 *ricmp = mtod(t, struct icmp6 *); | |
225 | ricmp->icmp6_type = ICMP6_NDP_NS; | |
226 | ricmp->icmp6_code = 0; | |
227 | ricmp->icmp6_cksum = 0; | |
228 | ||
229 | /* NDP */ | |
230 | ricmp->icmp6_nns.reserved = 0; | |
231 | ricmp->icmp6_nns.target = addr; | |
232 | ||
233 | /* Build NDP option */ | |
234 | t->m_data += ICMP6_NDP_NS_MINLEN; | |
235 | struct ndpopt *opt = mtod(t, struct ndpopt *); | |
236 | opt->ndpopt_type = NDPOPT_LINKLAYER_SOURCE; | |
237 | opt->ndpopt_len = NDPOPT_LINKLAYER_LEN / 8; | |
238 | in6_compute_ethaddr(slirp->vhost_addr6, opt->ndpopt_linklayer); | |
239 | ||
240 | /* ICMPv6 Checksum */ | |
241 | t->m_data -= ICMP6_NDP_NA_MINLEN; | |
242 | t->m_data -= sizeof(struct ip6); | |
243 | ricmp->icmp6_cksum = ip6_cksum(t); | |
244 | ||
245 | ip6_output(NULL, t, 1); | |
246 | } | |
247 | ||
248 | /* | |
249 | * Send NDP Neighbor Advertisement | |
250 | */ | |
251 | static void ndp_send_na(Slirp *slirp, struct ip6 *ip, struct icmp6 *icmp) | |
252 | { | |
253 | /* Build IPv6 packet */ | |
254 | struct mbuf *t = m_get(slirp); | |
255 | struct ip6 *rip = mtod(t, struct ip6 *); | |
256 | rip->ip_src = icmp->icmp6_nns.target; | |
257 | if (IN6_IS_ADDR_UNSPECIFIED(&ip->ip_src)) { | |
258 | rip->ip_dst = (struct in6_addr)ALLNODES_MULTICAST; | |
259 | } else { | |
260 | rip->ip_dst = ip->ip_src; | |
261 | } | |
262 | rip->ip_nh = IPPROTO_ICMPV6; | |
263 | rip->ip_pl = htons(ICMP6_NDP_NA_MINLEN | |
264 | + NDPOPT_LINKLAYER_LEN); | |
265 | t->m_len = sizeof(struct ip6) + ntohs(rip->ip_pl); | |
266 | ||
267 | /* Build ICMPv6 packet */ | |
268 | t->m_data += sizeof(struct ip6); | |
269 | struct icmp6 *ricmp = mtod(t, struct icmp6 *); | |
270 | ricmp->icmp6_type = ICMP6_NDP_NA; | |
271 | ricmp->icmp6_code = 0; | |
272 | ricmp->icmp6_cksum = 0; | |
273 | ||
274 | /* NDP */ | |
275 | ricmp->icmp6_nna.R = NDP_IsRouter; | |
276 | ricmp->icmp6_nna.S = !IN6_IS_ADDR_MULTICAST(&rip->ip_dst); | |
277 | ricmp->icmp6_nna.O = 1; | |
278 | ricmp->icmp6_nna.reserved_hi = 0; | |
279 | ricmp->icmp6_nna.reserved_lo = 0; | |
280 | ricmp->icmp6_nna.target = icmp->icmp6_nns.target; | |
281 | ||
282 | /* Build NDP option */ | |
283 | t->m_data += ICMP6_NDP_NA_MINLEN; | |
284 | struct ndpopt *opt = mtod(t, struct ndpopt *); | |
285 | opt->ndpopt_type = NDPOPT_LINKLAYER_TARGET; | |
286 | opt->ndpopt_len = NDPOPT_LINKLAYER_LEN / 8; | |
287 | in6_compute_ethaddr(ricmp->icmp6_nna.target, | |
288 | opt->ndpopt_linklayer); | |
289 | ||
290 | /* ICMPv6 Checksum */ | |
291 | t->m_data -= ICMP6_NDP_NA_MINLEN; | |
292 | t->m_data -= sizeof(struct ip6); | |
293 | ricmp->icmp6_cksum = ip6_cksum(t); | |
294 | ||
295 | ip6_output(NULL, t, 0); | |
296 | } | |
297 | ||
298 | /* | |
299 | * Process a NDP message | |
300 | */ | |
301 | static void ndp_input(struct mbuf *m, Slirp *slirp, struct ip6 *ip, | |
302 | struct icmp6 *icmp) | |
303 | { | |
304 | m->m_len += ETH_HLEN; | |
305 | m->m_data -= ETH_HLEN; | |
306 | struct ethhdr *eth = mtod(m, struct ethhdr *); | |
307 | m->m_len -= ETH_HLEN; | |
308 | m->m_data += ETH_HLEN; | |
309 | ||
310 | switch (icmp->icmp6_type) { | |
311 | case ICMP6_NDP_RS: | |
312 | DEBUG_CALL(" type = Router Solicitation"); | |
313 | if (ip->ip_hl == 255 | |
314 | && icmp->icmp6_code == 0 | |
315 | && ntohs(ip->ip_pl) >= ICMP6_NDP_RS_MINLEN) { | |
316 | /* Gratuitous NDP */ | |
317 | ndp_table_add(slirp, ip->ip_src, eth->h_source); | |
318 | ||
319 | ndp_send_ra(slirp); | |
320 | } | |
321 | break; | |
322 | ||
323 | case ICMP6_NDP_RA: | |
324 | DEBUG_CALL(" type = Router Advertisement"); | |
325 | qemu_log_mask(LOG_GUEST_ERROR, | |
326 | "Warning: guest sent NDP RA, but shouldn't"); | |
327 | break; | |
328 | ||
329 | case ICMP6_NDP_NS: | |
330 | DEBUG_CALL(" type = Neighbor Solicitation"); | |
331 | if (ip->ip_hl == 255 | |
332 | && icmp->icmp6_code == 0 | |
333 | && !IN6_IS_ADDR_MULTICAST(&icmp->icmp6_nns.target) | |
334 | && ntohs(ip->ip_pl) >= ICMP6_NDP_NS_MINLEN | |
335 | && (!IN6_IS_ADDR_UNSPECIFIED(&ip->ip_src) | |
336 | || in6_solicitednode_multicast(&ip->ip_dst))) { | |
337 | if (in6_equal_host(&icmp->icmp6_nns.target)) { | |
338 | /* Gratuitous NDP */ | |
339 | ndp_table_add(slirp, ip->ip_src, eth->h_source); | |
340 | ndp_send_na(slirp, ip, icmp); | |
341 | } | |
342 | } | |
343 | break; | |
344 | ||
345 | case ICMP6_NDP_NA: | |
346 | DEBUG_CALL(" type = Neighbor Advertisement"); | |
347 | if (ip->ip_hl == 255 | |
348 | && icmp->icmp6_code == 0 | |
349 | && ntohs(ip->ip_pl) >= ICMP6_NDP_NA_MINLEN | |
350 | && !IN6_IS_ADDR_MULTICAST(&icmp->icmp6_nna.target) | |
351 | && (!IN6_IS_ADDR_MULTICAST(&ip->ip_dst) | |
352 | || icmp->icmp6_nna.S == 0)) { | |
353 | ndp_table_add(slirp, ip->ip_src, eth->h_source); | |
354 | } | |
355 | break; | |
356 | ||
357 | case ICMP6_NDP_REDIRECT: | |
358 | DEBUG_CALL(" type = Redirect"); | |
359 | qemu_log_mask(LOG_GUEST_ERROR, | |
360 | "Warning: guest sent NDP REDIRECT, but shouldn't"); | |
361 | break; | |
362 | } | |
363 | } | |
364 | ||
365 | /* | |
366 | * Process a received ICMPv6 message. | |
367 | */ | |
368 | void icmp6_input(struct mbuf *m) | |
369 | { | |
370 | struct icmp6 *icmp; | |
371 | struct ip6 *ip = mtod(m, struct ip6 *); | |
372 | Slirp *slirp = m->slirp; | |
373 | int hlen = sizeof(struct ip6); | |
374 | ||
375 | DEBUG_CALL("icmp6_input"); | |
376 | DEBUG_ARG("m = %lx", (long) m); | |
377 | DEBUG_ARG("m_len = %d", m->m_len); | |
378 | ||
379 | if (ntohs(ip->ip_pl) < ICMP6_MINLEN) { | |
380 | goto end; | |
381 | } | |
382 | ||
383 | if (ip6_cksum(m)) { | |
384 | goto end; | |
385 | } | |
386 | ||
387 | m->m_len -= hlen; | |
388 | m->m_data += hlen; | |
389 | icmp = mtod(m, struct icmp6 *); | |
390 | m->m_len += hlen; | |
391 | m->m_data -= hlen; | |
392 | ||
393 | DEBUG_ARG("icmp6_type = %d", icmp->icmp6_type); | |
394 | switch (icmp->icmp6_type) { | |
395 | case ICMP6_ECHO_REQUEST: | |
396 | if (in6_equal_host(&ip->ip_dst)) { | |
397 | icmp6_send_echoreply(m, slirp, ip, icmp); | |
398 | } else { | |
399 | /* TODO */ | |
400 | error_report("external icmpv6 not supported yet"); | |
401 | } | |
402 | break; | |
403 | ||
404 | case ICMP6_NDP_RS: | |
405 | case ICMP6_NDP_RA: | |
406 | case ICMP6_NDP_NS: | |
407 | case ICMP6_NDP_NA: | |
408 | case ICMP6_NDP_REDIRECT: | |
409 | ndp_input(m, slirp, ip, icmp); | |
410 | break; | |
411 | ||
412 | case ICMP6_UNREACH: | |
413 | case ICMP6_TOOBIG: | |
414 | case ICMP6_TIMXCEED: | |
415 | case ICMP6_PARAMPROB: | |
416 | /* XXX? report error? close socket? */ | |
417 | default: | |
418 | break; | |
419 | } | |
420 | ||
421 | end: | |
422 | m_free(m); | |
423 | } |