Seperated out OTG, Device and Host mode demos into seperate folders for clarity....

[pub/lufa.git] / Demos / Device / RNDISEthernet / IP.c

diff --git a/Demos/Device/RNDISEthernet/IP.c b/Demos/Device/RNDISEthernet/IP.c
new file mode 100644 (file)
index 0000000..65875bb
--- /dev/null
+++ b/Demos/Device/RNDISEthernet/IP.c
@@ -0,0 +1,111 @@
+/*\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 Protocol (IP) packet handling routines. This protocol handles IP packets from the\r
+ *  host which typically encapsulate other protocols such as ICMP, UDP and TCP.\r
+ */\r
+ \r
+#include "IP.h"\r
+\r
+/** Processes an IP packet inside an Ethernet frame, and writes the appropriate response\r
+ *  to the output Ethernet frame if one is created by a subprotocol handler.\r
+ *\r
+ *  \param InDataStart   Pointer to the start of the incomming packet's IP header\r
+ *  \param OutDataStart  Pointer to the start of the outgoing packet's IP header\r
+ *\r
+ *  \return The number of bytes written to the out Ethernet frame if any, NO_RESPONSE if no\r
+ *           response was generated, NO_PROCESS if the packet processing was deferred until the\r
+ *           next Ethernet packet handler iteration\r
+ */\r
+int16_t IP_ProcessIPPacket(void* InDataStart, void* OutDataStart)\r
+{\r
+       DecodeIPHeader(InDataStart);\r
+\r
+       IP_Header_t* IPHeaderIN  = (IP_Header_t*)InDataStart;\r
+       IP_Header_t* IPHeaderOUT = (IP_Header_t*)OutDataStart;\r
+\r
+       /* Header length is specified in number of longs in the packet header, convert to bytes */\r
+       uint16_t HeaderLengthBytes = (IPHeaderIN->HeaderLength * sizeof(uint32_t));\r
+\r
+       int16_t  RetSize = NO_RESPONSE;\r
+\r
+       /* Check to ensure the IP packet is addressed to the virtual webserver's IP or the broadcast IP address */\r
+       if (!(IP_COMPARE(&IPHeaderIN->DestinationAddress, &ServerIPAddress)) &&\r
+           !(IP_COMPARE(&IPHeaderIN->DestinationAddress, &BroadcastIPAddress)))\r
+       {\r
+               return NO_RESPONSE;\r
+       }\r
+       \r
+       /* Pass off the IP payload to the appropriate protocol processing routine */\r
+       switch (IPHeaderIN->Protocol)\r
+       {\r
+               case PROTOCOL_ICMP:\r
+                       RetSize = ICMP_ProcessICMPPacket(&((uint8_t*)InDataStart)[HeaderLengthBytes],\r
+                                                        &((uint8_t*)OutDataStart)[sizeof(IP_Header_t)]);\r
+                       break;\r
+               case PROTOCOL_TCP:\r
+                       RetSize = TCP_ProcessTCPPacket(InDataStart,\r
+                                                      &((uint8_t*)InDataStart)[HeaderLengthBytes],\r
+                                                      &((uint8_t*)OutDataStart)[sizeof(IP_Header_t)]);         \r
+                       break;\r
+               case PROTOCOL_UDP:\r
+                       RetSize = UDP_ProcessUDPPacket(InDataStart,\r
+                                                      &((uint8_t*)InDataStart)[HeaderLengthBytes],\r
+                                                      &((uint8_t*)OutDataStart)[sizeof(IP_Header_t)]);         \r
+                       break;\r
+       }\r
+       \r
+       /* Check to see if the protocol processing routine has filled out a response */\r
+       if (RetSize > 0)\r
+       {\r
+               /* Fill out the response IP packet header */\r
+               IPHeaderOUT->TotalLength        = SwapEndian_16(sizeof(IP_Header_t) + RetSize);\r
+               IPHeaderOUT->TypeOfService      = 0;\r
+               IPHeaderOUT->HeaderLength       = (sizeof(IP_Header_t) / sizeof(uint32_t));\r
+               IPHeaderOUT->Version            = 4;\r
+               IPHeaderOUT->Flags              = 0;\r
+               IPHeaderOUT->FragmentOffset     = 0;\r
+               IPHeaderOUT->Identification     = 0;\r
+               IPHeaderOUT->HeaderChecksum     = 0;\r
+               IPHeaderOUT->Protocol           = IPHeaderIN->Protocol;\r
+               IPHeaderOUT->TTL                = DEFAULT_TTL;\r
+               IPHeaderOUT->SourceAddress      = IPHeaderIN->DestinationAddress;\r
+               IPHeaderOUT->DestinationAddress = IPHeaderIN->SourceAddress;\r
+               \r
+               IPHeaderOUT->HeaderChecksum     = Ethernet_Checksum16(IPHeaderOUT, sizeof(IP_Header_t));\r
+                                               \r
+               /* Return the size of the response so far */\r
+               return (sizeof(IP_Header_t) + RetSize);\r
+       }\r
+       \r
+       return RetSize;\r
+}\r