00001 /* 00002 * Copyright (c) 2009 Lukas Mejdrech 00003 * All rights reserved. 00004 * 00005 * Redistribution and use in source and binary forms, with or without 00006 * modification, are permitted provided that the following conditions 00007 * are met: 00008 * 00009 * - Redistributions of source code must retain the above copyright 00010 * notice, this list of conditions and the following disclaimer. 00011 * - Redistributions in binary form must reproduce the above copyright 00012 * notice, this list of conditions and the following disclaimer in the 00013 * documentation and/or other materials provided with the distribution. 00014 * - The name of the author may not be used to endorse or promote products 00015 * derived from this software without specific prior written permission. 00016 * 00017 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 00018 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 00019 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 00020 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 00021 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 00022 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 00023 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 00024 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 00025 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 00026 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 00027 */ 00028 00038 #include <icmp_client.h> 00039 #include <icmp_header.h> 00040 #include <packet_client.h> 00041 00042 #ifdef CONFIG_DEBUG 00043 #include <stdio.h> 00044 #endif 00045 00046 #include <errno.h> 00047 #include <sys/types.h> 00048 00049 #include <net/icmp_codes.h> 00050 #include <net/packet.h> 00051 00062 int 00063 icmp_client_process_packet(packet_t *packet, icmp_type_t *type, 00064 icmp_code_t *code, icmp_param_t *pointer, icmp_param_t *mtu) 00065 { 00066 icmp_header_t *header; 00067 00068 header = (icmp_header_t *) packet_get_data(packet); 00069 if (!header || 00070 (packet_get_data_length(packet) < sizeof(icmp_header_t))) { 00071 return 0; 00072 } 00073 00074 if (type) 00075 *type = header->type; 00076 if (code) 00077 *code = header->code; 00078 if (pointer) 00079 *pointer = header->un.param.pointer; 00080 if (mtu) 00081 *mtu = header->un.frag.mtu; 00082 00083 /* Remove debug dump */ 00084 #ifdef CONFIG_DEBUG 00085 printf("ICMP error %d (%d) in packet %d\n", header->type, header->code, 00086 packet_get_id(packet)); 00087 #endif 00088 return sizeof(icmp_header_t); 00089 } 00090 00096 size_t icmp_client_header_length(packet_t *packet) 00097 { 00098 if (packet_get_data_length(packet) < sizeof(icmp_header_t)) 00099 return 0; 00100 00101 return sizeof(icmp_header_t); 00102 } 00103