Moved out each demos' functionality library files (e.g. Ring Buffer library) to ...

[pub/lufa.git] / Demos / Device / RNDISEthernet / Lib / UDP.c

diff --git a/Demos/Device/RNDISEthernet/Lib/UDP.c b/Demos/Device/RNDISEthernet/Lib/UDP.c
new file mode 100644 (file)
index 0000000..1f571c3
--- /dev/null
+++ b/Demos/Device/RNDISEthernet/Lib/UDP.c
@@ -0,0 +1,80 @@
+/*\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
+ *  User Datagram Protocol (UDP) packet handling routines. This protocol handles high throughput, low\r
+ *  reliability packets which are typically used to encapsulate streaming data.\r
+ */\r
+ \r
+#define  INCLUDE_FROM_UDP_C\r
+#include "UDP.h"\r
+\r
+/** Processes a UDP packet inside an Ethernet frame, and writes the appropriate response\r
+ *  to the output Ethernet frame if a subprotocol handler has created a response packet.\r
+ *\r
+ *  \param IPHeaderInStart    Pointer to the start of the incoming packet's IP header\r
+ *  \param UDPHeaderInStart   Pointer to the start of the incoming packet's UDP header\r
+ *  \param UDPHeaderOutStart  Pointer to the start of the outgoing packet's UDP header\r
+ *\r
+ *  \return The number of bytes written to the out Ethernet frame if any, NO_RESPONSE otherwise\r
+ */\r
+int16_t UDP_ProcessUDPPacket(void* IPHeaderInStart, void* UDPHeaderInStart, void* UDPHeaderOutStart)\r
+{\r
+       UDP_Header_t* UDPHeaderIN  = (UDP_Header_t*)UDPHeaderInStart;\r
+       UDP_Header_t* UDPHeaderOUT = (UDP_Header_t*)UDPHeaderOutStart;\r
+       \r
+       int16_t RetSize = NO_RESPONSE;\r
+       \r
+       DecodeUDPHeader(UDPHeaderInStart);\r
+       \r
+       /* Check to see if the UDP packet is a DHCP packet */\r
+       if (SwapEndian_16(UDPHeaderIN->DestinationPort) == UDP_PORT_DHCP_REQUEST)\r
+       {\r
+               RetSize = DHCP_ProcessDHCPPacket(IPHeaderInStart,\r
+                                                &((uint8_t*)UDPHeaderInStart)[sizeof(UDP_Header_t)],\r
+                                            &((uint8_t*)UDPHeaderOutStart)[sizeof(UDP_Header_t)]);\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 UDP packet header */\r
+               UDPHeaderOUT->SourcePort      = UDPHeaderIN->DestinationPort;\r
+               UDPHeaderOUT->DestinationPort = UDPHeaderIN->SourcePort;\r
+               UDPHeaderOUT->Checksum        = 0;\r
+               UDPHeaderOUT->Length          = SwapEndian_16(sizeof(UDP_Header_t) + RetSize);\r
+\r
+               /* Return the size of the response so far */\r
+               return (sizeof(UDP_Header_t) + RetSize);\r
+       }\r
+       \r
+       return NO_RESPONSE;\r
+}\r