icmp6.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899
  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, Ipifc *ifc)
  277. {
  278. uchar addr[IPaddrlen];
  279. IPICMP *p = (IPICMP *)(bp->rp);
  280. ipmove(addr, p->src);
  281. if(!isv6mcast(p->dst))
  282. ipmove(p->src, p->dst);
  283. else if (!ipv6anylocal(ifc, p->src))
  284. return nil;
  285. ipmove(p->dst, addr);
  286. p->type = EchoReplyV6;
  287. set_cksum(bp);
  288. return bp;
  289. }
  290. /*
  291. * sends out an ICMPv6 neighbor solicitation
  292. * suni == SRC_UNSPEC or SRC_UNI,
  293. * tuni == TARG_MULTI => multicast for address resolution,
  294. * and tuni == TARG_UNI => neighbor reachability.
  295. */
  296. extern void
  297. icmpns(Fs *f, uchar* src, int suni, uchar* targ, int tuni, uchar* mac)
  298. {
  299. Block *nbp;
  300. Ndpkt *np;
  301. Proto *icmp = f->t2p[ICMPv6];
  302. Icmppriv6 *ipriv = icmp->priv;
  303. nbp = newIPICMP(sizeof(Ndpkt));
  304. np = (Ndpkt*) nbp->rp;
  305. if(suni == SRC_UNSPEC)
  306. memmove(np->src, v6Unspecified, IPaddrlen);
  307. else
  308. memmove(np->src, src, IPaddrlen);
  309. if(tuni == TARG_UNI)
  310. memmove(np->dst, targ, IPaddrlen);
  311. else
  312. ipv62smcast(np->dst, targ);
  313. np->type = NbrSolicit;
  314. np->code = 0;
  315. memmove(np->target, targ, IPaddrlen);
  316. if(suni != SRC_UNSPEC) {
  317. np->otype = SRC_LLADDR;
  318. np->olen = 1; /* 1+1+6 = 8 = 1 8-octet */
  319. memmove(np->lnaddr, mac, sizeof(np->lnaddr));
  320. } else
  321. nbp->wp -= sizeof(Ndpkt) - sizeof(NdiscC);
  322. set_cksum(nbp);
  323. np = (Ndpkt*)nbp->rp;
  324. np->ttl = HOP_LIMIT;
  325. np->vcf[0] = 0x06 << 4;
  326. ipriv->out[NbrSolicit]++;
  327. netlog(f, Logicmp, "sending neighbor solicitation %I\n", targ);
  328. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  329. }
  330. /*
  331. * sends out an ICMPv6 neighbor advertisement. pktflags == RSO flags.
  332. */
  333. extern void
  334. icmpna(Fs *f, uchar* src, uchar* dst, uchar* targ, uchar* mac, uchar flags)
  335. {
  336. Block *nbp;
  337. Ndpkt *np;
  338. Proto *icmp = f->t2p[ICMPv6];
  339. Icmppriv6 *ipriv = icmp->priv;
  340. nbp = newIPICMP(sizeof(Ndpkt));
  341. np = (Ndpkt*)nbp->rp;
  342. memmove(np->src, src, IPaddrlen);
  343. memmove(np->dst, dst, IPaddrlen);
  344. np->type = NbrAdvert;
  345. np->code = 0;
  346. np->icmpid[0] = flags;
  347. memmove(np->target, targ, IPaddrlen);
  348. np->otype = TARGET_LLADDR;
  349. np->olen = 1;
  350. memmove(np->lnaddr, mac, sizeof(np->lnaddr));
  351. set_cksum(nbp);
  352. np = (Ndpkt*) nbp->rp;
  353. np->ttl = HOP_LIMIT;
  354. np->vcf[0] = 0x06 << 4;
  355. ipriv->out[NbrAdvert]++;
  356. netlog(f, Logicmp, "sending neighbor advertisement %I\n", src);
  357. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  358. }
  359. extern void
  360. icmphostunr(Fs *f, Ipifc *ifc, Block *bp, int code, int free)
  361. {
  362. int osz = BLEN(bp);
  363. int sz = MIN(sizeof(IPICMP) + osz, v6MINTU);
  364. Block *nbp;
  365. IPICMP *np;
  366. Ip6hdr *p;
  367. Proto *icmp = f->t2p[ICMPv6];
  368. Icmppriv6 *ipriv = icmp->priv;
  369. p = (Ip6hdr *)bp->rp;
  370. if(isv6mcast(p->src))
  371. goto clean;
  372. nbp = newIPICMP(sz);
  373. np = (IPICMP *)nbp->rp;
  374. rlock(ifc);
  375. if(ipv6anylocal(ifc, np->src))
  376. netlog(f, Logicmp, "send icmphostunr -> s%I d%I\n",
  377. p->src, p->dst);
  378. else {
  379. netlog(f, Logicmp, "icmphostunr fail -> s%I d%I\n",
  380. p->src, p->dst);
  381. freeblist(nbp);
  382. if(free)
  383. goto clean;
  384. else
  385. return;
  386. }
  387. memmove(np->dst, p->src, IPaddrlen);
  388. np->type = UnreachableV6;
  389. np->code = code;
  390. memmove(nbp->rp + sizeof(IPICMP), bp->rp, sz - sizeof(IPICMP));
  391. set_cksum(nbp);
  392. np->ttl = HOP_LIMIT;
  393. np->vcf[0] = 0x06 << 4;
  394. ipriv->out[UnreachableV6]++;
  395. if(free)
  396. ipiput6(f, ifc, nbp);
  397. else {
  398. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  399. return;
  400. }
  401. clean:
  402. runlock(ifc);
  403. freeblist(bp);
  404. }
  405. extern void
  406. icmpttlexceeded6(Fs *f, Ipifc *ifc, Block *bp)
  407. {
  408. int osz = BLEN(bp);
  409. int sz = MIN(sizeof(IPICMP) + osz, v6MINTU);
  410. Block *nbp;
  411. IPICMP *np;
  412. Ip6hdr *p;
  413. Proto *icmp = f->t2p[ICMPv6];
  414. Icmppriv6 *ipriv = icmp->priv;
  415. p = (Ip6hdr *)bp->rp;
  416. if(isv6mcast(p->src))
  417. return;
  418. nbp = newIPICMP(sz);
  419. np = (IPICMP *) nbp->rp;
  420. if(ipv6anylocal(ifc, np->src))
  421. netlog(f, Logicmp, "send icmpttlexceeded6 -> s%I d%I\n",
  422. p->src, p->dst);
  423. else {
  424. netlog(f, Logicmp, "icmpttlexceeded6 fail -> s%I d%I\n",
  425. p->src, p->dst);
  426. return;
  427. }
  428. memmove(np->dst, p->src, IPaddrlen);
  429. np->type = TimeExceedV6;
  430. np->code = 0;
  431. memmove(nbp->rp + sizeof(IPICMP), bp->rp, sz - sizeof(IPICMP));
  432. set_cksum(nbp);
  433. np->ttl = HOP_LIMIT;
  434. np->vcf[0] = 0x06 << 4;
  435. ipriv->out[TimeExceedV6]++;
  436. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  437. }
  438. extern void
  439. icmppkttoobig6(Fs *f, Ipifc *ifc, Block *bp)
  440. {
  441. int osz = BLEN(bp);
  442. int sz = MIN(sizeof(IPICMP) + osz, v6MINTU);
  443. Block *nbp;
  444. IPICMP *np;
  445. Ip6hdr *p;
  446. Proto *icmp = f->t2p[ICMPv6];
  447. Icmppriv6 *ipriv = icmp->priv;
  448. p = (Ip6hdr *)bp->rp;
  449. if(isv6mcast(p->src))
  450. return;
  451. nbp = newIPICMP(sz);
  452. np = (IPICMP *)nbp->rp;
  453. if(ipv6anylocal(ifc, np->src))
  454. netlog(f, Logicmp, "send icmppkttoobig6 -> s%I d%I\n",
  455. p->src, p->dst);
  456. else {
  457. netlog(f, Logicmp, "icmppkttoobig6 fail -> s%I d%I\n",
  458. p->src, p->dst);
  459. return;
  460. }
  461. memmove(np->dst, p->src, IPaddrlen);
  462. np->type = PacketTooBigV6;
  463. np->code = 0;
  464. hnputl(np->icmpid, ifc->maxtu - ifc->m->hsize);
  465. memmove(nbp->rp + sizeof(IPICMP), bp->rp, sz - sizeof(IPICMP));
  466. set_cksum(nbp);
  467. np->ttl = HOP_LIMIT;
  468. np->vcf[0] = 0x06 << 4;
  469. ipriv->out[PacketTooBigV6]++;
  470. ipoput6(f, nbp, 0, MAXTTL, DFLTTOS, nil);
  471. }
  472. /*
  473. * RFC 2461, pages 39-40, pages 57-58.
  474. */
  475. static int
  476. valid(Proto *icmp, Ipifc *ifc, Block *bp, Icmppriv6 *ipriv)
  477. {
  478. int sz, osz, unsp, n, ttl, iplen;
  479. int pktsz = BLEN(bp);
  480. uchar *packet = bp->rp;
  481. IPICMP *p = (IPICMP *) packet;
  482. Ndpkt *np;
  483. USED(ifc);
  484. n = blocklen(bp);
  485. if(n < sizeof(IPICMP)) {
  486. ipriv->stats[HlenErrs6]++;
  487. netlog(icmp->f, Logicmp, "icmp hlen %d\n", n);
  488. goto err;
  489. }
  490. iplen = nhgets(p->ploadlen);
  491. if(iplen > n-IPV6HDR_LEN || (iplen % 1)) {
  492. ipriv->stats[LenErrs6]++;
  493. netlog(icmp->f, Logicmp, "icmp length %d\n", iplen);
  494. goto err;
  495. }
  496. /* Rather than construct explicit pseudoheader, overwrite IPv6 header */
  497. if(p->proto != ICMPv6) {
  498. /* This code assumes no extension headers!!! */
  499. netlog(icmp->f, Logicmp, "icmp error: extension header\n");
  500. goto err;
  501. }
  502. memset(packet, 0, 4);
  503. ttl = p->ttl;
  504. p->ttl = p->proto;
  505. p->proto = 0;
  506. if(ptclcsum(bp, 0, iplen + IPV6HDR_LEN)) {
  507. ipriv->stats[CsumErrs6]++;
  508. netlog(icmp->f, Logicmp, "icmp checksum error\n");
  509. goto err;
  510. }
  511. p->proto = p->ttl;
  512. p->ttl = ttl;
  513. /* additional tests for some pkt types */
  514. if (p->type == NbrSolicit || p->type == NbrAdvert ||
  515. p->type == RouterAdvert || p->type == RouterSolicit ||
  516. p->type == RedirectV6) {
  517. if(p->ttl != HOP_LIMIT) {
  518. ipriv->stats[HoplimErrs6]++;
  519. goto err;
  520. }
  521. if(p->code != 0) {
  522. ipriv->stats[IcmpCodeErrs6]++;
  523. goto err;
  524. }
  525. switch (p->type) {
  526. case NbrSolicit:
  527. case NbrAdvert:
  528. np = (Ndpkt*) p;
  529. if(isv6mcast(np->target)) {
  530. ipriv->stats[TargetErrs6]++;
  531. goto err;
  532. }
  533. if(optexsts(np) && np->olen == 0) {
  534. ipriv->stats[OptlenErrs6]++;
  535. goto err;
  536. }
  537. if (p->type == NbrSolicit &&
  538. ipcmp(np->src, v6Unspecified) == 0)
  539. if(!issmcast(np->dst) || optexsts(np)) {
  540. ipriv->stats[AddrmxpErrs6]++;
  541. goto err;
  542. }
  543. if(p->type == NbrAdvert)
  544. if(isv6mcast(np->dst) &&
  545. (nhgets(np->icmpid) & Sflag)){
  546. ipriv->stats[AddrmxpErrs6]++;
  547. goto err;
  548. }
  549. break;
  550. case RouterAdvert:
  551. if(pktsz - sizeof(Ip6hdr) < 16) {
  552. ipriv->stats[HlenErrs6]++;
  553. goto err;
  554. }
  555. if(!islinklocal(p->src)) {
  556. ipriv->stats[RouterAddrErrs6]++;
  557. goto err;
  558. }
  559. sz = sizeof(IPICMP) + 8;
  560. while (sz+1 < pktsz) {
  561. osz = packet[sz+1];
  562. if(osz <= 0) {
  563. ipriv->stats[OptlenErrs6]++;
  564. goto err;
  565. }
  566. sz += 8*osz;
  567. }
  568. break;
  569. case RouterSolicit:
  570. if(pktsz - sizeof(Ip6hdr) < 8) {
  571. ipriv->stats[HlenErrs6]++;
  572. goto err;
  573. }
  574. unsp = (ipcmp(p->src, v6Unspecified) == 0);
  575. sz = sizeof(IPICMP) + 8;
  576. while (sz+1 < pktsz) {
  577. osz = packet[sz+1];
  578. if(osz <= 0 ||
  579. (unsp && packet[sz] == SRC_LLADDR)) {
  580. ipriv->stats[OptlenErrs6]++;
  581. goto err;
  582. }
  583. sz += 8*osz;
  584. }
  585. break;
  586. case RedirectV6:
  587. /* to be filled in */
  588. break;
  589. default:
  590. goto err;
  591. }
  592. }
  593. return 1;
  594. err:
  595. ipriv->stats[InErrors6]++;
  596. return 0;
  597. }
  598. static int
  599. targettype(Fs *f, Ipifc *ifc, uchar *target)
  600. {
  601. Iplifc *lifc;
  602. int t;
  603. rlock(ifc);
  604. if(ipproxyifc(f, ifc, target)) {
  605. runlock(ifc);
  606. return t_uniproxy;
  607. }
  608. for(lifc = ifc->lifc; lifc; lifc = lifc->next)
  609. if(ipcmp(lifc->local, target) == 0) {
  610. t = (lifc->tentative)? t_unitent: t_unirany;
  611. runlock(ifc);
  612. return t;
  613. }
  614. runlock(ifc);
  615. return 0;
  616. }
  617. static void
  618. icmpiput6(Proto *icmp, Ipifc *ipifc, Block *bp)
  619. {
  620. int refresh = 1;
  621. char *msg, m2[128];
  622. uchar pktflags;
  623. uchar *packet = bp->rp;
  624. uchar lsrc[IPaddrlen];
  625. Block *r;
  626. IPICMP *p = (IPICMP *)packet;
  627. Icmppriv6 *ipriv = icmp->priv;
  628. Iplifc *lifc;
  629. Ndpkt* np;
  630. Proto *pr;
  631. if(!valid(icmp, ipifc, bp, ipriv) || p->type > Maxtype6)
  632. goto raise;
  633. ipriv->in[p->type]++;
  634. switch(p->type) {
  635. case EchoRequestV6:
  636. r = mkechoreply6(bp, ipifc);
  637. if(r == nil)
  638. goto raise;
  639. ipriv->out[EchoReply]++;
  640. ipoput6(icmp->f, r, 0, MAXTTL, DFLTTOS, nil);
  641. break;
  642. case UnreachableV6:
  643. if(p->code > 4)
  644. msg = unreachcode[icmp6_unkn_code];
  645. else
  646. msg = unreachcode[p->code];
  647. bp->rp += sizeof(IPICMP);
  648. if(blocklen(bp) < 8){
  649. ipriv->stats[LenErrs6]++;
  650. goto raise;
  651. }
  652. p = (IPICMP *)bp->rp;
  653. pr = Fsrcvpcolx(icmp->f, p->proto);
  654. if(pr != nil && pr->advise != nil) {
  655. (*pr->advise)(pr, bp, msg);
  656. return;
  657. }
  658. bp->rp -= sizeof(IPICMP);
  659. goticmpkt6(icmp, bp, 0);
  660. break;
  661. case TimeExceedV6:
  662. if(p->code == 0){
  663. sprint(m2, "ttl exceeded at %I", p->src);
  664. bp->rp += sizeof(IPICMP);
  665. if(blocklen(bp) < 8){
  666. ipriv->stats[LenErrs6]++;
  667. goto raise;
  668. }
  669. p = (IPICMP *)bp->rp;
  670. pr = Fsrcvpcolx(icmp->f, p->proto);
  671. if(pr && pr->advise) {
  672. (*pr->advise)(pr, bp, m2);
  673. return;
  674. }
  675. bp->rp -= sizeof(IPICMP);
  676. }
  677. goticmpkt6(icmp, bp, 0);
  678. break;
  679. case RouterAdvert:
  680. case RouterSolicit:
  681. /* using lsrc as a temp, munge hdr for goticmp6 */
  682. if (0) {
  683. memmove(lsrc, p->src, IPaddrlen);
  684. memmove(p->src, p->dst, IPaddrlen);
  685. memmove(p->dst, lsrc, IPaddrlen);
  686. }
  687. goticmpkt6(icmp, bp, p->type);
  688. break;
  689. case NbrSolicit:
  690. np = (Ndpkt*) p;
  691. pktflags = 0;
  692. switch (targettype(icmp->f, ipifc, np->target)) {
  693. case t_unirany:
  694. pktflags |= Oflag;
  695. /* fall through */
  696. case t_uniproxy:
  697. if(ipcmp(np->src, v6Unspecified) != 0) {
  698. arpenter(icmp->f, V6, np->src, np->lnaddr,
  699. 8*np->olen-2, 0);
  700. pktflags |= Sflag;
  701. }
  702. if(ipv6local(ipifc, lsrc))
  703. icmpna(icmp->f, lsrc,
  704. (ipcmp(np->src, v6Unspecified) == 0?
  705. v6allnodesL: np->src),
  706. np->target, ipifc->mac, pktflags);
  707. else
  708. freeblist(bp);
  709. break;
  710. case t_unitent:
  711. /* not clear what needs to be done. send up
  712. * an icmp mesg saying don't use this address? */
  713. default:
  714. freeblist(bp);
  715. }
  716. break;
  717. case NbrAdvert:
  718. np = (Ndpkt*) p;
  719. /*
  720. * if the target address matches one of the local interface
  721. * addresses and the local interface address has tentative bit
  722. * set, insert into ARP table. this is so the duplicate address
  723. * detection part of ipconfig can discover duplication through
  724. * the arp table.
  725. */
  726. lifc = iplocalonifc(ipifc, np->target);
  727. if(lifc && lifc->tentative)
  728. refresh = 0;
  729. arpenter(icmp->f, V6, np->target, np->lnaddr, 8*np->olen-2,
  730. refresh);
  731. freeblist(bp);
  732. break;
  733. case PacketTooBigV6:
  734. default:
  735. goticmpkt6(icmp, bp, 0);
  736. break;
  737. }
  738. return;
  739. raise:
  740. freeblist(bp);
  741. }
  742. int
  743. icmpstats6(Proto *icmp6, char *buf, int len)
  744. {
  745. Icmppriv6 *priv;
  746. char *p, *e;
  747. int i;
  748. priv = icmp6->priv;
  749. p = buf;
  750. e = p+len;
  751. for(i = 0; i < Nstats6; i++)
  752. p = seprint(p, e, "%s: %lud\n", statnames6[i], priv->stats[i]);
  753. for(i = 0; i <= Maxtype6; i++)
  754. if(icmpnames6[i])
  755. p = seprint(p, e, "%s: %lud %lud\n", icmpnames6[i],
  756. priv->in[i], priv->out[i]);
  757. /* else
  758. p = seprint(p, e, "%d: %lud %lud\n", i, priv->in[i],
  759. priv->out[i]);
  760. */
  761. return p - buf;
  762. }
  763. /* import from icmp.c */
  764. extern int icmpstate(Conv *c, char *state, int n);
  765. extern char* icmpannounce(Conv *c, char **argv, int argc);
  766. extern char* icmpconnect(Conv *c, char **argv, int argc);
  767. extern void icmpclose(Conv *c);
  768. void
  769. icmp6init(Fs *fs)
  770. {
  771. Proto *icmp6 = smalloc(sizeof(Proto));
  772. icmp6->priv = smalloc(sizeof(Icmppriv6));
  773. icmp6->name = "icmpv6";
  774. icmp6->connect = icmpconnect;
  775. icmp6->announce = icmpannounce;
  776. icmp6->state = icmpstate;
  777. icmp6->create = icmpcreate6;
  778. icmp6->close = icmpclose;
  779. icmp6->rcv = icmpiput6;
  780. icmp6->stats = icmpstats6;
  781. icmp6->ctl = icmpctl6;
  782. icmp6->advise = icmpadvise6;
  783. icmp6->gc = nil;
  784. icmp6->ipproto = ICMPv6;
  785. icmp6->nc = 16;
  786. icmp6->ptclsize = sizeof(Icmpcb6);
  787. Fsproto(fs, icmp6);
  788. }