static Bluetooth_HCIEvent_Header_t HCIEventHeader;\r
\r
uint8_t Bluetooth_HCIProcessingState;\r
+ uint8_t Bluetooth_HCINextState;\r
static uint8_t Bluetooth_TempDeviceAddress[6];\r
\r
static uint8_t Bluetooth_SendHCICommand(void* Parameters, uint8_t ParamLength)\r
memcpy(&CommandBuffer[sizeof(HCICommandHeader)], Parameters, ParamLength);\r
\r
Pipe_SelectPipe(PIPE_CONTROLPIPE);\r
-\r
return USB_Host_SendControlRequest(CommandBuffer);\r
}\r
\r
-static bool Bluetooth_GetNextHCIEventHeader(void)\r
-{\r
- Pipe_SelectPipe(BLUETOOTH_EVENTS_PIPE);\r
- Pipe_Unfreeze();\r
- \r
- if (!(Pipe_IsReadWriteAllowed()))\r
- {\r
- Pipe_Freeze();\r
- return false;\r
- }\r
- \r
- Pipe_Read_Stream_LE(&HCIEventHeader, sizeof(HCIEventHeader));\r
- Pipe_Freeze();\r
-\r
- return true;\r
-}\r
-\r
-static void Bluetooth_DiscardRemainingHCIEventParameters(void)\r
-{\r
- Pipe_SelectPipe(BLUETOOTH_EVENTS_PIPE);\r
- Pipe_Unfreeze();\r
-\r
- Pipe_Discard_Stream(HCIEventHeader.ParameterLength);\r
- Pipe_ClearIN();\r
-\r
- Pipe_Freeze();\r
- \r
- HCIEventHeader.ParameterLength = 0;\r
-}\r
-\r
void Bluetooth_ProcessHCICommands(void)\r
{\r
uint8_t ErrorCode;\r
\r
switch (Bluetooth_HCIProcessingState)\r
{\r
- case Bluetooth_Init:\r
+ case Bluetooth_ProcessEvents:\r
Pipe_SelectPipe(BLUETOOTH_EVENTS_PIPE);\r
+ Pipe_Unfreeze();\r
+ \r
+ if (Pipe_IsReadWriteAllowed())\r
+ {\r
+ Pipe_Read_Stream_LE(&HCIEventHeader, sizeof(HCIEventHeader));\r
+ \r
+ uint8_t EventParams[HCIEventHeader.ParameterLength];\r
+\r
+ Pipe_Read_Stream_LE(&EventParams, HCIEventHeader.ParameterLength);\r
+ Pipe_ClearIN();\r
+\r
+ BT_DEBUG("(HCI) Event Code: 0x%02X", HCIEventHeader.EventCode);\r
+ \r
+ switch (HCIEventHeader.EventCode)\r
+ {\r
+ case EVENT_COMMAND_COMPLETE:\r
+ Bluetooth_HCIProcessingState = Bluetooth_HCINextState;\r
+\r
+ BT_DEBUG("(HCI) >> Command Complete (Opcode 0x%04x)", \r
+ ((Bluetooth_HCIEvent_CommandComplete_t*)&EventParams)->Opcode);\r
+ break;\r
+ case EVENT_COMMAND_STATUS:\r
+ if (((Bluetooth_HCIEvent_CommandStatus_t*)&EventParams)->Status)\r
+ Bluetooth_HCIProcessingState = Bluetooth_Init;\r
+\r
+ BT_DEBUG("(HCI) >> Command Status: 0x%02X",\r
+ ((Bluetooth_HCIEvent_CommandStatus_t*)&EventParams)->Status); \r
+ break;\r
+ case EVENT_CONNECTION_REQUEST:\r
+ memcpy(Bluetooth_TempDeviceAddress,\r
+ &((Bluetooth_HCIEvent_ConnectionRequest_t*)&EventParams)->RemoteAddress,\r
+ sizeof(Bluetooth_TempDeviceAddress));\r
+ \r
+ Bluetooth_HCIProcessingState = (Bluetooth_Connection.IsConnected ||\r
+ (((Bluetooth_HCIEvent_ConnectionRequest_t*)&EventParams)->LinkType != 0x01)) ?\r
+ Bluetooth_Conn_RejectConnection : Bluetooth_Conn_AcceptConnection;\r
+\r
+ BT_DEBUG("(HCI) >> Connection Request from Device %02X:%02X:%02X:%02X:%02X:%02X",\r
+ Bluetooth_TempDeviceAddress[5], Bluetooth_TempDeviceAddress[4], Bluetooth_TempDeviceAddress[3],\r
+ Bluetooth_TempDeviceAddress[2], Bluetooth_TempDeviceAddress[1], Bluetooth_TempDeviceAddress[0]);\r
+ break;\r
+ case EVENT_PIN_CODE_REQUEST:\r
+ memcpy(Bluetooth_TempDeviceAddress,\r
+ &((Bluetooth_HCIEvent_PinCodeRequest_t*)&EventParams)->RemoteAddress,\r
+ sizeof(Bluetooth_TempDeviceAddress));\r
+\r
+ Bluetooth_HCIProcessingState = Bluetooth_Conn_SendPINCode;\r
+\r
+ BT_DEBUG("(HCI) >> PIN Request from Device %02X:%02X:%02X:%02X:%02X:%02X", \r
+ Bluetooth_TempDeviceAddress[5], Bluetooth_TempDeviceAddress[4], Bluetooth_TempDeviceAddress[3],\r
+ Bluetooth_TempDeviceAddress[2], Bluetooth_TempDeviceAddress[1], Bluetooth_TempDeviceAddress[0]);\r
+ break;\r
+ case EVENT_CONNECTION_COMPLETE:\r
+ memcpy(Bluetooth_Connection.RemoteAddress,\r
+ &((Bluetooth_HCIEvent_ConnectionComplete_t*)&EventParams)->RemoteAddress,\r
+ sizeof(Bluetooth_TempDeviceAddress));\r
+\r
+ Bluetooth_Connection.ConnectionHandle = ((Bluetooth_HCIEvent_ConnectionComplete_t*)&EventParams)->ConnectionHandle;\r
+ Bluetooth_Connection.IsConnected = true;\r
+\r
+ BT_DEBUG("(HCI) >> Connection Complete to Device %02X:%02X:%02X:%02X:%02X:%02X, Handle 0x%04x", \r
+ Bluetooth_Connection.RemoteAddress[5], Bluetooth_Connection.RemoteAddress[4],\r
+ Bluetooth_Connection.RemoteAddress[3], Bluetooth_Connection.RemoteAddress[2],\r
+ Bluetooth_Connection.RemoteAddress[1], Bluetooth_Connection.RemoteAddress[0],\r
+ Bluetooth_Connection.ConnectionHandle);\r
+ break;\r
+ }\r
+ }\r
+ \r
+ Pipe_Freeze();\r
\r
+ break;\r
+ case Bluetooth_Init:\r
memset(&Bluetooth_Connection, 0x00, sizeof(Bluetooth_Connection));\r
- \r
+\r
Bluetooth_HCIProcessingState = Bluetooth_Init_Reset; \r
break;\r
case Bluetooth_Init_Reset:\r
BT_DEBUG("(HCI) Enter State: Bluetooth_Init_Reset", NULL);\r
\r
ErrorCode = Bluetooth_SendHCICommand(NULL, 0);\r
-\r
- do\r
- {\r
- while (!(Bluetooth_GetNextHCIEventHeader()))\r
- {\r
- if (USB_HostState == HOST_STATE_Unattached)\r
- return;\r
- }\r
- \r
- Bluetooth_DiscardRemainingHCIEventParameters();\r
- } while (HCIEventHeader.EventCode != EVENT_COMMAND_COMPLETE);\r
-\r
- Bluetooth_HCIProcessingState = Bluetooth_Init_ReadBufferSize;\r
+ \r
+ Bluetooth_HCINextState = Bluetooth_Init_ReadBufferSize;\r
+ Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
break;\r
case Bluetooth_Init_ReadBufferSize:\r
HCICommandHeader = (Bluetooth_HCICommand_Header_t)\r
\r
ErrorCode = Bluetooth_SendHCICommand(NULL, 0);\r
\r
- do\r
- {\r
- while (!(Bluetooth_GetNextHCIEventHeader()))\r
- {\r
- if (USB_HostState == HOST_STATE_Unattached)\r
- return;\r
- }\r
-\r
- Bluetooth_DiscardRemainingHCIEventParameters();\r
- } while (HCIEventHeader.EventCode != EVENT_COMMAND_COMPLETE);\r
-\r
- Bluetooth_HCIProcessingState = Bluetooth_Init_SetEventMask; \r
- break;\r
- case Bluetooth_Init_SetEventMask:\r
- HCICommandHeader = (Bluetooth_HCICommand_Header_t)\r
- {\r
- OpCode: {OGF: OGF_CTRLR_BASEBAND, OCF: OCF_CTRLR_BASEBAND_SET_EVENT_MASK},\r
- ParameterLength: 8,\r
- };\r
- \r
- BT_DEBUG("(HCI) Enter State: Bluetooth_Init_SetEventMask", NULL);\r
- \r
- uint8_t EventMask[8] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};\r
- ErrorCode = Bluetooth_SendHCICommand(&EventMask, 8);\r
-\r
- BT_DEBUG("(HCI) -- Event mask: 0x%02X%02X%02X%02X%02X%02X%02X%02X", EventMask[7], EventMask[6], EventMask[5], EventMask[4],\r
- EventMask[3], EventMask[2], EventMask[1], EventMask[0]);\r
- do\r
- {\r
- while (!(Bluetooth_GetNextHCIEventHeader()))\r
- {\r
- if (USB_HostState == HOST_STATE_Unattached)\r
- return;\r
- }\r
-\r
- Bluetooth_DiscardRemainingHCIEventParameters();\r
- } while (HCIEventHeader.EventCode != EVENT_COMMAND_COMPLETE);\r
- \r
-\r
- Bluetooth_HCIProcessingState = Bluetooth_Init_SetLocalName; \r
+ Bluetooth_HCINextState = Bluetooth_Init_SetLocalName;\r
+ Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
break;\r
case Bluetooth_Init_SetLocalName:\r
HCICommandHeader = (Bluetooth_HCICommand_Header_t)\r
BT_DEBUG("(HCI) -- Name: %s", Bluetooth_DeviceConfiguration.Name);\r
\r
ErrorCode = Bluetooth_SendHCICommand(Bluetooth_DeviceConfiguration.Name, strlen(Bluetooth_DeviceConfiguration.Name));\r
- \r
- do\r
- {\r
- while (!(Bluetooth_GetNextHCIEventHeader()))\r
- {\r
- if (USB_HostState == HOST_STATE_Unattached)\r
- return;\r
- }\r
\r
- Bluetooth_DiscardRemainingHCIEventParameters();\r
- } while (HCIEventHeader.EventCode != EVENT_COMMAND_COMPLETE);\r
- \r
- Bluetooth_HCIProcessingState = Bluetooth_Init_SetDeviceClass;\r
+ Bluetooth_HCINextState = Bluetooth_Init_SetDeviceClass;\r
+ Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
break;\r
case Bluetooth_Init_SetDeviceClass:\r
HCICommandHeader = (Bluetooth_HCICommand_Header_t)\r
\r
ErrorCode = Bluetooth_SendHCICommand(&Bluetooth_DeviceConfiguration.Class, 3);\r
\r
- do\r
- {\r
- while (!(Bluetooth_GetNextHCIEventHeader()))\r
- {\r
- if (USB_HostState == HOST_STATE_Unattached)\r
- return;\r
- }\r
-\r
- Bluetooth_DiscardRemainingHCIEventParameters();\r
- } while (HCIEventHeader.EventCode != EVENT_COMMAND_COMPLETE);\r
-\r
- Bluetooth_HCIProcessingState = Bluetooth_Init_WriteScanEnable; \r
+ Bluetooth_HCINextState = Bluetooth_Init_WriteScanEnable;\r
+ Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
break;\r
case Bluetooth_Init_WriteScanEnable:\r
HCICommandHeader = (Bluetooth_HCICommand_Header_t)\r
\r
uint8_t Interval = InquiryAndPageScans;\r
ErrorCode = Bluetooth_SendHCICommand(&Interval, 1);\r
-\r
- do\r
- {\r
- while (!(Bluetooth_GetNextHCIEventHeader()))\r
- {\r
- if (USB_HostState == HOST_STATE_Unattached)\r
- return;\r
- }\r
-\r
- Bluetooth_DiscardRemainingHCIEventParameters();\r
- } while (HCIEventHeader.EventCode != EVENT_COMMAND_COMPLETE);\r
-\r
- Bluetooth_HCIProcessingState = Bluetooth_PrepareToProcessEvents;\r
- break;\r
- case Bluetooth_PrepareToProcessEvents:\r
- BT_DEBUG("(HCI) Enter State: Bluetooth_ProcessEvents", NULL);\r
-\r
- Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
- break;\r
- case Bluetooth_ProcessEvents:\r
- if (Bluetooth_GetNextHCIEventHeader())\r
- {\r
- BT_DEBUG("(HCI) Event Code: 0x%02X", HCIEventHeader.EventCode);\r
\r
- if (HCIEventHeader.EventCode == EVENT_COMMAND_STATUS)\r
- {\r
- Bluetooth_HCIEvent_CommandStatus_Header_t CommandStatusHeader;\r
-\r
- Pipe_Read_Stream_LE(&CommandStatusHeader, sizeof(CommandStatusHeader));\r
- HCIEventHeader.ParameterLength -= sizeof(CommandStatusHeader);\r
- \r
- BT_DEBUG("(HCI) >> Command status: 0x%02X", CommandStatusHeader.CommandStatus);\r
- \r
- if (CommandStatusHeader.CommandStatus)\r
- Bluetooth_HCIProcessingState = Bluetooth_Init;\r
- }\r
- else if (HCIEventHeader.EventCode == EVENT_CONNECTION_REQUEST)\r
- {\r
- Bluetooth_HCIEvent_ConnectionRequest_Header_t ConnectionRequestParams;\r
- \r
- Pipe_Read_Stream_LE(&ConnectionRequestParams, sizeof(ConnectionRequestParams));\r
- HCIEventHeader.ParameterLength -= sizeof(ConnectionRequestParams);\r
-\r
- BT_DEBUG("(HCI) >> Connection Request from device %02X:%02X:%02X:%02X:%02X:%02X",\r
- ConnectionRequestParams.RemoteAddress[5], ConnectionRequestParams.RemoteAddress[4], \r
- ConnectionRequestParams.RemoteAddress[3], ConnectionRequestParams.RemoteAddress[2], \r
- ConnectionRequestParams.RemoteAddress[1], ConnectionRequestParams.RemoteAddress[0]);\r
- BT_DEBUG("(HCI) -- Device Class: 0x%02X%04X", ConnectionRequestParams.ClassOfDevice_Service,\r
- ConnectionRequestParams.ClassOfDevice_MajorMinor);\r
- BT_DEBUG("(HCI) -- Link Type: 0x%02x", ConnectionRequestParams.LinkType);\r
- \r
- memcpy(Bluetooth_TempDeviceAddress, ConnectionRequestParams.RemoteAddress,\r
- sizeof(Bluetooth_TempDeviceAddress));\r
-\r
- Bluetooth_HCIProcessingState = (Bluetooth_Connection.IsConnected) ? Bluetooth_Conn_RejectConnection :\r
- Bluetooth_Conn_AcceptConnection;\r
- }\r
- else if (HCIEventHeader.EventCode == EVENT_DISCONNECTION_COMPLETE)\r
- {\r
- BT_DEBUG("(HCI) >> Disconnection from device complete.", NULL);\r
- Bluetooth_HCIProcessingState = Bluetooth_Init;\r
- }\r
- else if (HCIEventHeader.EventCode == EVENT_CONNECTION_COMPLETE)\r
- {\r
- Bluetooth_HCIEvent_ConnectionComplete_Header_t ConnectionCompleteParams;\r
- \r
- Pipe_Read_Stream_LE(&ConnectionCompleteParams, sizeof(ConnectionCompleteParams));\r
- HCIEventHeader.ParameterLength -= sizeof(ConnectionCompleteParams);\r
-\r
- BT_DEBUG("(HCI) >> Connection to device complete.", NULL);\r
- BT_DEBUG("(HCI) -- Status: %d", ConnectionCompleteParams.Status);\r
- BT_DEBUG("(HCI) -- Handle: %d", ConnectionCompleteParams.ConnectionHandle);\r
- \r
- if (ConnectionCompleteParams.Status == 0x00)\r
- {\r
- memcpy(Bluetooth_Connection.DeviceAddress, ConnectionCompleteParams.RemoteAddress,\r
- sizeof(Bluetooth_Connection.DeviceAddress));\r
- Bluetooth_Connection.ConnectionHandle = ConnectionCompleteParams.ConnectionHandle;\r
- Bluetooth_Connection.IsConnected = true;\r
- }\r
- }\r
- else if (HCIEventHeader.EventCode == EVENT_PIN_CODE_REQUEST)\r
- {\r
- Pipe_Read_Stream_LE(&Bluetooth_TempDeviceAddress, sizeof(Bluetooth_TempDeviceAddress));\r
- HCIEventHeader.ParameterLength -= sizeof(Bluetooth_TempDeviceAddress);\r
-\r
- BT_DEBUG("(HCI) >> PIN code Request from device %02X:%02X:%02X:%02X:%02X:%02X", \r
- Bluetooth_TempDeviceAddress[5], Bluetooth_TempDeviceAddress[4], Bluetooth_TempDeviceAddress[3],\r
- Bluetooth_TempDeviceAddress[2], Bluetooth_TempDeviceAddress[1], Bluetooth_TempDeviceAddress[0]);\r
- \r
- Bluetooth_HCIProcessingState = Bluetooth_Conn_SendPINCode;\r
- }\r
- else if (HCIEventHeader.EventCode == EVENT_COMMAND_COMPLETE)\r
- {\r
- BT_DEBUG("(HCI) >> Command Complete", NULL);\r
- }\r
- \r
- BT_DEBUG("(HCI) -- Unread Event Param Length: %d", HCIEventHeader.ParameterLength);\r
-\r
- Bluetooth_DiscardRemainingHCIEventParameters();\r
- }\r
-\r
+ Bluetooth_HCINextState = Bluetooth_ProcessEvents;\r
+ Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
break;\r
case Bluetooth_Conn_AcceptConnection:\r
HCICommandHeader = (Bluetooth_HCICommand_Header_t)\r
{\r
OpCode: {OGF: OGF_LINK_CONTROL, OCF: OCF_LINK_CONTROL_ACCEPT_CONNECTION_REQUEST},\r
- ParameterLength: sizeof(Bluetooth_HCICommand_AcceptConnectionRequest_Params_t),\r
+ ParameterLength: sizeof(Bluetooth_HCICommand_AcceptConnectionRequest_t),\r
};\r
\r
BT_DEBUG("(HCI) Enter State: Bluetooth_Conn_AcceptConnection", NULL);\r
\r
- Bluetooth_HCICommand_AcceptConnectionRequest_Params_t AcceptConnectionParams;\r
- \r
- memcpy(AcceptConnectionParams.RemoteAddress, Bluetooth_TempDeviceAddress,\r
- sizeof(Bluetooth_TempDeviceAddress));\r
+ Bluetooth_HCICommand_AcceptConnectionRequest_t AcceptConnectionParams;\r
+\r
+ memcpy(AcceptConnectionParams.RemoteAddress, Bluetooth_TempDeviceAddress, sizeof(Bluetooth_TempDeviceAddress));\r
AcceptConnectionParams.SlaveRole = true;\r
\r
- Bluetooth_SendHCICommand(&AcceptConnectionParams, sizeof(AcceptConnectionParams));\r
+ ErrorCode = Bluetooth_SendHCICommand(&AcceptConnectionParams, sizeof(AcceptConnectionParams));\r
\r
- Bluetooth_HCIProcessingState = Bluetooth_PrepareToProcessEvents;\r
+ Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
break;\r
case Bluetooth_Conn_RejectConnection:\r
HCICommandHeader = (Bluetooth_HCICommand_Header_t)\r
{\r
- OpCode: {OGF: OGF_LINK_CONTROL, OCF: OCF_LINK_CONTROL_ACCEPT_CONNECTION_REQUEST},\r
- ParameterLength: sizeof(Bluetooth_HCICommand_RejectConnectionRequest_Params_t),\r
+ OpCode: {OGF: OGF_LINK_CONTROL, OCF: OCF_LINK_CONTROL_REJECT_CONNECTION_REQUEST},\r
+ ParameterLength: sizeof(Bluetooth_HCICommand_RejectConnectionRequest_t),\r
};\r
\r
BT_DEBUG("(HCI) Enter State: Bluetooth_Conn_RejectConnection", NULL);\r
\r
- Bluetooth_HCICommand_RejectConnectionRequest_Params_t RejectConnectionParams;\r
+ Bluetooth_HCICommand_RejectConnectionRequest_t RejectConnectionParams;\r
\r
- memcpy(RejectConnectionParams.RemoteAddress, Bluetooth_TempDeviceAddress,\r
- sizeof(Bluetooth_TempDeviceAddress));\r
+ memcpy(RejectConnectionParams.RemoteAddress, Bluetooth_TempDeviceAddress, sizeof(RejectConnectionParams.RemoteAddress));\r
RejectConnectionParams.Reason = ERROR_LIMITED_RESOURCES;\r
\r
- Bluetooth_SendHCICommand(&AcceptConnectionParams, sizeof(AcceptConnectionParams));\r
+ ErrorCode = Bluetooth_SendHCICommand(&RejectConnectionParams, sizeof(RejectConnectionParams));\r
\r
- Bluetooth_HCIProcessingState = Bluetooth_PrepareToProcessEvents;\r
+ Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
break;\r
case Bluetooth_Conn_SendPINCode:\r
HCICommandHeader = (Bluetooth_HCICommand_Header_t)\r
{\r
OpCode: {OGF: OGF_LINK_CONTROL, OCF: OCF_LINK_CONTROL_PIN_CODE_REQUEST_REPLY},\r
- ParameterLength: sizeof(Bluetooth_HCICommand_PinCodeResponse_Params_t),\r
+ ParameterLength: sizeof(Bluetooth_HCICommand_PinCodeResponse_t),\r
};\r
\r
BT_DEBUG("(HCI) Enter State: Bluetooth_Conn_SendPINCode", NULL);\r
BT_DEBUG("(HCI) -- PIN: %s", Bluetooth_DeviceConfiguration.PINCode);\r
\r
- Bluetooth_HCICommand_PinCodeResponse_Params_t PINCodeRequestParams;\r
+ Bluetooth_HCICommand_PinCodeResponse_t PINCodeRequestParams;\r
\r
- memcpy(PINCodeRequestParams.RemoteAddress, Bluetooth_TempDeviceAddress,\r
- sizeof(Bluetooth_TempDeviceAddress));\r
+ memcpy(PINCodeRequestParams.RemoteAddress, Bluetooth_TempDeviceAddress, sizeof(Bluetooth_TempDeviceAddress));\r
PINCodeRequestParams.PINCodeLength = strlen(Bluetooth_DeviceConfiguration.PINCode);\r
- memcpy(PINCodeRequestParams.PINCode, Bluetooth_DeviceConfiguration.PINCode,\r
- sizeof(Bluetooth_DeviceConfiguration.PINCode));\r
+ memcpy(PINCodeRequestParams.PINCode, Bluetooth_DeviceConfiguration.PINCode, sizeof(PINCodeRequestParams.PINCode));\r
\r
- Bluetooth_SendHCICommand(&PINCodeRequestParams, sizeof(PINCodeRequestParams));\r
+ ErrorCode = Bluetooth_SendHCICommand(&PINCodeRequestParams, sizeof(PINCodeRequestParams));\r
\r
- Bluetooth_HCIProcessingState = Bluetooth_PrepareToProcessEvents;\r
+ Bluetooth_HCIProcessingState = Bluetooth_ProcessEvents;\r
break;\r
}\r
}\r
projects / pub / USBasp.git / blobdiff