00001 /* 00002 * Copyright (C) 2001-2004 by egnite Software GmbH. All rights reserved. 00003 * 00004 * Redistribution and use in source and binary forms, with or without 00005 * modification, are permitted provided that the following conditions 00006 * are met: 00007 * 00008 * 1. Redistributions of source code must retain the above copyright 00009 * notice, this list of conditions and the following disclaimer. 00010 * 2. Redistributions in binary form must reproduce the above copyright 00011 * notice, this list of conditions and the following disclaimer in the 00012 * documentation and/or other materials provided with the distribution. 00013 * 3. Neither the name of the copyright holders nor the names of 00014 * contributors may be used to endorse or promote products derived 00015 * from this software without specific prior written permission. 00016 * 00017 * THIS SOFTWARE IS PROVIDED BY EGNITE SOFTWARE GMBH AND CONTRIBUTORS 00018 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 00019 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 00020 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL EGNITE 00021 * SOFTWARE GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 00022 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 00023 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 00024 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 00025 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 00026 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 00027 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 00028 * SUCH DAMAGE. 00029 * 00030 * For additional information see http://www.ethernut.de/ 00031 * 00032 * - 00033 * Portions Copyright (C) 2000 David J. Hudson <dave@humbug.demon.co.uk> 00034 * 00035 * This file is distributed in the hope that it will be useful, but WITHOUT 00036 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 00037 * FITNESS FOR A PARTICULAR PURPOSE. 00038 * 00039 * You can redistribute this file and/or modify it under the terms of the GNU 00040 * General Public License (GPL) as published by the Free Software Foundation; 00041 * either version 2 of the License, or (at your discretion) any later version. 00042 * See the accompanying file "copying-gpl.txt" for more details. 00043 * 00044 * As a special exception to the GPL, permission is granted for additional 00045 * uses of the text contained in this file. See the accompanying file 00046 * "copying-liquorice.txt" for details. 00047 * - 00048 * Portions Copyright (c) 1983, 1993 by 00049 * The Regents of the University of California. All rights reserved. 00050 * 00051 * Redistribution and use in source and binary forms, with or without 00052 * modification, are permitted provided that the following conditions 00053 * are met: 00054 * 1. Redistributions of source code must retain the above copyright 00055 * notice, this list of conditions and the following disclaimer. 00056 * 2. Redistributions in binary form must reproduce the above copyright 00057 * notice, this list of conditions and the following disclaimer in the 00058 * documentation and/or other materials provided with the distribution. 00059 * 3. Neither the name of the University nor the names of its contributors 00060 * may be used to endorse or promote products derived from this software 00061 * without specific prior written permission. 00062 * 00063 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 00064 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 00065 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 00066 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 00067 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 00068 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 00069 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 00070 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 00071 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 00072 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 00073 * SUCH DAMAGE. 00074 * - 00075 * Portions Copyright (c) 1993 by Digital Equipment Corporation. 00076 * 00077 * Permission to use, copy, modify, and distribute this software for any 00078 * purpose with or without fee is hereby granted, provided that the above 00079 * copyright notice and this permission notice appear in all copies, and that 00080 * the name of Digital Equipment Corporation not be used in advertising or 00081 * publicity pertaining to distribution of the document or software without 00082 * specific, written prior permission. 00083 * 00084 * THE SOFTWARE IS PROVIDED "AS IS" AND DIGITAL EQUIPMENT CORP. DISCLAIMS ALL 00085 * WARRANTIES WITH REGARD TO THIS SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES 00086 * OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL DIGITAL EQUIPMENT 00087 * CORPORATION BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL 00088 * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR 00089 * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS 00090 * ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS 00091 * SOFTWARE. 00092 */ 00093 00094 /* 00095 * $Log: icmpin.c,v $ 00096 * Revision 1.7 2008/08/11 07:00:29 haraldkipp 00097 * BSD types replaced by stdint types (feature request #1282721). 00098 * 00099 * Revision 1.6 2008/05/24 22:23:55 olereinhardt 00100 * Fixed cvs log message 00101 * 00102 * Revision 1.5 2008/05/24 22:22:26 olereinhardt 00103 * Fixed size comparision in NutIcmpUnreach 00104 * 00105 * Revision 1.4 2004/03/18 10:28:36 haraldkipp 00106 * Comments updated 00107 * 00108 * Revision 1.3 2004/02/06 19:23:59 drsung 00109 * Bugfix. After last changes, ping didn't work any more. Thanks to Pavel Celeda, who discovered this bug. 00110 * 00111 * Revision 1.2 2004/02/02 18:59:25 drsung 00112 * Some more ICMP support added. 00113 * 00114 * Revision 1.1.1.1 2003/05/09 14:41:28 haraldkipp 00115 * Initial using 3.2.1 00116 * 00117 * Revision 1.11 2003/02/04 18:14:57 harald 00118 * Version 3 released 00119 * 00120 * Revision 1.10 2002/06/26 17:29:35 harald 00121 * First pre-release with 2.4 stack 00122 * 00123 */ 00124 00125 #include <netinet/ip_icmp.h> 00126 #include <netinet/ipcsum.h> 00127 #include <netinet/icmp.h> 00128 #include <sys/socket.h> 00129 #include <netinet/tcp.h> 00130 #include <net/errno.h> 00131 #include <netinet/in.h> 00132 00137 00138 /* 00139 * Send out ICMP echo response. 00140 */ 00141 static int NutIcmpReflect(NUTDEVICE * dev, uint8_t type, NETBUF * nb) 00142 { 00143 IPHDR *ip; 00144 ICMPHDR *icmp; 00145 uint32_t dest; 00146 IFNET *nif; 00147 00148 ip = nb->nb_nw.vp; 00149 icmp = nb->nb_tp.vp; 00150 dest = ip->ip_src; 00151 nif = dev->dev_icb; 00152 ip->ip_src = nif->if_local_ip; 00153 ip->ip_ttl = MAXTTL; 00154 00155 return NutIcmpOutput(type, dest, nb); 00156 } 00157 00158 /* 00159 * Process incoming ICMP messages for destination unreachable. 00160 */ 00161 static int NutIcmpUnreach(NETBUF * nb) 00162 { 00163 IPHDR *ih; 00164 TCPHDR *th; 00165 TCPSOCKET *sock; 00166 00167 if (nb->nb_ap.sz < sizeof(IPHDR) + 8) 00168 return -1; 00169 00170 ih = nb->nb_ap.vp; 00171 if (ih->ip_p != IPPROTO_TCP) 00172 return -1; 00173 00174 th = (TCPHDR *) ((char *) ih) + sizeof(IPHDR); 00175 sock = NutTcpFindSocket(th->th_dport, th->th_sport, ih->ip_src); 00176 if (sock == 0) 00177 return -1; 00178 00179 if (sock->so_state != TCPS_SYN_SENT && sock->so_state != TCPS_ESTABLISHED) 00180 return -1; 00181 00182 NutTcpAbortSocket(sock, EHOSTUNREACH); 00183 NutNetBufFree(nb); 00184 return 0; 00185 } 00186 00203 void NutIcmpInput(NUTDEVICE * dev, NETBUF * nb) 00204 { 00205 /* 00206 * Silently discard packets, which are too small. 00207 */ 00208 if (nb->nb_tp.sz > ICMP_MINLEN) { 00209 ICMPHDR *icp = (ICMPHDR *) nb->nb_tp.vp; 00210 00211 if (nb->nb_tp.sz > sizeof(ICMPHDR)) { 00212 nb->nb_ap.sz = nb->nb_tp.sz - sizeof(ICMPHDR); 00213 nb->nb_ap.vp = ((char *) icp) + sizeof(ICMPHDR); 00214 nb->nb_tp.sz = sizeof(ICMPHDR); 00215 } 00216 00217 switch (icp->icmp_type) { 00218 case ICMP_ECHO: 00219 if (NutIcmpReflect(dev, ICMP_ECHOREPLY, nb) == 0) 00220 NutNetBufFree(nb); 00221 break; 00222 case ICMP_UNREACH: 00223 if (NutIcmpUnreach(nb) != 0) 00224 NutNetBufFree(nb); 00225 break; 00226 default: 00227 NutNetBufFree(nb); 00228 } 00229 } else 00230 NutNetBufFree(nb); 00231 } 00232