Split out the RFCOMM Control Channel command processing code into a seperate set...

[pub/lufa.git] / Demos / Host / Incomplete / BluetoothHost / Lib / RFCOMMControl.c

diff --git a/Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMMControl.c b/Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMMControl.c
new file mode 100644 (file)
index 0000000..2321c25
--- /dev/null
+++ b/Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMMControl.c
@@ -0,0 +1,120 @@
+/*\r
+             LUFA Library\r
+     Copyright (C) Dean Camera, 2010.\r
+              \r
+  dean [at] fourwalledcubicle [dot] com\r
+      www.fourwalledcubicle.com\r
+*/\r
+\r
+/*\r
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)\r
+\r
+  Permission to use, copy, modify, distribute, and sell this \r
+  software and its documentation for any purpose is hereby granted\r
+  without fee, provided that the above copyright notice appear in \r
+  all 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
+ *  RFCOMM multiplexer control layer module. This module handles multiplexer\r
+ *  channel commands to the control DLCI in the RFCOMM layer, to open, configure,\r
+ *  test and close logical RFCOMM channels.\r
+ */\r
+\r
+#define  INCLUDE_FROM_RFCOMM_CONTROL_C\r
+#include "RFCOMMControl.h"\r
+\r
+void RFCOMM_ProcessControlCommand(const uint8_t* Command, Bluetooth_Channel_t* const Channel)\r
+{\r
+       const RFCOMM_Command_t* CommandHeader  = (const RFCOMM_Command_t*)Command;\r
+       const uint8_t*          CommandData    = (const uint8_t*)Command + sizeof(RFCOMM_Command_t);\r
+\r
+       switch (CommandHeader->Command)\r
+       {\r
+               case RFCOMM_Control_Test:\r
+                       RFCOMM_ProcessTestCommand(CommandHeader, CommandData);\r
+                       break;\r
+               case RFCOMM_Control_FlowControlEnable:\r
+                       RFCOMM_ProcessFCECommand(CommandHeader, CommandData);\r
+                       break;\r
+               case RFCOMM_Control_FlowControlDisable:\r
+                       RFCOMM_ProcessFCDCommand(CommandHeader, CommandData);\r
+                       break;\r
+               case RFCOMM_Control_ModemStatus:\r
+                       RFCOMM_ProcessMSCommand(CommandHeader, CommandData);\r
+                       break;\r
+               case RFCOMM_Control_RemotePortNegotiation:\r
+                       RFCOMM_ProcessRPNCommand(CommandHeader, CommandData);\r
+                       break;\r
+               case RFCOMM_Control_RemoteLineStatus:\r
+                       RFCOMM_ProcessRLSCommand(CommandHeader, CommandData);\r
+                       break;\r
+               case RFCOMM_Control_DLCParameterNegotiation:\r
+                       RFCOMM_ProcessDPNCommand(CommandHeader, CommandData);\r
+                       break;\r
+               default:\r
+                       BT_RFCOMM_DEBUG(1, "<< Unknown Command");               \r
+                       break;\r
+       }\r
+}\r
+\r
+static void RFCOMM_ProcessTestCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData)\r
+{\r
+       BT_RFCOMM_DEBUG(1, "<< TEST Command");\r
+}\r
+\r
+static void RFCOMM_ProcessFCECommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData)\r
+{\r
+       BT_RFCOMM_DEBUG(1, "<< FCE Command");\r
+}\r
+\r
+static void RFCOMM_ProcessFCDCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData)\r
+{\r
+       BT_RFCOMM_DEBUG(1, "<< FCD Command");\r
+}\r
+\r
+static void RFCOMM_ProcessMSCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData)\r
+{\r
+       BT_RFCOMM_DEBUG(1, "<< MS Command");\r
+}\r
+\r
+static void RFCOMM_ProcessRPNCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData)\r
+{\r
+       BT_RFCOMM_DEBUG(1, "<< RPN Command");\r
+}\r
+\r
+static void RFCOMM_ProcessRLSCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData)\r
+{\r
+       BT_RFCOMM_DEBUG(1, "<< RLS Command");\r
+}\r
+\r
+static void RFCOMM_ProcessDPNCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData)\r
+{\r
+       BT_RFCOMM_DEBUG(1, "<< DPN Command");\r
+       \r
+       /* Skip over the first data byte (Length field) since its size and value are fixed */\r
+       RFCOMM_Channel_t* RFCOMMChannel = RFCOMM_GetChannelData(CommandData[2]);\r
+       \r
+       if (RFCOMMChannel == NULL)\r
+       {\r
+               // TODO: Channel does not exist - create it\r
+       }\r
+       \r
+       RFCOMMChannel->Configured = true;\r
+       \r
+       // TODO: Read in channel data, ACK request\r
+}\r