icmp6.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894
  1. /*
  2. * Internet Control Message Protocol for IPv6
  3. */
  4. #include "u.h"
  5. #include "../port/lib.h"
  6. #include "mem.h"
  7. #include "dat.h"
  8. #include "fns.h"
  9. #include "../port/error.h"
  10. #include "ip.h"
  11. #include "ipv6.h"
  12. enum
  13. {
  14. InMsgs6,
  15. InErrors6,
  16. OutMsgs6,
  17. CsumErrs6,
  18. LenErrs6,
  19. HlenErrs6,
  20. HoplimErrs6,
  21. IcmpCodeErrs6,
  22. TargetErrs6,
  23. OptlenErrs6,
  24. AddrmxpErrs6,
  25. RouterAddrErrs6,
  26. Nstats6,
  27. };
  28. enum {
  29. ICMP_USEAD6 = 40,
  30. };
  31. enum {
  32. Oflag = 1<<5,
  33. Sflag = 1<<6,
  34. Rflag = 1<<7,
  35. };
  36. enum {
  37. /* ICMPv6 types */
  38. EchoReply = 0,
  39. UnreachableV6 = 1,
  40. PacketTooBigV6 = 2,
  41. TimeExceedV6 = 3,
  42. SrcQuench = 4,
  43. ParamProblemV6 = 4,
  44. Redirect = 5,
  45. EchoRequest = 8,
  46. TimeExceed = 11,
  47. InParmProblem = 12,
  48. Timestamp = 13,
  49. TimestampReply = 14,
  50. InfoRequest = 15,
  51. InfoReply = 16,
  52. AddrMaskRequest = 17,
  53. AddrMaskReply = 18,
  54. EchoRequestV6 = 128,
  55. EchoReplyV6 = 129,
  56. RouterSolicit = 133,
  57. RouterAdvert = 134,
  58. NbrSolicit = 135,
  59. NbrAdvert = 136,
  60. RedirectV6 = 137,
  61. Maxtype6 = 137,
  62. };
  63. typedef struct ICMPpkt ICMPpkt;
  64. typedef struct IPICMP IPICMP;
  65. typedef struct Ndpkt Ndpkt;
  66. typedef struct NdiscC NdiscC;
  67. struct ICMPpkt {
  68. uchar type;
  69. uchar code;
  70. uchar cksum[2];
  71. uchar icmpid[2];
  72. uchar seq[2];
  73. };
  74. struct IPICMP {
  75. Ip6hdr;
  76. ICMPpkt;
  77. };
  78. struct NdiscC
  79. {
  80. IPICMP;
  81. uchar target[IPaddrlen];
  82. };
  83. struct Ndpkt
  84. {
  85. NdiscC;
  86. uchar otype;
  87. uchar olen; /* length in units of 8 octets(incl type, code),
  88. * 1 for IEEE 802 addresses */
  89. uchar lnaddr[6]; /* link-layer address */
  90. };
  91. typedef struct Icmppriv6
  92. {
  93. ulong stats[Nstats6];
  94. /* message counts */
  95. ulong in[Maxtype6+1];
  96. ulong out[Maxtype6+1];
  97. } Icmppriv6;
  98. typedef struct Icmpcb6
  99. {
  100. QLock;
  101. uchar headers;
  102. } Icmpcb6;
  103. char *icmpnames6[Maxtype6+1] =
  104. {
  105. [EchoReply] "EchoReply",
  106. [UnreachableV6] "UnreachableV6",
  107. [PacketTooBigV6] "PacketTooBigV6",
  108. [TimeExceedV6] "TimeExceedV6",
  109. [SrcQuench] "SrcQuench",
  110. [Redirect] "Redirect",
  111. [EchoRequest] "EchoRequest",
  112. [TimeExceed] "TimeExceed",
  113. [InParmProblem] "InParmProblem",
  114. [Timestamp] "Timestamp",
  115. [TimestampReply] "TimestampReply",
  116. [InfoRequest] "InfoRequest",
  117. [InfoReply] "InfoReply",
  118. [AddrMaskRequest] "AddrMaskRequest",
  119. [AddrMaskReply] "AddrMaskReply",
  120. [EchoRequestV6] "EchoRequestV6",
  121. [EchoReplyV6] "EchoReplyV6",
  122. [RouterSolicit] "RouterSolicit",
  123. [RouterAdvert] "RouterAdvert",
  124. [NbrSolicit] "NbrSolicit",
  125. [NbrAdvert] "NbrAdvert",
  126. [RedirectV6] "RedirectV6",
  127. };
  128. static char *statnames6[Nstats6] =
  129. {
  130. [InMsgs6] "InMsgs",
  131. [InErrors6] "InErrors",
  132. [OutMsgs6] "OutMsgs",
  133. [CsumErrs6] "CsumErrs",
  134. [LenErrs6] "LenErrs",
  135. [HlenErrs6] "HlenErrs",
  136. [HoplimErrs6] "HoplimErrs",
  137. [IcmpCodeErrs6] "IcmpCodeErrs",
  138. [TargetErrs6] "TargetErrs",
  139. [OptlenErrs6] "OptlenErrs",
  140. [AddrmxpErrs6] "AddrmxpErrs",
  141. [RouterAddrErrs6] "RouterAddrErrs",
  142. };
  143. static char *unreachcode[] =
  144. {
  145. [icmp6_no_route] "no route to destination",
  146. [icmp6_ad_prohib] "comm with destination administratively prohibited",
  147. [icmp6_unassigned] "icmp unreachable: unassigned error code (2)",
  148. [icmp6_adr_unreach] "address unreachable",
  149. [icmp6_port_unreach] "port unreachable",
  150. [icmp6_unkn_code] "icmp unreachable: unknown code",
  151. };
  152. static void icmpkick6(void *x, Block *bp);
  153. static void
  154. icmpcreate6(Conv *c)
  155. {
  156. c->rq = qopen(64*1024, Qmsg, 0, c);
  157. c->wq = qbypass(icmpkick6, c);
  158. }
  159. static void
  160. set_cksum(Block *bp)
  161. {
  162. IPICMP *p = (IPICMP *)(bp->rp);
  163. hnputl(p->vcf, 0); /* borrow IP header as pseudoheader */
  164. hnputs(p->ploadlen, blocklen(bp)-IPV6HDR_LEN);
  165. p->proto = 0;
  166. p->ttl = ICMPv6; /* ttl gets set later */
  167. hnputs(p->cksum, 0);
  168. hnputs(p->cksum, ptclcsum(bp, 0, blocklen(bp)));
  169. p->proto = ICMPv6;
  170. }
  171. static Block *
  172. newIPICMP(int packetlen)
  173. {
  174. Block *nbp;
  175. nbp = allocb(packetlen);
  176. nbp->wp += packetlen;
  177. memset(nbp->rp, 0, packetlen);
  178. return nbp;
  179. }
  180. void
  181. icmpadvise6(Proto *icmp, Block *bp, char *msg)
  182. {
  183. ushort recid;
  184. Conv **c, *s;
  185. IPICMP *p;
  186. p = (IPICMP *)bp->rp;
  187. recid = nhgets(p->icmpid);
  188. for(c = icmp->conv; *c; c++) {
  189. s = *c;
  190. if(s->lport == recid && ipcmp(s->raddr, p->dst) == 0){
  191. qhangup(s->rq, msg);
  192. qhangup(s->wq, msg);
  193. break;
  194. }
  195. }
  196. freeblist(bp);
  197. }
  198. static void
  199. icmpkick6(void *x, Block *bp)
  200. {
  201. uchar laddr[IPaddrlen], raddr[IPaddrlen];
  202. Conv *c = x;
  203. IPICMP *p;
  204. Icmppriv6 *ipriv = c->p->priv;
  205. Icmpcb6 *icb = (Icmpcb6*)c->ptcl;
  206. if(bp == nil)
  207. return;
  208. if(icb->headers==6) {
  209. /* get user specified addresses */
  210. bp = pullupblock(bp, ICMP_USEAD6);
  211. if(bp == nil)
  212. return;
  213. bp->rp += 8;
  214. ipmove(laddr, bp->rp);
  215. bp->rp += IPaddrlen;
  216. ipmove(raddr, bp->rp);
  217. bp->rp += IPaddrlen;
  218. bp = padblock(bp, sizeof(Ip6hdr));
  219. }
  220. if(blocklen(bp) < sizeof(IPICMP)){
  221. freeblist(bp);
  222. return;
  223. }
  224. p = (IPICMP *)(bp->rp);
  225. if(icb->headers == 6) {
  226. ipmove(p->dst, raddr);
  227. ipmove(p->src, laddr);
  228. } else {
  229. ipmove(p->dst, c->raddr);
  230. ipmove(p->src, c->laddr);
  231. hnputs(p->icmpid, c->lport);
  232. }
  233. set_cksum(bp);
  234. p->vcf[0] = 0x06 << 4;
  235. if(p->type <= Maxtype6)
  236. ipriv->out[p->type]++;
  237. ipoput6(c->p->f, bp, 0, c->ttl, c->tos, nil);
  238. }
  239. char*
  240. icmpctl6(Conv *c, char **argv, int argc)
  241. {
  242. Icmpcb6 *icb;
  243. icb = (Icmpcb6*) c->ptcl;
  244. if(argc==1 && strcmp(argv[0], "headers")==0) {
  245. icb->headers = 6;
  246. return nil;
  247. }
  248. return "unknown control request";
  249. }
  250. static void
  251. goticmpkt6(Proto *icmp, Block *bp, int muxkey)
  252. {
  253. ushort recid;
  254. uchar *addr;
  255. Conv **c, *s;
  256. IPICMP *p = (IPICMP *)bp->rp;
  257. if(muxkey == 0) {
  258. recid = nhgets(p->icmpid);
  259. addr = p->src;
  260. } else {
  261. recid = muxkey;
  262. addr = p->dst;
  263. }
  264. for(c = icmp->conv; *c; c++){
  265. s = *c;
  266. if(s->lport == recid && ipcmp(s->raddr, addr) == 0){
  267. bp = concatblock(bp);
  268. if(bp != nil)
  269. qpass(s->rq, bp);
  270. return;
  271. }
  272. }
  273. freeblist(bp);
  274. }
  275. static Block *
  276. mkechoreply6(Block *bp)
  277. {
  278. uchar addr[IPaddrlen];
  279. IPICMP *p = (IPICMP *)(bp->rp);
  280. ipmove(addr, p->src);
  281. ipmove(p->src, p->dst);
  282. ipmove(p->dst, addr);
  283. p->type = EchoReplyV6;
  284. set_cksum(bp);
  285. return bp;
  286. }
  287. /*
  288. * sends out an ICMPv6 neighbor solicitation
  289. * suni == SRC_UNSPEC or SRC_UNI,
  290. * tuni == TARG_MULTI => multicast for address resolution,
  291. * and tuni == TARG_UNI => neighbor reachability.
  292. */
  293. extern void
  294. icmpns(Fs *f, uchar* src, int suni, uchar* targ, int tuni, uchar* mac)
  295. {
  296. Block *nbp;
  297. Ndpkt *np;
  298. Proto *icmp = f->t2p[ICMPv6];
  299. Icmppriv6 *ipriv = icmp->priv;
  300. nbp = newIPICMP(sizeof(Ndpkt));
  301. np = (Ndpkt*) nbp->rp;
  302. if(suni == SRC_UNSPEC)
  303. memmove(np->src, v6Unspecified, IPaddrlen);
  304. else
  305. memmove(np->src, src, IPaddrlen);
  306. if(tuni == TARG_UNI)
  307. memmove(np->dst, targ, IPaddrlen);
  308. else
  309. ipv62smcast(np->dst, targ);
  310. np->type = NbrSolicit;
  311. np->code = 0;
  312. memmove(np->target, targ, IPaddrlen);
  313. if(suni != SRC_UNSPEC) {
  314. np->otype = SRC_LLADDR;
  315. np->olen = 1; /* 1+1+6 = 8 = 1 8-octet */
  316. memmove(np->lnaddr, mac, sizeof(np->lnaddr));
  317. } else
  318. nbp->wp -= sizeof(Ndpkt) - sizeof(NdiscC);
  319. set_cksum(nbp);
  320. np = (Ndpkt*)nbp->rp;
  321. np->ttl = HOP_LIMIT;
  322. np->vcf[0] = 0x06 << 4;
  323. ipriv->out[NbrSolicit]++;
  324. netlog(f, Logicmp, "sending neighbor solicitation %I\n", targ);
  325. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  326. }
  327. /*
  328. * sends out an ICMPv6 neighbor advertisement. pktflags == RSO flags.
  329. */
  330. extern void
  331. icmpna(Fs *f, uchar* src, uchar* dst, uchar* targ, uchar* mac, uchar flags)
  332. {
  333. Block *nbp;
  334. Ndpkt *np;
  335. Proto *icmp = f->t2p[ICMPv6];
  336. Icmppriv6 *ipriv = icmp->priv;
  337. nbp = newIPICMP(sizeof(Ndpkt));
  338. np = (Ndpkt*)nbp->rp;
  339. memmove(np->src, src, IPaddrlen);
  340. memmove(np->dst, dst, IPaddrlen);
  341. np->type = NbrAdvert;
  342. np->code = 0;
  343. np->icmpid[0] = flags;
  344. memmove(np->target, targ, IPaddrlen);
  345. np->otype = TARGET_LLADDR;
  346. np->olen = 1;
  347. memmove(np->lnaddr, mac, sizeof(np->lnaddr));
  348. set_cksum(nbp);
  349. np = (Ndpkt*) nbp->rp;
  350. np->ttl = HOP_LIMIT;
  351. np->vcf[0] = 0x06 << 4;
  352. ipriv->out[NbrAdvert]++;
  353. netlog(f, Logicmp, "sending neighbor advertisement %I\n", src);
  354. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  355. }
  356. extern void
  357. icmphostunr(Fs *f, Ipifc *ifc, Block *bp, int code, int free)
  358. {
  359. int osz = BLEN(bp);
  360. int sz = MIN(sizeof(IPICMP) + osz, v6MINTU);
  361. Block *nbp;
  362. IPICMP *np;
  363. Ip6hdr *p;
  364. Proto *icmp = f->t2p[ICMPv6];
  365. Icmppriv6 *ipriv = icmp->priv;
  366. p = (Ip6hdr *)bp->rp;
  367. if(isv6mcast(p->src))
  368. goto clean;
  369. nbp = newIPICMP(sz);
  370. np = (IPICMP *)nbp->rp;
  371. rlock(ifc);
  372. if(ipv6anylocal(ifc, np->src))
  373. netlog(f, Logicmp, "send icmphostunr -> s%I d%I\n",
  374. p->src, p->dst);
  375. else {
  376. netlog(f, Logicmp, "icmphostunr fail -> s%I d%I\n",
  377. p->src, p->dst);
  378. freeblist(nbp);
  379. if(free)
  380. goto clean;
  381. else
  382. return;
  383. }
  384. memmove(np->dst, p->src, IPaddrlen);
  385. np->type = UnreachableV6;
  386. np->code = code;
  387. memmove(nbp->rp + sizeof(IPICMP), bp->rp, sz - sizeof(IPICMP));
  388. set_cksum(nbp);
  389. np->ttl = HOP_LIMIT;
  390. np->vcf[0] = 0x06 << 4;
  391. ipriv->out[UnreachableV6]++;
  392. if(free)
  393. ipiput6(f, ifc, nbp);
  394. else {
  395. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  396. return;
  397. }
  398. clean:
  399. runlock(ifc);
  400. freeblist(bp);
  401. }
  402. extern void
  403. icmpttlexceeded6(Fs *f, Ipifc *ifc, Block *bp)
  404. {
  405. int osz = BLEN(bp);
  406. int sz = MIN(sizeof(IPICMP) + osz, v6MINTU);
  407. Block *nbp;
  408. IPICMP *np;
  409. Ip6hdr *p;
  410. Proto *icmp = f->t2p[ICMPv6];
  411. Icmppriv6 *ipriv = icmp->priv;
  412. p = (Ip6hdr *)bp->rp;
  413. if(isv6mcast(p->src))
  414. return;
  415. nbp = newIPICMP(sz);
  416. np = (IPICMP *) nbp->rp;
  417. if(ipv6anylocal(ifc, np->src))
  418. netlog(f, Logicmp, "send icmpttlexceeded6 -> s%I d%I\n",
  419. p->src, p->dst);
  420. else {
  421. netlog(f, Logicmp, "icmpttlexceeded6 fail -> s%I d%I\n",
  422. p->src, p->dst);
  423. return;
  424. }
  425. memmove(np->dst, p->src, IPaddrlen);
  426. np->type = TimeExceedV6;
  427. np->code = 0;
  428. memmove(nbp->rp + sizeof(IPICMP), bp->rp, sz - sizeof(IPICMP));
  429. set_cksum(nbp);
  430. np->ttl = HOP_LIMIT;
  431. np->vcf[0] = 0x06 << 4;
  432. ipriv->out[TimeExceedV6]++;
  433. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  434. }
  435. extern void
  436. icmppkttoobig6(Fs *f, Ipifc *ifc, Block *bp)
  437. {
  438. int osz = BLEN(bp);
  439. int sz = MIN(sizeof(IPICMP) + osz, v6MINTU);
  440. Block *nbp;
  441. IPICMP *np;
  442. Ip6hdr *p;
  443. Proto *icmp = f->t2p[ICMPv6];
  444. Icmppriv6 *ipriv = icmp->priv;
  445. p = (Ip6hdr *)bp->rp;
  446. if(isv6mcast(p->src))
  447. return;
  448. nbp = newIPICMP(sz);
  449. np = (IPICMP *)nbp->rp;
  450. if(ipv6anylocal(ifc, np->src))
  451. netlog(f, Logicmp, "send icmppkttoobig6 -> s%I d%I\n",
  452. p->src, p->dst);
  453. else {
  454. netlog(f, Logicmp, "icmppkttoobig6 fail -> s%I d%I\n",
  455. p->src, p->dst);
  456. return;
  457. }
  458. memmove(np->dst, p->src, IPaddrlen);
  459. np->type = PacketTooBigV6;
  460. np->code = 0;
  461. hnputl(np->icmpid, ifc->maxtu - ifc->m->hsize);
  462. memmove(nbp->rp + sizeof(IPICMP), bp->rp, sz - sizeof(IPICMP));
  463. set_cksum(nbp);
  464. np->ttl = HOP_LIMIT;
  465. np->vcf[0] = 0x06 << 4;
  466. ipriv->out[PacketTooBigV6]++;
  467. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  468. }
  469. /*
  470. * RFC 2461, pages 39-40, pages 57-58.
  471. */
  472. static int
  473. valid(Proto *icmp, Ipifc *ifc, Block *bp, Icmppriv6 *ipriv)
  474. {
  475. int sz, osz, unsp, n, ttl, iplen;
  476. int pktsz = BLEN(bp);
  477. uchar *packet = bp->rp;
  478. IPICMP *p = (IPICMP *) packet;
  479. Ndpkt *np;
  480. USED(ifc);
  481. n = blocklen(bp);
  482. if(n < sizeof(IPICMP)) {
  483. ipriv->stats[HlenErrs6]++;
  484. netlog(icmp->f, Logicmp, "icmp hlen %d\n", n);
  485. goto err;
  486. }
  487. iplen = nhgets(p->ploadlen);
  488. if(iplen > n-IPV6HDR_LEN || (iplen % 1)) {
  489. ipriv->stats[LenErrs6]++;
  490. netlog(icmp->f, Logicmp, "icmp length %d\n", iplen);
  491. goto err;
  492. }
  493. /* Rather than construct explicit pseudoheader, overwrite IPv6 header */
  494. if(p->proto != ICMPv6) {
  495. /* This code assumes no extension headers!!! */
  496. netlog(icmp->f, Logicmp, "icmp error: extension header\n");
  497. goto err;
  498. }
  499. memset(packet, 0, 4);
  500. ttl = p->ttl;
  501. p->ttl = p->proto;
  502. p->proto = 0;
  503. if(ptclcsum(bp, 0, iplen + IPV6HDR_LEN)) {
  504. ipriv->stats[CsumErrs6]++;
  505. netlog(icmp->f, Logicmp, "icmp checksum error\n");
  506. goto err;
  507. }
  508. p->proto = p->ttl;
  509. p->ttl = ttl;
  510. /* additional tests for some pkt types */
  511. if (p->type == NbrSolicit || p->type == NbrAdvert ||
  512. p->type == RouterAdvert || p->type == RouterSolicit ||
  513. p->type == RedirectV6) {
  514. if(p->ttl != HOP_LIMIT) {
  515. ipriv->stats[HoplimErrs6]++;
  516. goto err;
  517. }
  518. if(p->code != 0) {
  519. ipriv->stats[IcmpCodeErrs6]++;
  520. goto err;
  521. }
  522. switch (p->type) {
  523. case NbrSolicit:
  524. case NbrAdvert:
  525. np = (Ndpkt*) p;
  526. if(isv6mcast(np->target)) {
  527. ipriv->stats[TargetErrs6]++;
  528. goto err;
  529. }
  530. if(optexsts(np) && np->olen == 0) {
  531. ipriv->stats[OptlenErrs6]++;
  532. goto err;
  533. }
  534. if (p->type == NbrSolicit &&
  535. ipcmp(np->src, v6Unspecified) == 0)
  536. if(!issmcast(np->dst) || optexsts(np)) {
  537. ipriv->stats[AddrmxpErrs6]++;
  538. goto err;
  539. }
  540. if(p->type == NbrAdvert)
  541. if(isv6mcast(np->dst) &&
  542. (nhgets(np->icmpid) & Sflag)){
  543. ipriv->stats[AddrmxpErrs6]++;
  544. goto err;
  545. }
  546. break;
  547. case RouterAdvert:
  548. if(pktsz - sizeof(Ip6hdr) < 16) {
  549. ipriv->stats[HlenErrs6]++;
  550. goto err;
  551. }
  552. if(!islinklocal(p->src)) {
  553. ipriv->stats[RouterAddrErrs6]++;
  554. goto err;
  555. }
  556. sz = sizeof(IPICMP) + 8;
  557. while (sz+1 < pktsz) {
  558. osz = packet[sz+1];
  559. if(osz <= 0) {
  560. ipriv->stats[OptlenErrs6]++;
  561. goto err;
  562. }
  563. sz += 8*osz;
  564. }
  565. break;
  566. case RouterSolicit:
  567. if(pktsz - sizeof(Ip6hdr) < 8) {
  568. ipriv->stats[HlenErrs6]++;
  569. goto err;
  570. }
  571. unsp = (ipcmp(p->src, v6Unspecified) == 0);
  572. sz = sizeof(IPICMP) + 8;
  573. while (sz+1 < pktsz) {
  574. osz = packet[sz+1];
  575. if(osz <= 0 ||
  576. (unsp && packet[sz] == SRC_LLADDR)) {
  577. ipriv->stats[OptlenErrs6]++;
  578. goto err;
  579. }
  580. sz += 8*osz;
  581. }
  582. break;
  583. case RedirectV6:
  584. /* to be filled in */
  585. break;
  586. default:
  587. goto err;
  588. }
  589. }
  590. return 1;
  591. err:
  592. ipriv->stats[InErrors6]++;
  593. return 0;
  594. }
  595. static int
  596. targettype(Fs *f, Ipifc *ifc, uchar *target)
  597. {
  598. Iplifc *lifc;
  599. int t;
  600. rlock(ifc);
  601. if(ipproxyifc(f, ifc, target)) {
  602. runlock(ifc);
  603. return t_uniproxy;
  604. }
  605. for(lifc = ifc->lifc; lifc; lifc = lifc->next)
  606. if(ipcmp(lifc->local, target) == 0) {
  607. t = (lifc->tentative)? t_unitent: t_unirany;
  608. runlock(ifc);
  609. return t;
  610. }
  611. runlock(ifc);
  612. return 0;
  613. }
  614. static void
  615. icmpiput6(Proto *icmp, Ipifc *ipifc, Block *bp)
  616. {
  617. int refresh = 1;
  618. char *msg, m2[128];
  619. uchar pktflags;
  620. uchar *packet = bp->rp;
  621. uchar lsrc[IPaddrlen];
  622. Block *r;
  623. IPICMP *p = (IPICMP *)packet;
  624. Icmppriv6 *ipriv = icmp->priv;
  625. Iplifc *lifc;
  626. Ndpkt* np;
  627. Proto *pr;
  628. if(!valid(icmp, ipifc, bp, ipriv) || p->type > Maxtype6)
  629. goto raise;
  630. ipriv->in[p->type]++;
  631. switch(p->type) {
  632. case EchoRequestV6:
  633. r = mkechoreply6(bp);
  634. ipriv->out[EchoReply]++;
  635. ipoput6(icmp->f, r, 0, MAXTTL, DFLTTOS, nil);
  636. break;
  637. case UnreachableV6:
  638. if(p->code > 4)
  639. msg = unreachcode[icmp6_unkn_code];
  640. else
  641. msg = unreachcode[p->code];
  642. bp->rp += sizeof(IPICMP);
  643. if(blocklen(bp) < 8){
  644. ipriv->stats[LenErrs6]++;
  645. goto raise;
  646. }
  647. p = (IPICMP *)bp->rp;
  648. pr = Fsrcvpcolx(icmp->f, p->proto);
  649. if(pr != nil && pr->advise != nil) {
  650. (*pr->advise)(pr, bp, msg);
  651. return;
  652. }
  653. bp->rp -= sizeof(IPICMP);
  654. goticmpkt6(icmp, bp, 0);
  655. break;
  656. case TimeExceedV6:
  657. if(p->code == 0){
  658. sprint(m2, "ttl exceeded at %I", p->src);
  659. bp->rp += sizeof(IPICMP);
  660. if(blocklen(bp) < 8){
  661. ipriv->stats[LenErrs6]++;
  662. goto raise;
  663. }
  664. p = (IPICMP *)bp->rp;
  665. pr = Fsrcvpcolx(icmp->f, p->proto);
  666. if(pr && pr->advise) {
  667. (*pr->advise)(pr, bp, m2);
  668. return;
  669. }
  670. bp->rp -= sizeof(IPICMP);
  671. }
  672. goticmpkt6(icmp, bp, 0);
  673. break;
  674. case RouterAdvert:
  675. case RouterSolicit:
  676. /* using lsrc as a temp, munge hdr for goticmp6 */
  677. if (0) {
  678. memmove(lsrc, p->src, IPaddrlen);
  679. memmove(p->src, p->dst, IPaddrlen);
  680. memmove(p->dst, lsrc, IPaddrlen);
  681. }
  682. goticmpkt6(icmp, bp, p->type);
  683. break;
  684. case NbrSolicit:
  685. np = (Ndpkt*) p;
  686. pktflags = 0;
  687. switch (targettype(icmp->f, ipifc, np->target)) {
  688. case t_unirany:
  689. pktflags |= Oflag;
  690. /* fall through */
  691. case t_uniproxy:
  692. if(ipcmp(np->src, v6Unspecified) != 0) {
  693. arpenter(icmp->f, V6, np->src, np->lnaddr,
  694. 8*np->olen-2, 0);
  695. pktflags |= Sflag;
  696. }
  697. if(ipv6local(ipifc, lsrc))
  698. icmpna(icmp->f, lsrc,
  699. (ipcmp(np->src, v6Unspecified) == 0?
  700. v6allnodesL: np->src),
  701. np->target, ipifc->mac, pktflags);
  702. else
  703. freeblist(bp);
  704. break;
  705. case t_unitent:
  706. /* not clear what needs to be done. send up
  707. * an icmp mesg saying don't use this address? */
  708. default:
  709. freeblist(bp);
  710. }
  711. break;
  712. case NbrAdvert:
  713. np = (Ndpkt*) p;
  714. /*
  715. * if the target address matches one of the local interface
  716. * addresses and the local interface address has tentative bit
  717. * set, insert into ARP table. this is so the duplicate address
  718. * detection part of ipconfig can discover duplication through
  719. * the arp table.
  720. */
  721. lifc = iplocalonifc(ipifc, np->target);
  722. if(lifc && lifc->tentative)
  723. refresh = 0;
  724. arpenter(icmp->f, V6, np->target, np->lnaddr, 8*np->olen-2,
  725. refresh);
  726. freeblist(bp);
  727. break;
  728. case PacketTooBigV6:
  729. default:
  730. goticmpkt6(icmp, bp, 0);
  731. break;
  732. }
  733. return;
  734. raise:
  735. freeblist(bp);
  736. }
  737. int
  738. icmpstats6(Proto *icmp6, char *buf, int len)
  739. {
  740. Icmppriv6 *priv;
  741. char *p, *e;
  742. int i;
  743. priv = icmp6->priv;
  744. p = buf;
  745. e = p+len;
  746. for(i = 0; i < Nstats6; i++)
  747. p = seprint(p, e, "%s: %lud\n", statnames6[i], priv->stats[i]);
  748. for(i = 0; i <= Maxtype6; i++)
  749. if(icmpnames6[i])
  750. p = seprint(p, e, "%s: %lud %lud\n", icmpnames6[i],
  751. priv->in[i], priv->out[i]);
  752. /* else
  753. p = seprint(p, e, "%d: %lud %lud\n", i, priv->in[i],
  754. priv->out[i]);
  755. */
  756. return p - buf;
  757. }
  758. /* import from icmp.c */
  759. extern int icmpstate(Conv *c, char *state, int n);
  760. extern char* icmpannounce(Conv *c, char **argv, int argc);
  761. extern char* icmpconnect(Conv *c, char **argv, int argc);
  762. extern void icmpclose(Conv *c);
  763. void
  764. icmp6init(Fs *fs)
  765. {
  766. Proto *icmp6 = smalloc(sizeof(Proto));
  767. icmp6->priv = smalloc(sizeof(Icmppriv6));
  768. icmp6->name = "icmpv6";
  769. icmp6->connect = icmpconnect;
  770. icmp6->announce = icmpannounce;
  771. icmp6->state = icmpstate;
  772. icmp6->create = icmpcreate6;
  773. icmp6->close = icmpclose;
  774. icmp6->rcv = icmpiput6;
  775. icmp6->stats = icmpstats6;
  776. icmp6->ctl = icmpctl6;
  777. icmp6->advise = icmpadvise6;
  778. icmp6->gc = nil;
  779. icmp6->ipproto = ICMPv6;
  780. icmp6->nc = 16;
  781. icmp6->ptclsize = sizeof(Icmpcb6);
  782. Fsproto(fs, icmp6);
  783. }