-/*\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
-/*\r
- TODO: Add local to remote device connections\r
- */\r
-\r
-#define INCLUDE_FROM_BLUETOOTHHCICOMMANDS_C\r
-#include "BluetoothHCICommands.h"\r
-\r
-/** Temporary Bluetooth Device Address, for HCI responses which much include the detination address */\r
-static uint8_t Bluetooth_TempDeviceAddress[6];\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
-void Bluetooth_HCITask(void)\r
-{\r
- BT_HCICommand_Header_t HCICommandHeader;\r
-\r
- switch (Bluetooth_State.CurrentHCIState)\r
- {\r
- case Bluetooth_ProcessEvents:\r
- Pipe_SelectPipe(BLUETOOTH_EVENTS_PIPE);\r
- Pipe_Unfreeze();\r
- \r
- if (Pipe_IsReadWriteAllowed())\r
- {\r
- BT_HCIEvent_Header_t HCIEventHeader;\r
-\r
- /* Read in the event header to fetch the event code and payload length */\r
- Pipe_Read_Stream_LE(&HCIEventHeader, sizeof(HCIEventHeader));\r
- \r
- /* Create a temporary buffer for the event parameters */\r
- uint8_t EventParams[HCIEventHeader.ParameterLength];\r
-\r
- /* Read in the event parameters into the temporary buffer */\r
- Pipe_Read_Stream_LE(&EventParams, HCIEventHeader.ParameterLength);\r
- Pipe_ClearIN();\r
- \r
- BT_HCI_DEBUG(1, "Event Received (0x%02X)", HCIEventHeader.EventCode);\r
-\r
- switch (HCIEventHeader.EventCode)\r
- {\r
- case EVENT_COMMAND_COMPLETE:\r
- BT_HCI_DEBUG(1, "<< Command Complete");\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
- BT_HCI_DEBUG(2, "-- Status Code: 0x%02X", (((BT_HCIEvent_CommandStatus_t*)&EventParams)->Status));\r
-\r
- /* If the execution of a command failed, reset the stack */\r
- if (((BT_HCIEvent_CommandStatus_t*)&EventParams)->Status)\r
- Bluetooth_State.CurrentHCIState = Bluetooth_Init;\r
- break;\r
- case EVENT_CONNECTION_REQUEST:\r
- BT_HCI_DEBUG(1, "<< Connection Request");\r
- BT_HCI_DEBUG(2, "-- Link Type: 0x%02X", (((BT_HCIEvent_ConnectionRequest_t*)&EventParams)->LinkType));\r
-\r
- /* Need to store the remote device's BT address in a temporary buffer for later use */\r
- memcpy(Bluetooth_TempDeviceAddress,\r
- &((BT_HCIEvent_ConnectionRequest_t*)&EventParams)->RemoteAddress,\r
- sizeof(Bluetooth_TempDeviceAddress));\r
- \r
- bool IsACLConnection = (((BT_HCIEvent_ConnectionRequest_t*)&EventParams)->LinkType == 0x01);\r
-\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_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_State.CurrentHCIState == Bluetooth_Conn_RejectConnection) ?\r
- PSTR("REJECTED") : PSTR("ACCEPTED"));\r
-\r
- break;\r
- case EVENT_PIN_CODE_REQUEST:\r
- BT_HCI_DEBUG(1, "<< Pin Code Request");\r
-\r
- /* Need to store the remote device's BT address in a temporary buffer for later use */\r
- memcpy(Bluetooth_TempDeviceAddress,\r
- &((BT_HCIEvent_PinCodeReq_t*)&EventParams)->RemoteAddress,\r
- sizeof(Bluetooth_TempDeviceAddress));\r
-\r
- Bluetooth_State.CurrentHCIState = Bluetooth_Conn_SendPINCode;\r
- break;\r
- case EVENT_LINK_KEY_REQUEST:\r
- BT_HCI_DEBUG(1, "<< Link Key Request");\r
- \r
- /* Need to store the remote device's BT address in a temporary buffer for later use */\r
- memcpy(Bluetooth_TempDeviceAddress,\r
- &((BT_HCIEvent_LinkKeyReq_t*)&EventParams)->RemoteAddress,\r
- sizeof(Bluetooth_TempDeviceAddress)); \r
- \r
- Bluetooth_State.CurrentHCIState = Bluetooth_Conn_SendLinkKeyNAK;\r
- break;\r
- case EVENT_CONNECTION_COMPLETE:\r
- BT_HCI_DEBUG(1, "<< Connection Complete");\r
- BT_HCI_DEBUG(2, "-- Handle: 0x%04X", ((BT_HCIEvent_ConnectionComplete_t*)&EventParams)->ConnectionHandle);\r
-\r
- /* Need to store the remote device's BT address in a temporary buffer for later use */\r
- memcpy(Bluetooth_Connection.RemoteAddress,\r
- &((BT_HCIEvent_ConnectionComplete_t*)&EventParams)->RemoteAddress,\r
- sizeof(Bluetooth_TempDeviceAddress));\r
-\r
- /* Store the created connection handle and indicate that the connection has been established */\r
- Bluetooth_Connection.ConnectionHandle = ((BT_HCIEvent_ConnectionComplete_t*)&EventParams)->ConnectionHandle;\r
- Bluetooth_Connection.IsConnected = true;\r
- \r
- Bluetooth_ConnectionComplete(); \r
- break;\r
- case EVENT_DISCONNECTION_COMPLETE:\r
- BT_HCI_DEBUG(1, "<< Disconnection Complete");\r
-\r
- /* Device disconnected, indicate connection information no longer valid */\r
- Bluetooth_Connection.IsConnected = false;\r
- \r
- Bluetooth_DisconnectionComplete();\r
- \r
- Bluetooth_State.CurrentHCIState = Bluetooth_Init;\r
- break;\r
- }\r
- }\r
- \r
- Pipe_Freeze();\r
- \r
- break;\r
- 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_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_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_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_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_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_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_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_CTRLR_BASEBAND | OCF_CTRLR_BASEBAND_WRITE_SCAN_ENABLE),\r
- ParameterLength: 1,\r
- };\r
-\r
- uint8_t Interval = BT_SCANMODE_InquiryAndPageScans;\r
- \r
- /* Send the command to set the remote device scanning mode */\r
- Bluetooth_SendHCICommand(&HCICommandHeader, &Interval, 1);\r
- \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_LINK_CONTROL | OCF_LINK_CONTROL_ACCEPT_CONNECTION_REQUEST),\r
- ParameterLength: sizeof(BT_HCICommand_AcceptConnectionReq_t),\r
- };\r
-\r
- /* Copy over the temporary BT device address saved from the Connection Request event, indicate slave\r
- connection role */\r
- BT_HCICommand_AcceptConnectionReq_t AcceptConnectionParams;\r
- memcpy(AcceptConnectionParams.RemoteAddress, Bluetooth_TempDeviceAddress,\r
- sizeof(AcceptConnectionParams.RemoteAddress));\r
- AcceptConnectionParams.SlaveRole = true;\r
-\r
- /* Send the command to accept the remote connection request */\r
- Bluetooth_SendHCICommand(&HCICommandHeader, &AcceptConnectionParams, sizeof(BT_HCICommand_AcceptConnectionReq_t));\r
- \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_LINK_CONTROL | OCF_LINK_CONTROL_REJECT_CONNECTION_REQUEST),\r
- ParameterLength: sizeof(BT_HCICommand_RejectConnectionReq_t),\r
- };\r
-\r
- /* Copy over the temporary BT device address saved from the Connection Request event, indicate failure\r
- to accept the connection due to limited device resources or incorrect device address */\r
- BT_HCICommand_RejectConnectionReq_t RejectConnectionParams;\r
- memcpy(RejectConnectionParams.RemoteAddress, Bluetooth_TempDeviceAddress, sizeof(RejectConnectionParams.RemoteAddress));\r
- RejectConnectionParams.Reason = Bluetooth_Connection.IsConnected ? ERROR_LIMITED_RESOURCES : ERROR_UNACCEPTABLE_BDADDR;\r
-\r
- /* Send the command to reject the remote connection request */\r
- Bluetooth_SendHCICommand(&HCICommandHeader, &RejectConnectionParams, sizeof(BT_HCICommand_RejectConnectionReq_t));\r
- \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_LINK_CONTROL | OCF_LINK_CONTROL_PIN_CODE_REQUEST_REPLY),\r
- ParameterLength: sizeof(BT_HCICommand_PinCodeResp_t),\r
- };\r
-\r
- /* Copy over the temporary BT device address saved from the PIN Code Request event, copy over the\r
- local PIN authentication code to the response */\r
- BT_HCICommand_PinCodeResp_t PINCodeRequestParams;\r
- memcpy(PINCodeRequestParams.RemoteAddress, Bluetooth_TempDeviceAddress, sizeof(PINCodeRequestParams.RemoteAddress));\r
- PINCodeRequestParams.PINCodeLength = strlen(Bluetooth_DeviceConfiguration.PINCode);\r
- memcpy(PINCodeRequestParams.PINCode, Bluetooth_DeviceConfiguration.PINCode, sizeof(PINCodeRequestParams.PINCode));\r
- \r
- /* 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_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_LINK_CONTROL | OCF_LINK_CONTROL_LINK_KEY_REQUEST_NEG_REPLY),\r
- ParameterLength: sizeof(BT_HCICommand_LinkKeyNAKResp_t),\r
- };\r
-\r
- /* Copy over the temporary BT device address saved from the Link Key Request event */\r
- BT_HCICommand_LinkKeyNAKResp_t LinkKeyNAKParams;\r
- memcpy(LinkKeyNAKParams.RemoteAddress, Bluetooth_TempDeviceAddress, sizeof(LinkKeyNAKParams.RemoteAddress));\r
-\r
- /* 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_State.CurrentHCIState = Bluetooth_ProcessEvents;\r
- break;\r
- }\r
-}\r
-\r
-/** Sends a Bluetooth HCI control command to the attached Bluetooth device.\r
- *\r
- * \param[in] HCICommandHeader HCI command header to send to the attached device\r
- * \param[in] Parameters Pointer to the source of the control parameters (if any)\r
- * \param[in] ParameterLength Length of the parameters to send in bytes\r
- *\r
- * \return A value from the USB_Host_SendControlErrorCodes_t enum.\r
- */\r
-static uint8_t Bluetooth_SendHCICommand(const BT_HCICommand_Header_t* const HCICommandHeader, const void* Parameters, const uint16_t ParameterLength)\r
-{\r
- /* Need to reserve the amount of bytes given in the header for the complete payload */\r
- uint8_t CommandBuffer[sizeof(BT_HCICommand_Header_t) + HCICommandHeader->ParameterLength];\r
-\r
- USB_ControlRequest = (USB_Request_Header_t)\r
- {\r
- .bmRequestType = (REQDIR_HOSTTODEVICE | REQTYPE_CLASS | REQREC_DEVICE),\r
- .bRequest = 0,\r
- .wValue = 0,\r
- .wIndex = 0,\r
- .wLength = sizeof(CommandBuffer)\r
- };\r
-\r
- /* Copy over the HCI command header to the allocated buffer */\r
- memcpy(CommandBuffer, HCICommandHeader, sizeof(BT_HCICommand_Header_t));\r
- \r
- /* Zero out the parameter section of the response so that all padding bytes are known to be zero */\r
- memset(&CommandBuffer[sizeof(BT_HCICommand_Header_t)], 0x00, HCICommandHeader->ParameterLength);\r
-\r
- /* Copy over the command parameters (if any) to the command buffer - note, the number of actual source parameter bytes\r
- may differ to those in the header; any difference in length is filled with 0x00 padding bytes */\r
- memcpy(&CommandBuffer[sizeof(BT_HCICommand_Header_t)], Parameters, ParameterLength);\r
- \r
- Pipe_SelectPipe(PIPE_CONTROLPIPE);\r
- return USB_Host_SendControlRequest(CommandBuffer);\r
-}\r
+/*
+ LUFA Library
+ Copyright (C) Dean Camera, 2010.
+
+ dean [at] fourwalledcubicle [dot] com
+ www.fourwalledcubicle.com
+*/
+
+/*
+ Copyright 2010 Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+ Permission to use, copy, modify, distribute, and sell this
+ software and its documentation for any purpose is hereby granted
+ without fee, provided that the above copyright notice appear in
+ all copies and that both that the copyright notice and this
+ permission notice and warranty disclaimer appear in supporting
+ documentation, and that the name of the author not be used in
+ advertising or publicity pertaining to distribution of the
+ software without specific, written prior permission.
+
+ The author disclaim all warranties with regard to this
+ software, including all implied warranties of merchantability
+ and fitness. In no event shall the author be liable for any
+ special, indirect or consequential damages or any damages
+ whatsoever resulting from loss of use, data or profits, whether
+ in an action of contract, negligence or other tortious action,
+ arising out of or in connection with the use or performance of
+ this software.
+*/
+
+/*
+ TODO: Add local to remote device connections
+ */
+
+#define INCLUDE_FROM_BLUETOOTHHCICOMMANDS_C
+#include "BluetoothHCICommands.h"
+
+/** Temporary Bluetooth Device Address, for HCI responses which much include the detination address */
+static uint8_t Bluetooth_TempDeviceAddress[6];
+
+/** Bluetooth HCI processing task. This task should be called repeatedly the main Bluetooth
+ * stack task to manage the HCI processing state.
+ */
+void Bluetooth_HCITask(void)
+{
+ BT_HCICommand_Header_t HCICommandHeader;
+
+ switch (Bluetooth_State.CurrentHCIState)
+ {
+ case Bluetooth_ProcessEvents:
+ Pipe_SelectPipe(BLUETOOTH_EVENTS_PIPE);
+ Pipe_Unfreeze();
+
+ if (Pipe_IsReadWriteAllowed())
+ {
+ BT_HCIEvent_Header_t HCIEventHeader;
+
+ /* Read in the event header to fetch the event code and payload length */
+ Pipe_Read_Stream_LE(&HCIEventHeader, sizeof(HCIEventHeader));
+
+ /* Create a temporary buffer for the event parameters */
+ uint8_t EventParams[HCIEventHeader.ParameterLength];
+
+ /* Read in the event parameters into the temporary buffer */
+ Pipe_Read_Stream_LE(&EventParams, HCIEventHeader.ParameterLength);
+ Pipe_ClearIN();
+
+ BT_HCI_DEBUG(1, "Event Received (0x%02X)", HCIEventHeader.EventCode);
+
+ switch (HCIEventHeader.EventCode)
+ {
+ case EVENT_COMMAND_COMPLETE:
+ BT_HCI_DEBUG(1, "<< Command Complete");
+
+ /* Check which operation was completed in case we need to process the even parameters */
+ switch (((BT_HCIEvent_CommandComplete_t*)&EventParams)->Opcode)
+ {
+ case (OGF_CTRLR_INFORMATIONAL | OCF_CTRLR_INFORMATIONAL_READBDADDR):
+ /* A READ BDADDR command completed, copy over the local device's BDADDR from the response */
+ memcpy(Bluetooth_State.LocalBDADDR,
+ &((BT_HCIEvent_CommandComplete_t*)&EventParams)->ReturnParams[1],
+ sizeof(Bluetooth_State.LocalBDADDR));
+ break;
+ }
+
+ Bluetooth_State.CurrentHCIState = Bluetooth_State.NextHCIState;
+ break;
+ case EVENT_COMMAND_STATUS:
+ BT_HCI_DEBUG(1, "<< Command Status");
+ BT_HCI_DEBUG(2, "-- Status Code: 0x%02X", (((BT_HCIEvent_CommandStatus_t*)&EventParams)->Status));
+
+ /* If the execution of a command failed, reset the stack */
+ if (((BT_HCIEvent_CommandStatus_t*)&EventParams)->Status)
+ Bluetooth_State.CurrentHCIState = Bluetooth_Init;
+ break;
+ case EVENT_CONNECTION_REQUEST:
+ BT_HCI_DEBUG(1, "<< Connection Request");
+ BT_HCI_DEBUG(2, "-- Link Type: 0x%02X", (((BT_HCIEvent_ConnectionRequest_t*)&EventParams)->LinkType));
+
+ /* Need to store the remote device's BT address in a temporary buffer for later use */
+ memcpy(Bluetooth_TempDeviceAddress,
+ &((BT_HCIEvent_ConnectionRequest_t*)&EventParams)->RemoteAddress,
+ sizeof(Bluetooth_TempDeviceAddress));
+
+ bool IsACLConnection = (((BT_HCIEvent_ConnectionRequest_t*)&EventParams)->LinkType == 0x01);
+
+ /* Only accept the connection if it is a ACL (data) connection, a device is not already connected
+ and the user application has indicated that the connection should be allowed */
+ Bluetooth_State.CurrentHCIState = (Bluetooth_Connection.IsConnected || !(IsACLConnection) ||
+ !(Bluetooth_ConnectionRequest(Bluetooth_TempDeviceAddress))) ?
+ Bluetooth_Conn_RejectConnection : Bluetooth_Conn_AcceptConnection;
+
+ BT_HCI_DEBUG(2, "-- Connection %S", (Bluetooth_State.CurrentHCIState == Bluetooth_Conn_RejectConnection) ?
+ PSTR("REJECTED") : PSTR("ACCEPTED"));
+
+ break;
+ case EVENT_PIN_CODE_REQUEST:
+ BT_HCI_DEBUG(1, "<< Pin Code Request");
+
+ /* Need to store the remote device's BT address in a temporary buffer for later use */
+ memcpy(Bluetooth_TempDeviceAddress,
+ &((BT_HCIEvent_PinCodeReq_t*)&EventParams)->RemoteAddress,
+ sizeof(Bluetooth_TempDeviceAddress));
+
+ Bluetooth_State.CurrentHCIState = Bluetooth_Conn_SendPINCode;
+ break;
+ case EVENT_LINK_KEY_REQUEST:
+ BT_HCI_DEBUG(1, "<< Link Key Request");
+
+ /* Need to store the remote device's BT address in a temporary buffer for later use */
+ memcpy(Bluetooth_TempDeviceAddress,
+ &((BT_HCIEvent_LinkKeyReq_t*)&EventParams)->RemoteAddress,
+ sizeof(Bluetooth_TempDeviceAddress));
+
+ Bluetooth_State.CurrentHCIState = Bluetooth_Conn_SendLinkKeyNAK;
+ break;
+ case EVENT_CONNECTION_COMPLETE:
+ BT_HCI_DEBUG(1, "<< Connection Complete");
+ BT_HCI_DEBUG(2, "-- Handle: 0x%04X", ((BT_HCIEvent_ConnectionComplete_t*)&EventParams)->ConnectionHandle);
+
+ /* Need to store the remote device's BT address in a temporary buffer for later use */
+ memcpy(Bluetooth_Connection.RemoteAddress,
+ &((BT_HCIEvent_ConnectionComplete_t*)&EventParams)->RemoteAddress,
+ sizeof(Bluetooth_TempDeviceAddress));
+
+ /* Store the created connection handle and indicate that the connection has been established */
+ Bluetooth_Connection.ConnectionHandle = ((BT_HCIEvent_ConnectionComplete_t*)&EventParams)->ConnectionHandle;
+ Bluetooth_Connection.IsConnected = true;
+
+ Bluetooth_ConnectionComplete();
+ break;
+ case EVENT_DISCONNECTION_COMPLETE:
+ BT_HCI_DEBUG(1, "<< Disconnection Complete");
+
+ /* Device disconnected, indicate connection information no longer valid */
+ Bluetooth_Connection.IsConnected = false;
+
+ Bluetooth_DisconnectionComplete();
+
+ Bluetooth_State.CurrentHCIState = Bluetooth_Init;
+ break;
+ }
+ }
+
+ Pipe_Freeze();
+
+ break;
+ case Bluetooth_Init:
+ BT_HCI_DEBUG(1, "# Init");
+
+ Bluetooth_State.IsInitialized = false;
+
+ /* Reset the connection information structure to destroy any previous connection state */
+ memset(&Bluetooth_Connection, 0x00, sizeof(Bluetooth_Connection));
+
+ Bluetooth_State.CurrentHCIState = Bluetooth_Init_Reset;
+ break;
+ case Bluetooth_Init_Reset:
+ BT_HCI_DEBUG(1, "# Reset");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_CTRLR_BASEBAND | OCF_CTRLR_BASEBAND_RESET),
+ ParameterLength: 0,
+ };
+
+ /* Send the command to reset the bluetooth dongle controller */
+ Bluetooth_SendHCICommand(&HCICommandHeader, NULL, 0);
+
+ Bluetooth_State.NextHCIState = Bluetooth_Init_ReadBufferSize;
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Init_ReadBufferSize:
+ BT_HCI_DEBUG(1, "# Read Buffer Size");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_CTRLR_INFORMATIONAL | OCF_CTRLR_INFORMATIONAL_READBUFFERSIZE),
+ ParameterLength: 0,
+ };
+
+ /* Send the command to read the bluetooth buffer size (mandatory before device sends any data) */
+ Bluetooth_SendHCICommand(&HCICommandHeader, NULL, 0);
+
+ Bluetooth_State.NextHCIState = Bluetooth_Init_GetBDADDR;
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Init_GetBDADDR:
+ BT_HCI_DEBUG(1, "# Get BDADDR");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_CTRLR_INFORMATIONAL | OCF_CTRLR_INFORMATIONAL_READBDADDR),
+ ParameterLength: 0,
+ };
+
+ /* Send the command to retrieve the BDADDR of the inserted bluetooth dongle */
+ Bluetooth_SendHCICommand(&HCICommandHeader, NULL, 0);
+
+ Bluetooth_State.NextHCIState = Bluetooth_Init_SetLocalName;
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Init_SetLocalName:
+ BT_HCI_DEBUG(1, "# Set Local Name");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_CTRLR_BASEBAND | OCF_CTRLR_BASEBAND_WRITE_LOCAL_NAME),
+ ParameterLength: 248,
+ };
+
+ /* Send the command to set the bluetooth dongle's name for other devices to see */
+ Bluetooth_SendHCICommand(&HCICommandHeader, Bluetooth_DeviceConfiguration.Name, strlen(Bluetooth_DeviceConfiguration.Name));
+
+ Bluetooth_State.NextHCIState = Bluetooth_Init_SetDeviceClass;
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Init_SetDeviceClass:
+ BT_HCI_DEBUG(1, "# Set Device Class");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_CTRLR_BASEBAND | OCF_CTRLR_BASEBAND_WRITE_CLASS_OF_DEVICE),
+ ParameterLength: 3,
+ };
+
+ /* Send the command to set the class of the device for other devices to see */
+ Bluetooth_SendHCICommand(&HCICommandHeader, &Bluetooth_DeviceConfiguration.Class, 3);
+
+ Bluetooth_State.NextHCIState = Bluetooth_Init_WriteScanEnable;
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Init_WriteScanEnable:
+ BT_HCI_DEBUG(1, "# Write Scan Enable");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_CTRLR_BASEBAND | OCF_CTRLR_BASEBAND_WRITE_SCAN_ENABLE),
+ ParameterLength: 1,
+ };
+
+ uint8_t Interval = BT_SCANMODE_InquiryAndPageScans;
+
+ /* Send the command to set the remote device scanning mode */
+ Bluetooth_SendHCICommand(&HCICommandHeader, &Interval, 1);
+
+ Bluetooth_State.NextHCIState = Bluetooth_Init_FinalizeInit;
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Init_FinalizeInit:
+ Bluetooth_State.IsInitialized = true;
+
+ /* Fire the user application callback to indicate that the stack is now fully initialized */
+ Bluetooth_StackInitialized();
+
+ Bluetooth_State.NextHCIState = Bluetooth_ProcessEvents;
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Conn_AcceptConnection:
+ BT_HCI_DEBUG(1, "# Accept Connection");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_LINK_CONTROL | OCF_LINK_CONTROL_ACCEPT_CONNECTION_REQUEST),
+ ParameterLength: sizeof(BT_HCICommand_AcceptConnectionReq_t),
+ };
+
+ /* Copy over the temporary BT device address saved from the Connection Request event, indicate slave
+ connection role */
+ BT_HCICommand_AcceptConnectionReq_t AcceptConnectionParams;
+ memcpy(AcceptConnectionParams.RemoteAddress, Bluetooth_TempDeviceAddress,
+ sizeof(AcceptConnectionParams.RemoteAddress));
+ AcceptConnectionParams.SlaveRole = true;
+
+ /* Send the command to accept the remote connection request */
+ Bluetooth_SendHCICommand(&HCICommandHeader, &AcceptConnectionParams, sizeof(BT_HCICommand_AcceptConnectionReq_t));
+
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Conn_RejectConnection:
+ BT_HCI_DEBUG(1, "# Reject Connection");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_LINK_CONTROL | OCF_LINK_CONTROL_REJECT_CONNECTION_REQUEST),
+ ParameterLength: sizeof(BT_HCICommand_RejectConnectionReq_t),
+ };
+
+ /* Copy over the temporary BT device address saved from the Connection Request event, indicate failure
+ to accept the connection due to limited device resources or incorrect device address */
+ BT_HCICommand_RejectConnectionReq_t RejectConnectionParams;
+ memcpy(RejectConnectionParams.RemoteAddress, Bluetooth_TempDeviceAddress, sizeof(RejectConnectionParams.RemoteAddress));
+ RejectConnectionParams.Reason = Bluetooth_Connection.IsConnected ? ERROR_LIMITED_RESOURCES : ERROR_UNACCEPTABLE_BDADDR;
+
+ /* Send the command to reject the remote connection request */
+ Bluetooth_SendHCICommand(&HCICommandHeader, &RejectConnectionParams, sizeof(BT_HCICommand_RejectConnectionReq_t));
+
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Conn_SendPINCode:
+ BT_HCI_DEBUG(1, "# Send Pin Code");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_LINK_CONTROL | OCF_LINK_CONTROL_PIN_CODE_REQUEST_REPLY),
+ ParameterLength: sizeof(BT_HCICommand_PinCodeResp_t),
+ };
+
+ /* Copy over the temporary BT device address saved from the PIN Code Request event, copy over the
+ local PIN authentication code to the response */
+ BT_HCICommand_PinCodeResp_t PINCodeRequestParams;
+ memcpy(PINCodeRequestParams.RemoteAddress, Bluetooth_TempDeviceAddress, sizeof(PINCodeRequestParams.RemoteAddress));
+ PINCodeRequestParams.PINCodeLength = strlen(Bluetooth_DeviceConfiguration.PINCode);
+ memcpy(PINCodeRequestParams.PINCode, Bluetooth_DeviceConfiguration.PINCode, sizeof(PINCodeRequestParams.PINCode));
+
+ /* Send the command to transmit the device's local PIN number for authentication */
+ Bluetooth_SendHCICommand(&HCICommandHeader, &PINCodeRequestParams, sizeof(BT_HCICommand_PinCodeResp_t));
+
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ case Bluetooth_Conn_SendLinkKeyNAK:
+ BT_HCI_DEBUG(1, "# Send Link Key NAK");
+
+ HCICommandHeader = (BT_HCICommand_Header_t)
+ {
+ OpCode: (OGF_LINK_CONTROL | OCF_LINK_CONTROL_LINK_KEY_REQUEST_NEG_REPLY),
+ ParameterLength: sizeof(BT_HCICommand_LinkKeyNAKResp_t),
+ };
+
+ /* Copy over the temporary BT device address saved from the Link Key Request event */
+ BT_HCICommand_LinkKeyNAKResp_t LinkKeyNAKParams;
+ memcpy(LinkKeyNAKParams.RemoteAddress, Bluetooth_TempDeviceAddress, sizeof(LinkKeyNAKParams.RemoteAddress));
+
+ /* Send the command to transmit the link key NAK to the receiver */
+ Bluetooth_SendHCICommand(&HCICommandHeader, &LinkKeyNAKParams, sizeof(BT_HCICommand_LinkKeyNAKResp_t));
+
+ Bluetooth_State.CurrentHCIState = Bluetooth_ProcessEvents;
+ break;
+ }
+}
+
+/** Sends a Bluetooth HCI control command to the attached Bluetooth device.
+ *
+ * \param[in] HCICommandHeader HCI command header to send to the attached device
+ * \param[in] Parameters Pointer to the source of the control parameters (if any)
+ * \param[in] ParameterLength Length of the parameters to send in bytes
+ *
+ * \return A value from the USB_Host_SendControlErrorCodes_t enum.
+ */
+static uint8_t Bluetooth_SendHCICommand(const BT_HCICommand_Header_t* const HCICommandHeader, const void* Parameters, const uint16_t ParameterLength)
+{
+ /* Need to reserve the amount of bytes given in the header for the complete payload */
+ uint8_t CommandBuffer[sizeof(BT_HCICommand_Header_t) + HCICommandHeader->ParameterLength];
+
+ USB_ControlRequest = (USB_Request_Header_t)
+ {
+ .bmRequestType = (REQDIR_HOSTTODEVICE | REQTYPE_CLASS | REQREC_DEVICE),
+ .bRequest = 0,
+ .wValue = 0,
+ .wIndex = 0,
+ .wLength = sizeof(CommandBuffer)
+ };
+
+ /* Copy over the HCI command header to the allocated buffer */
+ memcpy(CommandBuffer, HCICommandHeader, sizeof(BT_HCICommand_Header_t));
+
+ /* Zero out the parameter section of the response so that all padding bytes are known to be zero */
+ memset(&CommandBuffer[sizeof(BT_HCICommand_Header_t)], 0x00, HCICommandHeader->ParameterLength);
+
+ /* Copy over the command parameters (if any) to the command buffer - note, the number of actual source parameter bytes
+ may differ to those in the header; any difference in length is filled with 0x00 padding bytes */
+ memcpy(&CommandBuffer[sizeof(BT_HCICommand_Header_t)], Parameters, ParameterLength);
+
+ Pipe_SelectPipe(PIPE_CONTROLPIPE);
+ return USB_Host_SendControlRequest(CommandBuffer);
+}
projects / pub / USBasp.git / blobdiff