slirp/ip6_icmp.c

   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"
  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 {
  26     if (!slirp->in6_enabled) {
  27         return;
  28     }
  29
  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 {
  37     if (!slirp->in6_enabled) {
  38         return;
  39     }
  40
  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
  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
 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 #ifndef _WIN32
 153                         + NDPOPT_RDNSS_LEN
 154 #endif
 155                         );
 156     t->m_len = sizeof(struct ip6) + ntohs(rip->ip_pl);
 157
 158     /* Build ICMPv6 packet */
 159     t->m_data += sizeof(struct ip6);
 160     struct icmp6 *ricmp = mtod(t, struct icmp6 *);
 161     ricmp->icmp6_type = ICMP6_NDP_RA;
 162     ricmp->icmp6_code = 0;
 163     ricmp->icmp6_cksum = 0;
 164
 165     /* NDP */
 166     ricmp->icmp6_nra.chl = NDP_AdvCurHopLimit;
 167     ricmp->icmp6_nra.M = NDP_AdvManagedFlag;
 168     ricmp->icmp6_nra.O = NDP_AdvOtherConfigFlag;
 169     ricmp->icmp6_nra.reserved = 0;
 170     ricmp->icmp6_nra.lifetime = htons(NDP_AdvDefaultLifetime);
 171     ricmp->icmp6_nra.reach_time = htonl(NDP_AdvReachableTime);
 172     ricmp->icmp6_nra.retrans_time = htonl(NDP_AdvRetransTime);
 173     t->m_data += ICMP6_NDP_RA_MINLEN;
 174
 175     /* Source link-layer address (NDP option) */
 176     struct ndpopt *opt = mtod(t, struct ndpopt *);
 177     opt->ndpopt_type = NDPOPT_LINKLAYER_SOURCE;
 178     opt->ndpopt_len = NDPOPT_LINKLAYER_LEN / 8;
 179     in6_compute_ethaddr(rip->ip_src, opt->ndpopt_linklayer);
 180     t->m_data += NDPOPT_LINKLAYER_LEN;
 181
 182     /* Prefix information (NDP option) */
 183     struct ndpopt *opt2 = mtod(t, struct ndpopt *);
 184     opt2->ndpopt_type = NDPOPT_PREFIX_INFO;
 185     opt2->ndpopt_len = NDPOPT_PREFIXINFO_LEN / 8;
 186     opt2->ndpopt_prefixinfo.prefix_length = slirp->vprefix_len;
 187     opt2->ndpopt_prefixinfo.L = 1;
 188     opt2->ndpopt_prefixinfo.A = 1;
 189     opt2->ndpopt_prefixinfo.reserved1 = 0;
 190     opt2->ndpopt_prefixinfo.valid_lt = htonl(NDP_AdvValidLifetime);
 191     opt2->ndpopt_prefixinfo.pref_lt = htonl(NDP_AdvPrefLifetime);
 192     opt2->ndpopt_prefixinfo.reserved2 = 0;
 193     opt2->ndpopt_prefixinfo.prefix = slirp->vprefix_addr6;
 194     t->m_data += NDPOPT_PREFIXINFO_LEN;
 195
 196 #ifndef _WIN32
 197     /* Prefix information (NDP option) */
 198     /* disabled for windows for now, until get_dns6_addr is implemented */
 199     struct ndpopt *opt3 = mtod(t, struct ndpopt *);
 200     opt3->ndpopt_type = NDPOPT_RDNSS;
 201     opt3->ndpopt_len = NDPOPT_RDNSS_LEN / 8;
 202     opt3->ndpopt_rdnss.reserved = 0;
 203     opt3->ndpopt_rdnss.lifetime = htonl(2 * NDP_MaxRtrAdvInterval);
 204     opt3->ndpopt_rdnss.addr = slirp->vnameserver_addr6;
 205     t->m_data += NDPOPT_RDNSS_LEN;
 206 #endif
 207
 208     /* ICMPv6 Checksum */
 209 #ifndef _WIN32
 210     t->m_data -= NDPOPT_RDNSS_LEN;
 211 #endif
 212     t->m_data -= NDPOPT_PREFIXINFO_LEN;
 213     t->m_data -= NDPOPT_LINKLAYER_LEN;
 214     t->m_data -= ICMP6_NDP_RA_MINLEN;
 215     t->m_data -= sizeof(struct ip6);
 216     ricmp->icmp6_cksum = ip6_cksum(t);
 217
 218     ip6_output(NULL, t, 0);
 219 }
 220
 221 /*
 222  * Send NDP Neighbor Solitication
 223  */
 224 void ndp_send_ns(Slirp *slirp, struct in6_addr addr)
 225 {
 226     DEBUG_CALL("ndp_send_ns");
 227 #if !defined(_WIN32) || (_WIN32_WINNT >= 0x0600)
 228     char addrstr[INET6_ADDRSTRLEN];
 229     inet_ntop(AF_INET6, &addr, addrstr, INET6_ADDRSTRLEN);
 230     DEBUG_ARG("target = %s", addrstr);
 231 #endif
 232
 233     /* Build IPv6 packet */
 234     struct mbuf *t = m_get(slirp);
 235     struct ip6 *rip = mtod(t, struct ip6 *);
 236     rip->ip_src = slirp->vhost_addr6;
 237     rip->ip_dst = (struct in6_addr)SOLICITED_NODE_PREFIX;
 238     memcpy(&rip->ip_dst.s6_addr[13], &addr.s6_addr[13], 3);
 239     rip->ip_nh = IPPROTO_ICMPV6;
 240     rip->ip_pl = htons(ICMP6_NDP_NS_MINLEN + NDPOPT_LINKLAYER_LEN);
 241     t->m_len = sizeof(struct ip6) + ntohs(rip->ip_pl);
 242
 243     /* Build ICMPv6 packet */
 244     t->m_data += sizeof(struct ip6);
 245     struct icmp6 *ricmp = mtod(t, struct icmp6 *);
 246     ricmp->icmp6_type = ICMP6_NDP_NS;
 247     ricmp->icmp6_code = 0;
 248     ricmp->icmp6_cksum = 0;
 249
 250     /* NDP */
 251     ricmp->icmp6_nns.reserved = 0;
 252     ricmp->icmp6_nns.target = addr;
 253
 254     /* Build NDP option */
 255     t->m_data += ICMP6_NDP_NS_MINLEN;
 256     struct ndpopt *opt = mtod(t, struct ndpopt *);
 257     opt->ndpopt_type = NDPOPT_LINKLAYER_SOURCE;
 258     opt->ndpopt_len = NDPOPT_LINKLAYER_LEN / 8;
 259     in6_compute_ethaddr(slirp->vhost_addr6, opt->ndpopt_linklayer);
 260
 261     /* ICMPv6 Checksum */
 262     t->m_data -= ICMP6_NDP_NA_MINLEN;
 263     t->m_data -= sizeof(struct ip6);
 264     ricmp->icmp6_cksum = ip6_cksum(t);
 265
 266     ip6_output(NULL, t, 1);
 267 }
 268
 269 /*
 270  * Send NDP Neighbor Advertisement
 271  */
 272 static void ndp_send_na(Slirp *slirp, struct ip6 *ip, struct icmp6 *icmp)
 273 {
 274     /* Build IPv6 packet */
 275     struct mbuf *t = m_get(slirp);
 276     struct ip6 *rip = mtod(t, struct ip6 *);
 277     rip->ip_src = icmp->icmp6_nns.target;
 278     if (IN6_IS_ADDR_UNSPECIFIED(&ip->ip_src)) {
 279         rip->ip_dst = (struct in6_addr)ALLNODES_MULTICAST;
 280     } else {
 281         rip->ip_dst = ip->ip_src;
 282     }
 283     rip->ip_nh = IPPROTO_ICMPV6;
 284     rip->ip_pl = htons(ICMP6_NDP_NA_MINLEN
 285                         + NDPOPT_LINKLAYER_LEN);
 286     t->m_len = sizeof(struct ip6) + ntohs(rip->ip_pl);
 287
 288     /* Build ICMPv6 packet */
 289     t->m_data += sizeof(struct ip6);
 290     struct icmp6 *ricmp = mtod(t, struct icmp6 *);
 291     ricmp->icmp6_type = ICMP6_NDP_NA;
 292     ricmp->icmp6_code = 0;
 293     ricmp->icmp6_cksum = 0;
 294
 295     /* NDP */
 296     ricmp->icmp6_nna.R = NDP_IsRouter;
 297     ricmp->icmp6_nna.S = !IN6_IS_ADDR_MULTICAST(&rip->ip_dst);
 298     ricmp->icmp6_nna.O = 1;
 299     ricmp->icmp6_nna.reserved_hi = 0;
 300     ricmp->icmp6_nna.reserved_lo = 0;
 301     ricmp->icmp6_nna.target = icmp->icmp6_nns.target;
 302
 303     /* Build NDP option */
 304     t->m_data += ICMP6_NDP_NA_MINLEN;
 305     struct ndpopt *opt = mtod(t, struct ndpopt *);
 306     opt->ndpopt_type = NDPOPT_LINKLAYER_TARGET;
 307     opt->ndpopt_len = NDPOPT_LINKLAYER_LEN / 8;
 308     in6_compute_ethaddr(ricmp->icmp6_nna.target,
 309                     opt->ndpopt_linklayer);
 310
 311     /* ICMPv6 Checksum */
 312     t->m_data -= ICMP6_NDP_NA_MINLEN;
 313     t->m_data -= sizeof(struct ip6);
 314     ricmp->icmp6_cksum = ip6_cksum(t);
 315
 316     ip6_output(NULL, t, 0);
 317 }
 318
 319 /*
 320  * Process a NDP message
 321  */
 322 static void ndp_input(struct mbuf *m, Slirp *slirp, struct ip6 *ip,
 323         struct icmp6 *icmp)
 324 {
 325     m->m_len += ETH_HLEN;
 326     m->m_data -= ETH_HLEN;
 327     struct ethhdr *eth = mtod(m, struct ethhdr *);
 328     m->m_len -= ETH_HLEN;
 329     m->m_data += ETH_HLEN;
 330
 331     switch (icmp->icmp6_type) {
 332     case ICMP6_NDP_RS:
 333         DEBUG_CALL(" type = Router Solicitation");
 334         if (ip->ip_hl == 255
 335                 && icmp->icmp6_code == 0
 336                 && ntohs(ip->ip_pl) >= ICMP6_NDP_RS_MINLEN) {
 337             /* Gratuitous NDP */
 338             ndp_table_add(slirp, ip->ip_src, eth->h_source);
 339
 340             ndp_send_ra(slirp);
 341         }
 342         break;
 343
 344     case ICMP6_NDP_RA:
 345         DEBUG_CALL(" type = Router Advertisement");
 346         qemu_log_mask(LOG_GUEST_ERROR,
 347                 "Warning: guest sent NDP RA, but shouldn't");
 348         break;
 349
 350     case ICMP6_NDP_NS:
 351         DEBUG_CALL(" type = Neighbor Solicitation");
 352         if (ip->ip_hl == 255
 353                 && icmp->icmp6_code == 0
 354                 && !IN6_IS_ADDR_MULTICAST(&icmp->icmp6_nns.target)
 355                 && ntohs(ip->ip_pl) >= ICMP6_NDP_NS_MINLEN
 356                 && (!IN6_IS_ADDR_UNSPECIFIED(&ip->ip_src)
 357                     || in6_solicitednode_multicast(&ip->ip_dst))) {
 358             if (in6_equal_host(&icmp->icmp6_nns.target)) {
 359                 /* Gratuitous NDP */
 360                 ndp_table_add(slirp, ip->ip_src, eth->h_source);
 361                 ndp_send_na(slirp, ip, icmp);
 362             }
 363         }
 364         break;
 365
 366     case ICMP6_NDP_NA:
 367         DEBUG_CALL(" type = Neighbor Advertisement");
 368         if (ip->ip_hl == 255
 369                 && icmp->icmp6_code == 0
 370                 && ntohs(ip->ip_pl) >= ICMP6_NDP_NA_MINLEN
 371                 && !IN6_IS_ADDR_MULTICAST(&icmp->icmp6_nna.target)
 372                 && (!IN6_IS_ADDR_MULTICAST(&ip->ip_dst)
 373                     || icmp->icmp6_nna.S == 0)) {
 374             ndp_table_add(slirp, ip->ip_src, eth->h_source);
 375         }
 376         break;
 377
 378     case ICMP6_NDP_REDIRECT:
 379         DEBUG_CALL(" type = Redirect");
 380         qemu_log_mask(LOG_GUEST_ERROR,
 381                 "Warning: guest sent NDP REDIRECT, but shouldn't");
 382         break;
 383     }
 384 }
 385
 386 /*
 387  * Process a received ICMPv6 message.
 388  */
 389 void icmp6_input(struct mbuf *m)
 390 {
 391     struct icmp6 *icmp;
 392     struct ip6 *ip = mtod(m, struct ip6 *);
 393     Slirp *slirp = m->slirp;
 394     int hlen = sizeof(struct ip6);
 395
 396     DEBUG_CALL("icmp6_input");
 397     DEBUG_ARG("m = %lx", (long) m);
 398     DEBUG_ARG("m_len = %d", m->m_len);
 399
 400     if (ntohs(ip->ip_pl) < ICMP6_MINLEN) {
 401         goto end;
 402     }
 403
 404     if (ip6_cksum(m)) {
 405         goto end;
 406     }
 407
 408     m->m_len -= hlen;
 409     m->m_data += hlen;
 410     icmp = mtod(m, struct icmp6 *);
 411     m->m_len += hlen;
 412     m->m_data -= hlen;
 413
 414     DEBUG_ARG("icmp6_type = %d", icmp->icmp6_type);
 415     switch (icmp->icmp6_type) {
 416     case ICMP6_ECHO_REQUEST:
 417         if (in6_equal_host(&ip->ip_dst)) {
 418             icmp6_send_echoreply(m, slirp, ip, icmp);
 419         } else {
 420             /* TODO */
 421             error_report("external icmpv6 not supported yet");
 422         }
 423         break;
 424
 425     case ICMP6_NDP_RS:
 426     case ICMP6_NDP_RA:
 427     case ICMP6_NDP_NS:
 428     case ICMP6_NDP_NA:
 429     case ICMP6_NDP_REDIRECT:
 430         ndp_input(m, slirp, ip, icmp);
 431         break;
 432
 433     case ICMP6_UNREACH:
 434     case ICMP6_TOOBIG:
 435     case ICMP6_TIMXCEED:
 436     case ICMP6_PARAMPROB:
 437         /* XXX? report error? close socket? */
 438     default:
 439         break;
 440     }
 441
 442 end:
 443     m_free(m);
 444 }