+++ /dev/null
-/*\r
- LUFA Library\r
- Copyright (C) Dean Camera, 2009.\r
- \r
- dean [at] fourwalledcubicle [dot] com\r
- www.fourwalledcubicle.com\r
-*/\r
-\r
-/*\r
- Copyright 2009 Dean Camera (dean [at] fourwalledcubicle [dot] com)\r
-\r
- Permission to use, copy, modify, and distribute this software\r
- and its documentation for any purpose and without fee is hereby\r
- granted, provided that the above copyright notice appear in all\r
- copies and that both that the copyright notice and this\r
- permission notice and warranty disclaimer appear in supporting\r
- documentation, and that the name of the author not be used in\r
- advertising or publicity pertaining to distribution of the\r
- software without specific, written prior permission.\r
-\r
- The author disclaim all warranties with regard to this\r
- software, including all implied warranties of merchantability\r
- and fitness. In no event shall the author be liable for any\r
- special, indirect or consequential damages or any damages\r
- whatsoever resulting from loss of use, data or profits, whether\r
- in an action of contract, negligence or other tortious action,\r
- arising out of or in connection with the use or performance of\r
- this software.\r
-*/\r
-\r
-/** \file\r
- *\r
- * Internet Control Message Protocol (ICMP) packet handling routines. This protocol handles\r
- * Echo requests from the host, to indicate a successful network connection between the host\r
- * and the virtual server.\r
- */\r
- \r
-#include "ICMP.h"\r
-\r
-/** Processes an ICMP packet inside an Ethernet frame, and writes the appropriate response\r
- * to the output Ethernet frame if the host is issuing a ICMP ECHO request.\r
- *\r
- * \param FrameIN Pointer to the incomming Ethernet frame information structure\r
- * \param InDataStart Pointer to the start of the incoming packet's ICMP header\r
- * \param OutDataStart Pointer to the start of the outgoing packet's ICMP header\r
- *\r
- * \return The number of bytes written to the out Ethernet frame if any, NO_RESPONSE otherwise\r
- */\r
-int16_t ICMP_ProcessICMPPacket(Ethernet_Frame_Info_t* FrameIN, void* InDataStart, void* OutDataStart)\r
-{\r
- ICMP_Header_t* ICMPHeaderIN = (ICMP_Header_t*)InDataStart;\r
- ICMP_Header_t* ICMPHeaderOUT = (ICMP_Header_t*)OutDataStart;\r
-\r
- DecodeICMPHeader(InDataStart);\r
-\r
- /* Determine if the ICMP packet is an echo request (ping) */\r
- if (ICMPHeaderIN->Type == ICMP_TYPE_ECHOREQUEST)\r
- {\r
- /* Fill out the ICMP response packet */\r
- ICMPHeaderOUT->Type = ICMP_TYPE_ECHOREPLY;\r
- ICMPHeaderOUT->Code = 0;\r
- ICMPHeaderOUT->Checksum = 0;\r
- ICMPHeaderOUT->Id = ICMPHeaderIN->Id;\r
- ICMPHeaderOUT->Sequence = ICMPHeaderIN->Sequence;\r
- \r
- uint16_t DataSize = FrameIN->FrameLength - ((((uint16_t)InDataStart + sizeof(ICMP_Header_t)) - (uint16_t)FrameIN->FrameData));\r
- \r
- /* Copy the remaining payload to the response - echo requests should echo back any sent data */\r
- memcpy(&((uint8_t*)OutDataStart)[sizeof(ICMP_Header_t)],\r
- &((uint8_t*)InDataStart)[sizeof(ICMP_Header_t)],\r
- DataSize);\r
-\r
- ICMPHeaderOUT->Checksum = Ethernet_Checksum16(ICMPHeaderOUT, (DataSize + sizeof(ICMP_Header_t)));\r
-\r
- /* Return the size of the response so far */\r
- return (DataSize + sizeof(ICMP_Header_t));\r
- }\r
- \r
- return NO_RESPONSE;\r
-}\r