Added ability to search by Channel PSM to the GetChannelData() function in the Blueto...
[pub/USBasp.git] / Demos / Host / Incomplete / BluetoothHost / Lib / BluetoothHCICommands.c
index 2f78621..d83b93b 100644 (file)
 #define  INCLUDE_FROM_BLUETOOTHHCICOMMANDS_C\r
 #include "BluetoothHCICommands.h"\r
 \r
-/** Current processing state of the HCI portion of the Bluetooth stack. */\r
-uint8_t Bluetooth_HCIProcessingState;\r
-\r
-/** Next HCI state to enter once the last issued HCI command has completed. */\r
-static uint8_t Bluetooth_HCINextState;\r
-\r
 /** Temporary Bluetooth Device Address, for HCI responses which much include the detination address */\r
 static uint8_t Bluetooth_TempDeviceAddress[6];\r
 \r
-\r
 /** Bluetooth HCI processing task. This task should be called repeatedly the main Bluetooth\r
  *  stack task to manage the HCI processing state.\r
  */\r
@@ -48,7 +41,7 @@ void Bluetooth_HCITask(void)
 {\r
        BT_HCICommand_Header_t HCICommandHeader;\r
 \r
-       switch (Bluetooth_HCIProcessingState)\r
+       switch (Bluetooth_State.CurrentHCIState)\r
        {\r
                case Bluetooth_ProcessEvents:\r
                        Pipe_SelectPipe(BLUETOOTH_EVENTS_PIPE);\r
@@ -74,7 +67,19 @@ void Bluetooth_HCITask(void)
                                {\r
                                        case EVENT_COMMAND_COMPLETE:\r
                                                BT_HCI_DEBUG(1, "<< Command Complete");\r
-                                               Bluetooth_HCIProcessingState = Bluetooth_HCINextState;\r
+                                               \r
+                                               /* Check which operation was completed in case we need to process the even parameters */\r
+                                               switch (((BT_HCIEvent_CommandComplete_t*)&EventParams)->Opcode)\r
+                                               {\r
+                                                       case (OGF_CTRLR_INFORMATIONAL | OCF_CTRLR_INFORMATIONAL_READBDADDR):\r
+                                                               /* A READ BDADDR command completed, copy over the local device's BDADDR from the response */\r
+                                                               memcpy(Bluetooth_State.LocalBDADDR,\r
+                                                                      &((BT_HCIEvent_CommandComplete_t*)&EventParams)->ReturnParams[1],\r
+                                                                      sizeof(Bluetooth_State.LocalBDADDR));\r
+                                                               break;\r
+                                               }\r
+                                               \r
+                                               Bluetooth_State.CurrentHCIState = Bluetooth_State.NextHCIState;\r
                                                break;\r
                                        case EVENT_COMMAND_STATUS:\r
                                                BT_HCI_DEBUG(1, "<< Command Status");\r
@@ -82,7 +87,7 @@ void Bluetooth_HCITask(void)
 \r
                                                /* If the execution of a command failed, reset the stack */\r
                                                if (((BT_HCIEvent_CommandStatus_t*)&EventParams)->Status)\r
-                                                 Bluetooth_HCIProcessingState = Bluetooth_Init;\r
+                                                 Bluetooth_State.CurrentHCIState = Bluetooth_Init;\r
                                                break;\r
                                        case EVENT_CONNECTION_REQUEST:\r
                                                BT_HCI_DEBUG(1, "<< Connection Request");\r
@@ -97,11 +102,11 @@ void Bluetooth_HCITask(void)
 \r
                                                /* Only accept the connection if it is a ACL (data) connection, a device is not already connected\r
                                                   and the user application has indicated that the connection should be allowed */\r
-                                               Bluetooth_HCIProcessingState = (Bluetooth_Connection.IsConnected || !(IsACLConnection) ||\r
-                                                                                                           !(Bluetooth_ConnectionRequest(Bluetooth_TempDeviceAddress))) ?\r
-                                                                                                          Bluetooth_Conn_RejectConnection : Bluetooth_Conn_AcceptConnection;\r
+                                               Bluetooth_State.CurrentHCIState = (Bluetooth_Connection.IsConnected || !(IsACLConnection) ||\r
+                                                                                                             !(Bluetooth_ConnectionRequest(Bluetooth_TempDeviceAddress))) ?\r
+                                                                                                             Bluetooth_Conn_RejectConnection : Bluetooth_Conn_AcceptConnection;\r
 \r
-                                               BT_HCI_DEBUG(2, "-- Connection %S", (Bluetooth_HCIProcessingState == Bluetooth_Conn_RejectConnection) ?\r
+                                               BT_HCI_DEBUG(2, "-- Connection %S", (Bluetooth_State.CurrentHCIState == Bluetooth_Conn_RejectConnection) ?\r
                                                                                     PSTR("REJECTED") : PSTR("ACCEPTED"));\r
 \r
                                                break;\r
@@ -113,7 +118,7 @@ void Bluetooth_HCITask(void)
                                                       &((BT_HCIEvent_PinCodeReq_t*)&EventParams)->RemoteAddress,\r
                                                       sizeof(Bluetooth_TempDeviceAddress));\r
 \r
-                                               Bluetooth_HCIProcessingState = Bluetooth_Conn_SendPINCode;\r
+                                               Bluetooth_State.CurrentHCIState = Bluetooth_Conn_SendPINCode;\r
                                                break;\r
                                        case EVENT_LINK_KEY_REQUEST:\r
                                                BT_HCI_DEBUG(1, "<< Link Key Request");\r
@@ -123,7 +128,7 @@ void Bluetooth_HCITask(void)
                                                       &((BT_HCIEvent_LinkKeyReq_t*)&EventParams)->RemoteAddress,\r
                                                       sizeof(Bluetooth_TempDeviceAddress));                                            \r
                                                \r
-                                               Bluetooth_HCIProcessingState = Bluetooth_Conn_SendLinkKeyNAK;\r
+                                               Bluetooth_State.CurrentHCIState = Bluetooth_Conn_SendLinkKeyNAK;\r
                                                break;\r
                                        case EVENT_CONNECTION_COMPLETE:\r
                                                BT_HCI_DEBUG(1, "<< Connection Complete");\r
@@ -148,7 +153,7 @@ void Bluetooth_HCITask(void)
                                                \r
                                                Bluetooth_DisconnectionComplete();\r
                                                \r
-                                               Bluetooth_HCIProcessingState = Bluetooth_Init;\r
+                                               Bluetooth_State.CurrentHCIState = Bluetooth_Init;\r
                                                break;\r
                                }\r
                        }\r
@@ -159,62 +164,94 @@ void Bluetooth_HCITask(void)
                case Bluetooth_Init:\r
                        BT_HCI_DEBUG(1, "# Init");\r
 \r
+                       Bluetooth_State.IsInitialized = false;\r
+\r
                        /* Reset the connection information structure to destroy any previous connection state */\r
                        memset(&Bluetooth_Connection, 0x00, sizeof(Bluetooth_Connection));\r
 \r
-                       Bluetooth_HCIProcessingState = Bluetooth_Init_Reset; \r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_Init_Reset; \r
                        break;\r
                case Bluetooth_Init_Reset:\r
                        BT_HCI_DEBUG(1, "# Reset");\r
 \r
                        HCICommandHeader = (BT_HCICommand_Header_t)\r
                        {\r
-                               OpCode: {OGF: OGF_CTRLR_BASEBAND, OCF: OCF_CTRLR_BASEBAND_RESET},\r
+                               OpCode: (OGF_CTRLR_BASEBAND | OCF_CTRLR_BASEBAND_RESET),\r
                                ParameterLength: 0,\r
                        };\r
 \r
                        /* Send the command to reset the bluetooth dongle controller */\r
                        Bluetooth_SendHCICommand(&HCICommandHeader, NULL, 0);\r
                        \r
-                       Bluetooth_HCINextState       = Bluetooth_Init_SetLocalName;\r
-                       Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
+                       Bluetooth_State.NextHCIState    = Bluetooth_Init_ReadBufferSize;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
+                       break;\r
+               case Bluetooth_Init_ReadBufferSize:\r
+                       BT_HCI_DEBUG(1, "# Read Buffer Size");\r
+               \r
+                       HCICommandHeader = (BT_HCICommand_Header_t)\r
+                       {\r
+                               OpCode: (OGF_CTRLR_INFORMATIONAL | OCF_CTRLR_INFORMATIONAL_READBUFFERSIZE),\r
+                               ParameterLength: 0,\r
+                       };\r
+\r
+                       /* Send the command to read the bluetooth buffer size (mandatory before device sends any data) */\r
+                       Bluetooth_SendHCICommand(&HCICommandHeader, NULL, 0);\r
+\r
+                       Bluetooth_State.NextHCIState    = Bluetooth_Init_GetBDADDR;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
+                       break;\r
+               case Bluetooth_Init_GetBDADDR:\r
+                       BT_HCI_DEBUG(1, "# Get BDADDR");\r
+               \r
+                       HCICommandHeader = (BT_HCICommand_Header_t)\r
+                       {\r
+                               OpCode: (OGF_CTRLR_INFORMATIONAL | OCF_CTRLR_INFORMATIONAL_READBDADDR),\r
+                               ParameterLength: 0,\r
+                       };\r
+\r
+                       /* Send the command to retrieve the BDADDR of the inserted bluetooth dongle */\r
+                       Bluetooth_SendHCICommand(&HCICommandHeader, NULL, 0);\r
+\r
+                       Bluetooth_State.NextHCIState    = Bluetooth_Init_SetLocalName;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
                        break;\r
                case Bluetooth_Init_SetLocalName:\r
                        BT_HCI_DEBUG(1, "# Set Local Name");\r
 \r
                        HCICommandHeader = (BT_HCICommand_Header_t)\r
                                {\r
-                                       OpCode: {OGF: OGF_CTRLR_BASEBAND, OCF: OCF_CTRLR_BASEBAND_WRITE_LOCAL_NAME},\r
+                                       OpCode: (OGF_CTRLR_BASEBAND | OCF_CTRLR_BASEBAND_WRITE_LOCAL_NAME),\r
                                        ParameterLength: 248,\r
                                };\r
 \r
                        /* Send the command to set the bluetooth dongle's name for other devices to see */\r
                        Bluetooth_SendHCICommand(&HCICommandHeader, Bluetooth_DeviceConfiguration.Name, strlen(Bluetooth_DeviceConfiguration.Name));\r
 \r
-                       Bluetooth_HCINextState       = Bluetooth_Init_SetDeviceClass;\r
-                       Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
+                       Bluetooth_State.NextHCIState    = Bluetooth_Init_SetDeviceClass;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
                        break;\r
                case Bluetooth_Init_SetDeviceClass:\r
                        BT_HCI_DEBUG(1, "# Set Device Class");\r
 \r
                        HCICommandHeader = (BT_HCICommand_Header_t)\r
                                {\r
-                                       OpCode: {OGF: OGF_CTRLR_BASEBAND, OCF: OCF_CTRLR_BASEBAND_WRITE_CLASS_OF_DEVICE},\r
+                                       OpCode: (OGF_CTRLR_BASEBAND | OCF_CTRLR_BASEBAND_WRITE_CLASS_OF_DEVICE),\r
                                        ParameterLength: 3,\r
                                };\r
 \r
                        /* Send the command to set the class of the device for other devices to see */\r
                        Bluetooth_SendHCICommand(&HCICommandHeader, &Bluetooth_DeviceConfiguration.Class, 3);\r
 \r
-                       Bluetooth_HCINextState       = Bluetooth_Init_WriteScanEnable;\r
-                       Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
+                       Bluetooth_State.NextHCIState    = Bluetooth_Init_WriteScanEnable;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
                        break;\r
                case Bluetooth_Init_WriteScanEnable:\r
                        BT_HCI_DEBUG(1, "# Write Scan Enable");\r
 \r
                        HCICommandHeader = (BT_HCICommand_Header_t)\r
                        {\r
-                               OpCode: {OGF: OGF_CTRLR_BASEBAND, OCF: OCF_CTRLR_BASEBAND_WRITE_SCAN_ENABLE},\r
+                               OpCode: (OGF_CTRLR_BASEBAND | OCF_CTRLR_BASEBAND_WRITE_SCAN_ENABLE),\r
                                ParameterLength: 1,\r
                        };\r
 \r
@@ -223,15 +260,24 @@ void Bluetooth_HCITask(void)
                        /* Send the command to set the remote device scanning mode */\r
                        Bluetooth_SendHCICommand(&HCICommandHeader, &Interval, 1);\r
                        \r
-                       Bluetooth_HCINextState       = Bluetooth_ProcessEvents;\r
-                       Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
+                       Bluetooth_State.NextHCIState    = Bluetooth_Init_FinalizeInit;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
+                       break;\r
+               case Bluetooth_Init_FinalizeInit:\r
+                       Bluetooth_State.IsInitialized = true;\r
+\r
+                       /* Fire the user application callback to indicate that the stack is now fully initialized */\r
+                       Bluetooth_StackInitialized();\r
+\r
+                       Bluetooth_State.NextHCIState    = Bluetooth_ProcessEvents;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
                        break;\r
                case Bluetooth_Conn_AcceptConnection:\r
                        BT_HCI_DEBUG(1, "# Accept Connection");\r
 \r
                        HCICommandHeader = (BT_HCICommand_Header_t)\r
                                {\r
-                                       OpCode: {OGF: OGF_LINK_CONTROL, OCF: OCF_LINK_CONTROL_ACCEPT_CONNECTION_REQUEST},\r
+                                       OpCode: (OGF_LINK_CONTROL | OCF_LINK_CONTROL_ACCEPT_CONNECTION_REQUEST),\r
                                        ParameterLength: sizeof(BT_HCICommand_AcceptConnectionReq_t),\r
                                };\r
 \r
@@ -245,14 +291,14 @@ void Bluetooth_HCITask(void)
                        /* Send the command to accept the remote connection request */\r
                        Bluetooth_SendHCICommand(&HCICommandHeader, &AcceptConnectionParams, sizeof(BT_HCICommand_AcceptConnectionReq_t));\r
                        \r
-                       Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
                        break;\r
                case Bluetooth_Conn_RejectConnection:\r
                        BT_HCI_DEBUG(1, "# Reject Connection");\r
 \r
                        HCICommandHeader = (BT_HCICommand_Header_t)\r
                                {\r
-                                       OpCode: {OGF: OGF_LINK_CONTROL, OCF: OCF_LINK_CONTROL_REJECT_CONNECTION_REQUEST},\r
+                                       OpCode: (OGF_LINK_CONTROL | OCF_LINK_CONTROL_REJECT_CONNECTION_REQUEST),\r
                                        ParameterLength: sizeof(BT_HCICommand_RejectConnectionReq_t),\r
                                };\r
 \r
@@ -265,14 +311,14 @@ void Bluetooth_HCITask(void)
                        /* Send the command to reject the remote connection request */\r
                        Bluetooth_SendHCICommand(&HCICommandHeader, &RejectConnectionParams, sizeof(BT_HCICommand_RejectConnectionReq_t));\r
                \r
-                       Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
                        break;\r
                case Bluetooth_Conn_SendPINCode:\r
                        BT_HCI_DEBUG(1, "# Send Pin Code");\r
 \r
                        HCICommandHeader = (BT_HCICommand_Header_t)\r
                                {\r
-                                       OpCode: {OGF: OGF_LINK_CONTROL, OCF: OCF_LINK_CONTROL_PIN_CODE_REQUEST_REPLY},\r
+                                       OpCode: (OGF_LINK_CONTROL | OCF_LINK_CONTROL_PIN_CODE_REQUEST_REPLY),\r
                                        ParameterLength: sizeof(BT_HCICommand_PinCodeResp_t),\r
                                };\r
 \r
@@ -286,14 +332,14 @@ void Bluetooth_HCITask(void)
                        /* Send the command to transmit the device's local PIN number for authentication */\r
                        Bluetooth_SendHCICommand(&HCICommandHeader, &PINCodeRequestParams, sizeof(BT_HCICommand_PinCodeResp_t));\r
 \r
-                       Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
                        break;\r
                case Bluetooth_Conn_SendLinkKeyNAK:\r
                        BT_HCI_DEBUG(1, "# Send Link Key NAK");\r
 \r
                        HCICommandHeader = (BT_HCICommand_Header_t)\r
                                {\r
-                                       OpCode: {OGF: OGF_LINK_CONTROL, OCF: OCF_LINK_CONTROL_LINK_KEY_REQUEST_NEG_REPLY},\r
+                                       OpCode: (OGF_LINK_CONTROL | OCF_LINK_CONTROL_LINK_KEY_REQUEST_NEG_REPLY),\r
                                        ParameterLength: sizeof(BT_HCICommand_LinkKeyNAKResp_t),\r
                                };\r
 \r
@@ -304,7 +350,7 @@ void Bluetooth_HCITask(void)
                        /* Send the command to transmit the link key NAK to the receiver */\r
                        Bluetooth_SendHCICommand(&HCICommandHeader, &LinkKeyNAKParams, sizeof(BT_HCICommand_LinkKeyNAKResp_t));\r
 \r
-                       Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
+                       Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
                        break;\r
        }\r
 }\r