ip_icmp.c
上传用户:baixin
上传日期:2008-03-13
资源大小:4795k
文件大小:30k
开发平台:

MultiPlatform

  1. /* ip_icmp.c - internet ICMP routines */
  2. /* Copyright 1984 - 2002 Wind River Systems, Inc. */
  3. #include "copyright_wrs.h"
  4. /*
  5.  * Copyright (c) 1982, 1986, 1988, 1993
  6.  * The Regents of the University of California.  All rights reserved.
  7.  *
  8.  * Redistribution and use in source and binary forms, with or without
  9.  * modification, are permitted provided that the following conditions
  10.  * are met:
  11.  * 1. Redistributions of source code must retain the above copyright
  12.  *    notice, this list of conditions and the following disclaimer.
  13.  * 2. Redistributions in binary form must reproduce the above copyright
  14.  *    notice, this list of conditions and the following disclaimer in the
  15.  *    documentation and/or other materials provided with the distribution.
  16.  * 3. All advertising materials mentioning features or use of this software
  17.  *    must display the following acknowledgement:
  18.  * This product includes software developed by the University of
  19.  * California, Berkeley and its contributors.
  20.  * 4. Neither the name of the University nor the names of its contributors
  21.  *    may be used to endorse or promote products derived from this software
  22.  *    without specific prior written permission.
  23.  *
  24.  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  25.  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  26.  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  27.  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  28.  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  29.  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  30.  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  31.  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  32.  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  33.  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  34.  * SUCH DAMAGE.
  35.  *
  36.  * @(#)ip_icmp.c 8.2 (Berkeley) 1/4/94
  37.  */
  38. /*
  39. modification history
  40. --------------------
  41. 03h,18apr02,vvv  removed incorrect icmpmaskrepl initialization from icmp_init
  42.  (SPR #74338)
  43. 03g,18dec01,vvv  reflect messages with correct source address (SPR #71684)
  44. 03f,12oct01,rae  merge from truestack ver 03j, base 03e (SPRs 69344, 69683 etc)
  45. 03e,16mar99,spm  recovered orphaned code from tor2_0_x branch (SPR #25770)
  46. 03d,09feb99,ham  fixed SPR#24975.
  47. 03c,31jan97,vin  changed declaration according to prototype decl in protosw.h
  48. 03b,07jan96,vin  added icmp_init(..) for scalability, moved iptime to 
  49.  ip_input.c
  50. 03a,31oct96,vin  changed m_gethdr(..) to mHdrClGet(..).
  51. 02u,24aug96,vin  integrated with BSD44 and 02t of ip_icmp.c.
  52. */
  53. /*
  54.  * ICMP routines: error generation, receive packet processing, and
  55.  * routines to turnaround packets back to the originator, and
  56.  * host table maintenance routines.
  57.  */
  58. #include "vxWorks.h"
  59. #include "net/mbuf.h"
  60. #include "net/protosw.h"
  61. #include "sys/socket.h"
  62. #include "sys/ioctl.h"
  63. #include "net/systm.h"
  64. #include "net/route.h"
  65. #include "net/if.h"
  66. #include "net/if_types.h"
  67. #include "netinet/in.h"
  68. #include "netinet/in_systm.h"
  69. #include "netinet/in_var.h"
  70. #include "netinet/ip.h"
  71. #include "netinet/ip_var.h"
  72. #include "netinet/ip_icmp.h"
  73. #include "netinet/icmp_var.h"
  74. #ifdef WV_INSTRUMENTATION
  75. #ifdef INCLUDE_WVNET
  76. #include "wvNetLib.h"
  77. #endif
  78. #endif
  79. #ifdef VIRTUAL_STACK
  80. #include "netinet/vsLib.h"
  81. #endif /* VIRTUAL_STACK */
  82. /* defines */
  83. #ifndef VIRTUAL_STACK
  84. #define MAXTABLESIZE 64 /*
  85.                                  * smallest cluster limits setsockopt() 
  86.                                  * routine to 64 2-byte integers
  87.                                  */
  88. #endif /* VIRTUAL_STACK */
  89. #define PATHMTU_MIN  68  /* Lowest allowable path MTU estimate */
  90. /* externs */
  91. extern void pfctlinput ();
  92. #ifndef VIRTUAL_STACK
  93. extern struct protosw inetsw[];
  94. extern VOIDFUNCPTR _icmpErrorHook; 
  95. #endif /* VIRTUAL_STACK */
  96. /* globals */
  97. #ifndef VIRTUAL_STACK
  98. struct icmpstat icmpstat;
  99. struct sockaddr_in icmpmask = { 8, 0 };
  100. int icmpmaskrepl = 0;
  101. #ifdef ICMPPRINTFS
  102. int icmpprintfs = 0;
  103. #endif
  104. #endif /* VIRTUAL_STACK */
  105. /* locals */
  106. #ifndef VIRTUAL_STACK
  107. static struct sockaddr_in icmpsrc = { sizeof (struct sockaddr_in), AF_INET };
  108. static struct sockaddr_in icmpdst = { sizeof (struct sockaddr_in), AF_INET };
  109. static struct sockaddr_in icmpgw = { sizeof (struct sockaddr_in), AF_INET };
  110. LOCAL u_short mtuTable [MAXTABLESIZE] = {68, 296, 508, 1006, 1492, 2002,
  111.                                          4352, 8166, 17914, 32000, 65535};
  112. LOCAL int mtuTableSize = 11;
  113. #endif /* VIRTUAL_STACK */
  114. /* forward declarations */
  115. static void icmp_error (struct mbuf *, int, int, n_long, struct ifnet *);
  116. static void icmp_reflect (struct mbuf *);
  117. static void icmp_send (struct mbuf *, struct mbuf *);
  118. LOCAL void ip_next_mtu (struct sockaddr *, int);
  119. #ifdef WV_INSTRUMENTATION
  120. #ifdef INCLUDE_WVNET
  121.     /* Set common fields of event identifiers for this module. */
  122. LOCAL UCHAR wvNetModuleId = WV_NET_IPICMP_MODULE;   /* Value for ip_icmp.c */
  123. LOCAL UCHAR wvNetLocalFilter = WV_NET_NONE;     /* Available event filter */
  124. LOCAL ULONG wvNetEventId;       /* Event identifier: see wvNetLib.h */
  125. #endif    /* INCLUDE_WVNET */
  126. #endif
  127. void
  128. icmp_init()
  129. {
  130. if (_icmpErrorHook == NULL) /* initialize the hook if not null */
  131.     _icmpErrorHook = icmp_error; 
  132. #ifdef ICMPPRINTFS
  133.         icmpprintfs = 0;
  134. #endif
  135.         icmpsrc.sin_len = sizeof(struct sockaddr_in);
  136.         icmpsrc.sin_family = AF_INET;
  137.         icmpdst.sin_len = sizeof(struct sockaddr_in);
  138.         icmpdst.sin_family = AF_INET;
  139.         icmpgw.sin_len = sizeof(struct sockaddr_in);
  140.         icmpgw.sin_family = AF_INET;
  141.         mtuTable[0] = 68;
  142.         mtuTable[1] = 296;
  143.         mtuTable[2] = 508;
  144.         mtuTable[3] = 1006;
  145.         mtuTable[4] = 1492;
  146.         mtuTable[5] = 2002;
  147.         mtuTable[6] = 4352;
  148.         mtuTable[7] = 8166;
  149.         mtuTable[8] = 17914;
  150.         mtuTable[9] = 32000;
  151.         mtuTable[10] = 65535;
  152.         mtuTableSize = 11;
  153. }
  154. /*
  155.  * ICMP routines: error generation, receive packet processing, and
  156.  * routines to turnaround packets back to the originator, and
  157.  * host table maintenance routines.
  158.  */
  159. /*
  160.  * Generate an error packet of type error
  161.  * in response to bad packet ip.
  162.  */
  163. static void
  164. icmp_error(n, type, code, dest, destifp)
  165. struct mbuf *n;
  166. int type, code;
  167. n_long dest;
  168. struct ifnet *destifp;
  169. {
  170. register struct ip *oip = mtod(n, struct ip *), *nip;
  171. register unsigned oiplen = oip->ip_hl << 2;
  172. register struct icmp *icp;
  173. register struct mbuf *m;
  174.         MTU_QUERY mtuQuery;
  175. unsigned icmplen;
  176. short    offset;
  177. #ifdef WV_INSTRUMENTATION
  178. #ifdef INCLUDE_WVNET    /* WV_NET_EMERGENCY or WV_NET_ALERT event */
  179.         if (type == ICMP_SOURCEQUENCH)  /* ENOBUFS error: out of memory. */
  180.             {
  181.             WV_NET_MARKER_2 (NET_CORE_EVENT, WV_NET_EMERGENCY, 9, 2, 
  182.                              WV_NETEVENT_ICMPERR_START, type, code)
  183.             }
  184.         else
  185.             {
  186.             WV_NET_MARKER_2 (NET_CORE_EVENT, WV_NET_CRITICAL, 8, 2, 
  187.                              WV_NETEVENT_ICMPERR_START, type, code)
  188.             }
  189. #endif  /* INCLUDE_WVNET */
  190. #endif
  191. #ifdef ICMPPRINTFS
  192. if (icmpprintfs)
  193. printf("icmp_error(%x, %d, %d)n", oip, type, code);
  194. #endif
  195. if (type != ICMP_REDIRECT)
  196.     {
  197. #ifdef VIRTUAL_STACK
  198.     _icmpstat.icps_error++;
  199. #else
  200.     icmpstat.icps_error++;
  201. #endif /* VIRTUAL_STACK */
  202.             offset = oip->ip_off;
  203.     }
  204.         else
  205.     {
  206.             /* 
  207.      * If ICMP_REDIRECT, offset field is in network host order
  208.      * (changed when ip_output forwarded this packet). We need it 
  209.      * to be in host order for the processing.
  210.      */
  211.     offset = ntohs (oip->ip_off);
  212.     }
  213. /*
  214.  * Don't send error if not the first fragment of message.
  215.  * Don't error if the old packet protocol was ICMP
  216.  * error message, only known informational types.
  217.  */
  218. if (offset &~ (IP_MF|IP_DF))
  219. goto freeit;
  220. if (oip->ip_p == IPPROTO_ICMP && type != ICMP_REDIRECT &&
  221.   n->m_len >= oiplen + ICMP_MINLEN &&
  222.   !ICMP_INFOTYPE(((struct icmp *)((caddr_t)oip + oiplen))->icmp_type)) {
  223. #ifdef VIRTUAL_STACK
  224. _icmpstat.icps_oldicmp++;
  225. #else
  226. icmpstat.icps_oldicmp++;
  227. #endif /* VIRTUAL_STACK */
  228. goto freeit;
  229. }
  230. /* Don't send error in response to a multicast or broadcast packet */
  231. if (n->m_flags & (M_BCAST|M_MCAST))
  232. goto freeit;
  233. /*
  234.  * First, formulate icmp message
  235.  */
  236. if ((m = mHdrClGet(M_DONTWAIT, MT_HEADER, CL_SIZE_128, TRUE)) == NULL)
  237. goto freeit;
  238. icmplen = oiplen + min(8, oip->ip_len);
  239. m->m_len = icmplen + ICMP_MINLEN;
  240. MH_ALIGN(m, m->m_len);
  241. icp = mtod(m, struct icmp *);
  242. if ((u_int)type > ICMP_MAXTYPE)
  243.             {
  244. #ifdef WV_INSTRUMENTATION
  245. #ifdef INCLUDE_WVNET    /* WV_NET_EMERGENCY event */
  246.             WV_NET_MARKER_1 (NET_CORE_EVENT, WV_NET_EMERGENCY, 14, 1, 
  247.                              WV_NETEVENT_ICMPERR_PANIC, type)
  248. #endif  /* INCLUDE_WVNET */
  249. #endif
  250.             panic("icmp_error");
  251.             }
  252. #ifdef VIRTUAL_STACK
  253. _icmpstat.icps_outhist[type]++;
  254. #else
  255. icmpstat.icps_outhist[type]++;
  256. #endif /* VIRTUAL_STACK */
  257. icp->icmp_type = type;
  258. if (type == ICMP_REDIRECT)
  259. icp->icmp_gwaddr.s_addr = dest;
  260. else {
  261. icp->icmp_void = 0;
  262. /* 
  263.  * The following assignments assume an overlay with the
  264.  * zeroed icmp_void field.
  265.  */
  266. if (type == ICMP_PARAMPROB) {
  267. icp->icmp_pptr = code;
  268. code = 0;
  269. } else if (type == ICMP_UNREACH &&
  270. code == ICMP_UNREACH_NEEDFRAG && destifp) {
  271.                         /*
  272.                          * Point-to-multipoint devices allow a separate MTU
  273.                          * for each destination address. Get that value or
  274.                          * leave the next MTU unspecified if not available.
  275.                          */
  276.                         if (destifp->if_type == IFT_PMP)
  277.                             {
  278.                             mtuQuery.family = AF_INET;
  279.                             mtuQuery.dstIpAddr = dest;
  280.                             if (destifp->if_ioctl (destifp, SIOCGMTU,
  281.                                                    (caddr_t) &mtuQuery) == 0)
  282.                                 {
  283.                                 icp->icmp_nextmtu = htons (mtuQuery.mtu);
  284.                                 }
  285.                             }
  286.                         else
  287.                             {
  288.                             icp->icmp_nextmtu = htons(destifp->if_mtu);
  289.                             }
  290. }
  291. }
  292. icp->icmp_code = code;
  293. bcopy((caddr_t)oip, (caddr_t)&icp->icmp_ip, icmplen);
  294. nip = &icp->icmp_ip;
  295. if (type != ICMP_REDIRECT)
  296.     {
  297.     /*
  298.      * If ICMP_REDIRECT, these changes have already been made in 
  299.      * ip_output when the packet was forwarded.
  300.      */
  301.     nip->ip_len = htons((u_short)(nip->ip_len + oiplen));
  302.     HTONS (nip->ip_id);
  303.     HTONS (nip->ip_off);
  304.     }
  305. /*
  306.  * Now, copy old ip header (without options)
  307.  * in front of icmp message.
  308.  */
  309. if (m->m_data - sizeof(struct ip) < m->m_extBuf)
  310. panic("icmp len");
  311. m->m_data -= sizeof(struct ip);
  312. m->m_len += sizeof(struct ip);
  313. m->m_pkthdr.len = m->m_len;
  314. m->m_pkthdr.rcvif = n->m_pkthdr.rcvif;
  315. nip = mtod(m, struct ip *);
  316. bcopy((caddr_t)oip, (caddr_t)nip, sizeof(struct ip));
  317. nip->ip_len = m->m_len;
  318. nip->ip_hl = sizeof(struct ip) >> 2;
  319. nip->ip_p = IPPROTO_ICMP;
  320. nip->ip_tos = 0;
  321. icmp_reflect(m);
  322. freeit:
  323. m_freem(n);
  324. }
  325. /*
  326.  * Process a received ICMP message.
  327.  */
  328. void
  329. icmp_input(m, hlen)
  330. register struct mbuf *m;
  331. int hlen;
  332. {
  333. register struct icmp *icp;
  334. register struct ip *ip = mtod(m, struct ip *);
  335. int icmplen = ip->ip_len;
  336. register int i;
  337. struct in_ifaddr *ia;
  338. int (*ctlfunc) (int, struct sockaddr *, struct ip *);
  339. int code;
  340. #ifndef VIRTUAL_STACK
  341. extern u_char ip_protox[];
  342. #endif /* VIRTUAL_STACK */
  343. #ifdef WV_INSTRUMENTATION
  344. #ifdef INCLUDE_WVNET    /* WV_NET_NOTICE event */
  345.     WV_NET_EVENT_0 (NET_CORE_EVENT, WV_NET_NOTICE, 7, 8, 
  346.                     WV_NETEVENT_ICMPIN_START, WV_NET_RECV)
  347. #endif  /* INCLUDE_WVNET */
  348. #endif
  349. /*
  350.  * Locate icmp structure in mbuf, and check
  351.  * that not corrupted and of at least minimum length.
  352.  */
  353. #ifdef ICMPPRINTFS
  354. if (icmpprintfs)
  355. printf("icmp_input from %x to %x, len %dn",
  356. ntohl(ip->ip_src.s_addr), ntohl(ip->ip_dst.s_addr),
  357. icmplen);
  358. #endif
  359. if (icmplen < ICMP_MINLEN) {
  360. #ifdef WV_INSTRUMENTATION
  361. #ifdef INCLUDE_WVNET    /* WV_NET_CRITICAL event */
  362.         WV_NET_ADDRIN_EVENT_0 (NET_CORE_EVENT, WV_NET_CRITICAL, 9, 3,
  363.                                ip->ip_src.s_addr, ip->ip_dst.s_addr,
  364.                                WV_NETEVENT_ICMPIN_SHORTMSG, WV_NET_RECV)
  365. #endif  /* INCLUDE_WVNET */
  366. #endif
  367. #ifdef VIRTUAL_STACK
  368. _icmpstat.icps_tooshort++;
  369. #else
  370. icmpstat.icps_tooshort++;
  371. #endif /* VIRTUAL_STACK */
  372. goto freeit;
  373. }
  374. i = hlen + min(icmplen, ICMP_ADVLENMIN);
  375. if (m->m_len < i && (m = m_pullup(m, i)) == 0)  {
  376. #ifdef WV_INSTRUMENTATION
  377. #ifdef INCLUDE_WVNET    /* WV_NET_CRITICAL event */
  378.         WV_NET_ADDRIN_EVENT_0 (NET_CORE_EVENT, WV_NET_CRITICAL, 9, 3,
  379.                                ip->ip_src.s_addr, ip->ip_dst.s_addr,
  380.                                WV_NETEVENT_ICMPIN_SHORTMSG, WV_NET_RECV)
  381. #endif  /* INCLUDE_WVNET */
  382. #endif
  383. #ifdef VIRTUAL_STACK
  384. _icmpstat.icps_tooshort++;
  385. #else
  386. icmpstat.icps_tooshort++;
  387. #endif /* VIRTUAL_STACK */
  388. return;
  389. }
  390. ip = mtod(m, struct ip *);
  391. m->m_len -= hlen;
  392. m->m_data += hlen;
  393. icp = mtod(m, struct icmp *);
  394. if (in_cksum(m, icmplen)) {
  395. #ifdef WV_INSTRUMENTATION
  396. #ifdef INCLUDE_WVNET    /* WV_NET_CRITICAL event */
  397.         WV_NET_ADDRIN_EVENT_0 (NET_CORE_EVENT, WV_NET_CRITICAL, 10, 4,
  398.                                ip->ip_src.s_addr, ip->ip_dst.s_addr,
  399.                                WV_NETEVENT_ICMPIN_BADSUM, WV_NET_RECV)
  400. #endif  /* INCLUDE_WVNET */
  401. #endif
  402. #ifdef VIRTUAL_STACK
  403. _icmpstat.icps_checksum++;
  404. #else
  405. icmpstat.icps_checksum++;
  406. #endif /* VIRTUAL_STACK */
  407. goto freeit;
  408. }
  409. m->m_len += hlen;
  410. m->m_data -= hlen;
  411. #ifdef ICMPPRINTFS
  412. /*
  413.  * Message type specific processing.
  414.  */
  415. if (icmpprintfs)
  416. printf("icmp_input, type %d code %dn", icp->icmp_type,
  417.     icp->icmp_code);
  418. #endif
  419. if (icp->icmp_type > ICMP_MAXTYPE)
  420. goto raw;
  421. #ifdef VIRTUAL_STACK
  422. _icmpstat.icps_inhist[icp->icmp_type]++;
  423. #else
  424. icmpstat.icps_inhist[icp->icmp_type]++;
  425. #endif /* VIRTUAL_STACK */
  426. code = icp->icmp_code;
  427. switch (icp->icmp_type) {
  428. case ICMP_UNREACH:
  429. switch (code) {
  430. case ICMP_UNREACH_NET:
  431. case ICMP_UNREACH_HOST:
  432. case ICMP_UNREACH_PROTOCOL:
  433. case ICMP_UNREACH_PORT:
  434. case ICMP_UNREACH_SRCFAIL:
  435. code += PRC_UNREACH_NET;
  436. break;
  437. case ICMP_UNREACH_NEEDFRAG:
  438. code = PRC_MSGSIZE;
  439. break;
  440. case ICMP_UNREACH_NET_UNKNOWN:
  441. case ICMP_UNREACH_NET_PROHIB:
  442. case ICMP_UNREACH_TOSNET:
  443. code = PRC_UNREACH_NET;
  444. break;
  445. case ICMP_UNREACH_HOST_UNKNOWN:
  446. case ICMP_UNREACH_ISOLATED:
  447. case ICMP_UNREACH_HOST_PROHIB:
  448. case ICMP_UNREACH_TOSHOST:
  449. code = PRC_UNREACH_HOST;
  450. break;
  451. default:
  452. goto badcode;
  453. }
  454. goto deliver;
  455. case ICMP_TIMXCEED:
  456. if (code > 1)
  457. goto badcode;
  458. code += PRC_TIMXCEED_INTRANS;
  459. goto deliver;
  460. case ICMP_PARAMPROB:
  461. if (code > 1)
  462. goto badcode;
  463. code = PRC_PARAMPROB;
  464. goto deliver;
  465. case ICMP_SOURCEQUENCH:
  466. if (code)
  467. goto badcode;
  468. code = PRC_QUENCH;
  469. deliver:
  470. /*
  471.  * Problem with datagram; advise higher level routines.
  472.  */
  473. if (icmplen < ICMP_ADVLENMIN || icmplen < ICMP_ADVLEN(icp) ||
  474.     icp->icmp_ip.ip_hl < (sizeof(struct ip) >> 2)) {
  475. #ifdef WV_INSTRUMENTATION
  476. #ifdef INCLUDE_WVNET    /* WV_NET_CRITICAL event */
  477.             WV_NET_ADDRIN_EVENT_2 (NET_CORE_EVENT, WV_NET_CRITICAL, 11, 5, 
  478.                                    ip->ip_src.s_addr, ip->ip_dst.s_addr,
  479.                                    WV_NETEVENT_ICMPIN_BADLEN, WV_NET_RECV,
  480.                                    icmplen, 4 * icp->icmp_ip.ip_hl)
  481. #endif  /* INCLUDE_WVNET */
  482. #endif
  483. #ifdef VIRTUAL_STACK
  484. _icmpstat.icps_badlen++;
  485. #else
  486. icmpstat.icps_badlen++;
  487. #endif /* VIRTUAL_STACK */
  488. goto freeit;
  489. }
  490. NTOHS(icp->icmp_ip.ip_len);
  491. #ifdef ICMPPRINTFS
  492. if (icmpprintfs)
  493. printf("deliver to protocol %dn", icp->icmp_ip.ip_p);
  494. #endif
  495. icmpsrc.sin_addr = icp->icmp_ip.ip_dst;
  496.                 /* Path MTU discovery: get new MTU value. */
  497.                 if (code == PRC_MSGSIZE)
  498.                     {
  499.                     i = ntohs (icp->icmp_nextmtu);
  500.                     ip_next_mtu ( (struct sockaddr *)&icmpsrc, i);
  501.                     }
  502. if ((ctlfunc =
  503.                    (FUNCPTR)(inetsw[ip_protox[icp->icmp_ip.ip_p]].pr_ctlinput)))
  504. (*ctlfunc)(code, (struct sockaddr *)&icmpsrc,
  505.     &icp->icmp_ip);
  506. break;
  507. badcode:
  508. #ifdef VIRTUAL_STACK
  509. _icmpstat.icps_badcode++;
  510. #else
  511. icmpstat.icps_badcode++;
  512. #endif /* VIRTUAL_STACK */
  513. break;
  514. case ICMP_ECHO:
  515. icp->icmp_type = ICMP_ECHOREPLY;
  516. goto reflect;
  517. case ICMP_TSTAMP:
  518. if (icmplen < ICMP_TSLEN) {
  519. #ifdef VIRTUAL_STACK
  520. _icmpstat.icps_badlen++;
  521. #else
  522. icmpstat.icps_badlen++;
  523. #endif /* VIRTUAL_STACK */
  524. break;
  525. }
  526. icp->icmp_type = ICMP_TSTAMPREPLY;
  527. icp->icmp_rtime = iptime();
  528. icp->icmp_ttime = icp->icmp_rtime; /* bogus, do later! */
  529. goto reflect;
  530. case ICMP_MASKREQ:
  531. #define satosin(sa) ((struct sockaddr_in *)(sa))
  532. if (icmpmaskrepl == 0)
  533. break;
  534. /*
  535.  * We are not able to respond with all ones broadcast
  536.  * unless we receive it over a point-to-point interface.
  537.  */
  538. if (icmplen < ICMP_MASKLEN)
  539. break;
  540. switch (ip->ip_dst.s_addr) {
  541. case INADDR_BROADCAST:
  542. case INADDR_ANY:
  543. icmpdst.sin_addr = ip->ip_src;
  544. break;
  545. default:
  546. icmpdst.sin_addr = ip->ip_dst;
  547. }
  548. ia = (struct in_ifaddr *)ifaof_ifpforaddr(
  549.     (struct sockaddr *)&icmpdst, m->m_pkthdr.rcvif);
  550. if (ia == 0 || ia->ia_ifp == 0)
  551. break;
  552. icp->icmp_type = ICMP_MASKREPLY;
  553. icp->icmp_mask = ia->ia_sockmask.sin_addr.s_addr;
  554. if (ip->ip_src.s_addr == 0) {
  555. if (ia->ia_ifp->if_flags & IFF_BROADCAST)
  556.     ip->ip_src = satosin(&ia->ia_broadaddr)->sin_addr;
  557. else if (ia->ia_ifp->if_flags & IFF_POINTOPOINT)
  558.     ip->ip_src = satosin(&ia->ia_dstaddr)->sin_addr;
  559. }
  560. reflect:
  561. ip->ip_len += hlen; /* since ip_input deducts this */
  562. #ifdef VIRTUAL_STACK
  563. _icmpstat.icps_reflect++;
  564. _icmpstat.icps_outhist[icp->icmp_type]++;
  565. #else
  566. icmpstat.icps_reflect++;
  567. icmpstat.icps_outhist[icp->icmp_type]++;
  568. #endif /* VIRTUAL_STACK */
  569. icmp_reflect(m);
  570. return; 
  571. case ICMP_REDIRECT:
  572. if (code > 3)
  573. goto badcode;
  574. if (icmplen < ICMP_ADVLENMIN || icmplen < ICMP_ADVLEN(icp) ||
  575.     icp->icmp_ip.ip_hl < (sizeof(struct ip) >> 2)) {
  576. #ifdef VIRTUAL_STACK
  577. _icmpstat.icps_badlen++;
  578. #else
  579. icmpstat.icps_badlen++;
  580. #endif /* VIRTUAL_STACK */
  581. break;
  582. }
  583. /*
  584.  * Short circuit routing redirects to force
  585.  * immediate change in the kernel's routing
  586.  * tables.  The message is also handed to anyone
  587.  * listening on a raw socket (e.g. the routing
  588.  * daemon for use in updating its tables).
  589.  */
  590. icmpgw.sin_addr = ip->ip_src;
  591. icmpdst.sin_addr = icp->icmp_gwaddr;
  592. #ifdef ICMPPRINTFS
  593. if (icmpprintfs)
  594. printf("redirect dst %x to %xn", icp->icmp_ip.ip_dst,
  595. icp->icmp_gwaddr);
  596. #endif
  597. icmpsrc.sin_addr = icp->icmp_ip.ip_dst;
  598. rtredirect((struct sockaddr *)&icmpsrc,
  599.   (struct sockaddr *)&icmpdst,
  600.   (struct sockaddr *)0, RTF_GATEWAY | RTF_HOST,
  601.   (struct sockaddr *)&icmpgw, (struct rtentry **)0);
  602. pfctlinput(PRC_REDIRECT_HOST, (struct sockaddr *)&icmpsrc);
  603. break;
  604. /*
  605.  * No kernel processing for the following;
  606.  * just fall through to send to raw listener.
  607.  */
  608. case ICMP_ECHOREPLY:
  609. case ICMP_ROUTERADVERT:
  610. case ICMP_ROUTERSOLICIT:
  611. case ICMP_TSTAMPREPLY:
  612. case ICMP_IREQREPLY:
  613. case ICMP_MASKREPLY:
  614. default:
  615. break;
  616. }
  617. raw:
  618. rip_input(m);
  619. return;
  620. freeit:
  621. m_freem(m);
  622. return;
  623. }
  624. /*
  625.  * Reflect the ip packet back to the source
  626.  */
  627. static void
  628. icmp_reflect(m)
  629. struct mbuf *m;
  630. {
  631. register struct ip *ip = mtod(m, struct ip *);
  632. register struct in_ifaddr *ia;
  633. struct in_addr t;
  634. struct mbuf *opts = 0, *ip_srcroute();
  635. int optlen = (ip->ip_hl << 2) - sizeof(struct ip);
  636. #ifdef WV_INSTRUMENTATION
  637. #ifdef INCLUDE_WVNET    /* WV_NET_NOTICE event */
  638.     WV_NET_EVENT_1 (NET_CORE_EVENT, WV_NET_NOTICE, 8, 9, 
  639.                     WV_NETEVENT_ICMPREFLECT_START, WV_NET_SEND,
  640.                     ip->ip_src.s_addr)
  641. #endif  /* INCLUDE_WVNET */
  642. #endif
  643. if (!in_canforward(ip->ip_src) &&
  644.     ((ntohl(ip->ip_src.s_addr) & IN_CLASSA_NET) !=
  645.      (IN_LOOPBACKNET << IN_CLASSA_NSHIFT))) {
  646. m_freem(m); /* Bad return address */
  647. goto done; /* Ip_output() will check for broadcast */
  648. }
  649. t = ip->ip_dst;
  650. ip->ip_dst = ip->ip_src;
  651. /*
  652.  * If the incoming packet was addressed directly to us,
  653.  * use dst as the src for the reply.  Otherwise (broadcast
  654.  * or anonymous), use the address which corresponds
  655.  * to the incoming interface.
  656.  */
  657. #ifdef VIRTUAL_STACK
  658. for (ia = _in_ifaddr; ia; ia = ia->ia_next) {
  659. #else
  660. for (ia = in_ifaddr; ia; ia = ia->ia_next) {
  661. #endif /* VIRTUAL_STACK */
  662. if (t.s_addr == IA_SIN(ia)->sin_addr.s_addr)
  663. break;
  664. if (ia->ia_ifp && (ia->ia_ifp->if_flags & IFF_BROADCAST) &&
  665.     t.s_addr == satosin(&ia->ia_broadaddr)->sin_addr.s_addr)
  666. break;
  667. }
  668. icmpsrc.sin_addr = ip->ip_src;
  669. if (ia == (struct in_ifaddr *)0)
  670. ia = (struct in_ifaddr *)ifaof_ifpforaddr(
  671. (struct sockaddr *)&icmpsrc, m->m_pkthdr.rcvif);
  672. /*
  673.  * The following happens if the packet was not addressed to us,
  674.  * and was received on an interface with no IP address.
  675.  */
  676. if (ia == (struct in_ifaddr *)0)
  677. #ifdef VIRTUAL_STACK
  678. ia = _in_ifaddr;
  679. #else
  680. ia = in_ifaddr;
  681. #endif /* VIRTUAL_STACK */
  682. t = IA_SIN(ia)->sin_addr;
  683. ip->ip_src = t;
  684. ip->ip_ttl = ipTimeToLive;
  685. if (optlen > 0) {
  686. register u_char *cp;
  687. int opt, cnt;
  688. u_int len;
  689. /*
  690.  * Retrieve any source routing from the incoming packet;
  691.  * add on any record-route or timestamp options.
  692.  */
  693. cp = (u_char *) (ip + 1);
  694. #ifdef SRCRT
  695. if ((opts = ip_srcroute()) == 0 &&
  696.     (opts = mHdrClGet(M_DONTWAIT, MT_HEADER, CL_SIZE_128,
  697.       TRUE))) {
  698. opts->m_len = sizeof(struct in_addr);
  699. mtod(opts, struct in_addr *)->s_addr = 0;
  700. }
  701. #endif /* SRCRT */
  702. if (opts) {
  703. #ifdef ICMPPRINTFS
  704.     if (icmpprintfs)
  705.     printf("icmp_reflect optlen %d rt %d => ",
  706. optlen, opts->m_len);
  707. #endif
  708.     for (cnt = optlen; cnt > 0; cnt -= len, cp += len) {
  709.     opt = cp[IPOPT_OPTVAL];
  710.     if (opt == IPOPT_EOL)
  711.     break;
  712.     if (opt == IPOPT_NOP)
  713.     len = 1;
  714.     else {
  715.     len = cp[IPOPT_OLEN];
  716.     if (len <= 0 || len > cnt)
  717.     break;
  718.     }
  719.     /*
  720.      * Should check for overflow, but it "can't happen"
  721.      */
  722.     if (opt == IPOPT_RR || opt == IPOPT_TS || 
  723. opt == IPOPT_SECURITY) {
  724.     bcopy((caddr_t)cp,
  725. mtod(opts, caddr_t) + opts->m_len, len);
  726.     opts->m_len += len;
  727.     }
  728.     }
  729.     /* Terminate & pad, if necessary */
  730.     if ((cnt = opts->m_len % 4)) {
  731.     for (; cnt < 4; cnt++) {
  732.     *(mtod(opts, caddr_t) + opts->m_len) =
  733. IPOPT_EOL;
  734.     opts->m_len++;
  735.     }
  736.     }
  737. #ifdef ICMPPRINTFS
  738.     if (icmpprintfs)
  739.     printf("%dn", opts->m_len);
  740. #endif
  741. }
  742. /*
  743.  * Now strip out original options by copying rest of first
  744.  * mbuf's data back, and adjust the IP length.
  745.  */
  746. ip->ip_len -= optlen;
  747. ip->ip_hl = sizeof(struct ip) >> 2;
  748. m->m_len -= optlen;
  749. if (m->m_flags & M_PKTHDR)
  750. m->m_pkthdr.len -= optlen;
  751. optlen += sizeof(struct ip);
  752. bcopy((caddr_t)ip + optlen, (caddr_t)(ip + 1),
  753.  (unsigned)(m->m_len - sizeof(struct ip)));
  754. }
  755. m->m_flags &= ~(M_BCAST|M_MCAST);
  756. icmp_send(m, opts);
  757. done:
  758. if (opts)
  759. (void)m_free(opts);
  760. }
  761. /*
  762.  * Send an icmp packet back to the ip level,
  763.  * after supplying a checksum.
  764.  */
  765. static void
  766. icmp_send(m, opts)
  767. register struct mbuf *m;
  768. struct mbuf *opts;
  769. {
  770. register struct ip *ip = mtod(m, struct ip *);
  771. register int hlen;
  772. register struct icmp *icp;
  773. #ifdef WV_INSTRUMENTATION
  774. #ifdef INCLUDE_WVNET    /* WV_NET_NOTICE event */
  775.     WV_NET_ADDROUT_EVENT_2 (NET_CORE_EVENT, WV_NET_NOTICE, 9, 10, 
  776.                             ip->ip_src.s_addr, ip->ip_dst.s_addr,
  777.                             WV_NETEVENT_ICMPSEND_START, WV_NET_SEND,
  778.                             ip->ip_src.s_addr, ip->ip_dst.s_addr)
  779. #endif  /* INCLUDE_WVNET */
  780. #endif
  781. hlen = ip->ip_hl << 2;
  782. m->m_data += hlen;
  783. m->m_len -= hlen;
  784. icp = mtod(m, struct icmp *);
  785. icp->icmp_cksum = 0;
  786. icp->icmp_cksum = in_cksum(m, ip->ip_len - hlen);
  787. m->m_data -= hlen;
  788. m->m_len += hlen;
  789. #ifdef ICMPPRINTFS
  790. if (icmpprintfs)
  791. printf("icmp_send dst %x src %xn", ip->ip_dst, ip->ip_src);
  792. #endif
  793. (void) ip_output(m, opts, NULL, 0, NULL);
  794. }
  795.     /*
  796.      * This routine handles the ICMP "need fragmentation" error which
  797.      * triggers the selection of a new MTU value for the path MTU discovery
  798.      * process. The new MTU value is equal to the suggested value from the
  799.      * ICMP error message (if any) or the next value from the current path
  800.      * MTU table. If the new MTU value is less than the acceptable minimum,
  801.      * the routine marks the corresponding route to disable the path MTU
  802.      * discovery process.
  803.      */
  804. LOCAL void ip_next_mtu
  805.     (
  806.     struct sockaddr * pDstAddr,     /* destination of original IP packet */
  807.     int nextmtu
  808.     )
  809.     {
  810.     struct rtentry *  pDestRoute;
  811.     u_long  oldmtu = 0;
  812.     u_long  newmtu;
  813.     int  loop;
  814.     pDestRoute = rtalloc1 (pDstAddr, 0);
  815.     if (pDestRoute && (pDestRoute->rt_flags & RTF_HOST) &&
  816.             !(pDestRoute->rt_rmx.rmx_locks & RTV_MTU))
  817.         {
  818.         oldmtu = pDestRoute->rt_rmx.rmx_mtu;
  819.         if (oldmtu == 0)
  820.             {
  821.             /* Current estimate unavailable - end discovery process. */
  822.             newmtu = 0;
  823.             }
  824.         else if (nextmtu == 0)
  825.             {
  826.             /* No value included in ICMP message. Use entry from table. */
  827.             for (loop = 0; loop < mtuTableSize; loop++)
  828.                  if (oldmtu > mtuTable [ (mtuTableSize - 1) - loop])
  829.                      break;
  830.             if (loop != mtuTableSize)
  831.                 {
  832.                 /* Set the new MTU value. */
  833.                 newmtu = mtuTable [loop];
  834.                 }
  835.             else
  836.                 newmtu = 0;   /* Match not found - disable MTU discovery. */
  837.             }
  838.         else
  839.             newmtu = nextmtu;    /* Use value from ICMP message. */
  840.         if (newmtu < PATHMTU_MIN)
  841.             {
  842.             /* Set lock to disable path MTU discovery for this destination. */
  843.             pDestRoute->rt_rmx.rmx_locks |= RTV_MTU;
  844.             }
  845.         else if (oldmtu > newmtu)
  846.             {
  847.             /*
  848.              * Decrease the estimated MTU size to the new value. The test
  849.              * handles the (illegal) case where a downstream router sends
  850.              * a larger MTU size in the "need fragment" message.
  851.              */
  852.             pDestRoute->rt_rmx.rmx_mtu = newmtu;
  853.             }
  854.         }
  855.     if (pDestRoute)
  856.         {
  857.         RTFREE (pDestRoute)
  858.         }
  859.     return;
  860.     }
  861. /* ICMP socket option processing. */
  862. int icmp_ctloutput
  863.     (
  864.     int op,
  865.     struct socket *so,
  866.     int level,
  867.     int optname,
  868.     struct mbuf **mp
  869.     )
  870.     {
  871.     register struct mbuf *m = *mp;
  872. #if 0    /* For timer options (not yet supported). */
  873.     int optval;
  874. #endif
  875.     int optlen;
  876.     int error = 0;
  877.     switch (op)
  878.         {
  879.         case PRCO_SETOPT:
  880.             optlen = m->m_len;
  881.             switch (optname)
  882.                 {
  883.                 case SO_PATHMTU_TBL:
  884.                     if (m->m_len % sizeof (u_short))
  885.                         error = EINVAL;
  886.                     else
  887.                         { 
  888.                         bcopy ((char *)mtod (m, u_short *),
  889.                                (char *)mtuTable, m->m_len);
  890.                         mtuTableSize = m->m_len / sizeof (u_short);
  891.                         }
  892.                     break;
  893. #if 0    /* Timers for increasing path MTU value (not yet supported). */
  894.                 case SO_PATHMTU_LIFETIME:
  895.                     if (m->m_len != sizeof (int))
  896.                         error = EINVAL;
  897.                     else
  898.                         optval = *mtod (m, int *);
  899.                     break;
  900.                 case SO_PATHMTU_TIMEOUT:
  901.                     break;
  902. #endif
  903.                 default:
  904.                     error = ENOPROTOOPT;
  905.                     break;
  906.                 }
  907.             if (m)
  908.                 (void)m_free(m);
  909.             break;
  910.         case PRCO_GETOPT:
  911.             *mp = m = mBufClGet (M_WAIT, MT_SOOPTS, CL_SIZE_128, TRUE);
  912.             if (m == (struct mbuf *) NULL)
  913.                 {
  914.                 error = ENOBUFS;
  915.                 break;
  916.                 }
  917.             switch (optname)
  918.                 {
  919.                 case SO_PATHMTU_TBL:
  920.                     m->m_len = mtuTableSize * sizeof (u_short);
  921.                     bcopy ((char *)mtuTable, (char *)mtod(m, u_short *),
  922.                            (unsigned)m->m_len);
  923.                     break;
  924. #if 0    /* Timers for increasing path MTU value (not yet supported). */
  925.                 case SO_PATHMTU_LIFETIME:
  926.                     m->m_len = sizeof (u_int);
  927.                     /* optval = lifetime; */
  928.                     *mtod (m, u_int *) = optval;
  929.                     break;
  930.                 case SO_PATHMTU_TIMEOUT:
  931.                     break;
  932. #endif
  933.                 default:
  934.                     error = ENOPROTOOPT;
  935.                     break;
  936.                 }
  937.             break;
  938.         }
  939.     return (error);
  940.     }
  941. #ifdef SYSCTL_SUPPORT
  942. int
  943. icmp_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
  944. int *name;
  945. u_int namelen;
  946. void *oldp;
  947. size_t *oldlenp;
  948. void *newp;
  949. size_t newlen;
  950. {
  951. /*
  952.  * XXX - This event cannot currently occur: the icmp_sysctl() routine
  953.  *       is only called by the Unix sysctl command which is not supported
  954.  *       by VxWorks
  955. #ifdef WV_INSTRUMENTATION
  956. #ifdef INCLUDE_WVNET    /@ WV_NET_INFO event @/
  957.     WV_NET_MARKER_1 (NET_AUX_EVENT, WV_NET_INFO, 5, 11, 
  958.                      WV_NETEVENT_ICMPCTRL_START, name[0])
  959. #endif  /@ INCLUDE_WVNET @/
  960. #endif
  961.  * XXX - end of unused event
  962.  */
  963. /* All sysctl names at this level are terminal. */
  964. if (namelen != 1)
  965.             {
  966. /*
  967.  * XXX - This event cannot currently occur: the icmp_sysctl() routine
  968.  *       is only called by the Unix sysctl command which is not supported
  969.  *       by VxWorks
  970. #ifdef WV_INSTRUMENTATION
  971. #ifdef INCLUDE_WVNET    /@ WV_NET_ERROR event @/
  972.         WV_NET_MARKER_1 (NET_AUX_EVENT, WV_NET_ERROR, 18, 6, 
  973.                          WV_NETEVENT_ICMPCTRL_BADLEN, namelen)
  974. #endif  /@ INCLUDE_WVNET @/
  975. #endif
  976.  * XXX - end of unused event
  977.  */
  978.             return (ENOTDIR);
  979.             }
  980. switch (name[0]) {
  981. case ICMPCTL_MASKREPL:
  982. return (sysctl_int(oldp, oldlenp, newp, newlen, &icmpmaskrepl));
  983. default:
  984. /*
  985.  * XXX - This event cannot currently occur: the icmp_sysctl() routine
  986.  *       is only called by the Unix sysctl command which is not supported
  987.  *       by VxWorks
  988. #ifdef WV_INSTRUMENTATION
  989. #ifdef INCLUDE_WVNET    /@ WV_NET_ERROR event @/
  990.             WV_NET_MARKER_1 (NET_AUX_EVENT, WV_NET_ERROR, 19, 7, 
  991.                             WV_NETEVENT_ICMPCTRL_BADCMD, name[0]) 
  992. #endif  /@ INCLUDE_WVNET @/
  993. #endif
  994.  * XXX - end of unused event
  995.  */
  996. return (ENOPROTOOPT);
  997. }
  998. /* NOTREACHED */
  999. }
  1000. #endif /* SYSCTL_SUPPORT */