forksand
/
qmk_firmware
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Add RFCOMM channel configuration parsing and channel states to the incomplete BluetoothHost demo.

Browse Source 
Add missing BT_* prefix to the Bluetooth stack's channel state enum values.
pull/1469/head
Dean Camera 15 years ago
parent dcedde0123
commit 3125fd5f4f
6 changed files with 188 additions and 86 deletions
Show Stats Download Patch File Download Diff File

50
Demos/Host/Incomplete/BluetoothHost/Lib/BluetoothACLPackets.c
Unescape View File

@ -62,11 +62,11 @@ void Bluetooth_ACLTask(void)
/* Check if we are in a channel state which requires a configuration request to be sent */ /* Check if we are in a channel state which requires a configuration request to be sent */
switch (ChannelData->State) switch (ChannelData->State)
{ {
case Channel_Config_WaitConfig: case BT_Channel_Config_WaitConfig:
ChannelData->State = Channel_Config_WaitReqResp; ChannelData->State = BT_Channel_Config_WaitReqResp;
break; break;
case Channel_Config_WaitSendConfig: case BT_Channel_Config_WaitSendConfig:
ChannelData->State = Channel_Config_WaitResp; ChannelData->State = BT_Channel_Config_WaitResp;
break; break;
default: default:
MustSendConfigReq = false; MustSendConfigReq = false;
@ -224,7 +224,7 @@ uint8_t Bluetooth_SendPacket(void* Data, const uint16_t DataLen, Bluetooth_Chann
return BT_SENDPACKET_NotConnected; return BT_SENDPACKET_NotConnected;
/* If the destination channel is not the signalling channel and it is not currently fully open, abort */ /* If the destination channel is not the signalling channel and it is not currently fully open, abort */
if ((Channel != NULL) && (Channel->State != Channel_Open)) if ((Channel != NULL) && (Channel->State != BT_Channel_Open))
return BT_SENDPACKET_ChannelNotOpen; return BT_SENDPACKET_ChannelNotOpen;
/* Fill out the packet's header from the remote device connection information structure */ /* Fill out the packet's header from the remote device connection information structure */
@ -274,7 +274,7 @@ Bluetooth_Channel_t* Bluetooth_OpenChannel(const uint16_t PSM)
/* Search through the channel information list for a free channel item */ /* Search through the channel information list for a free channel item */
for (uint8_t i = 0; i < BLUETOOTH_MAX_OPEN_CHANNELS; i++) for (uint8_t i = 0; i < BLUETOOTH_MAX_OPEN_CHANNELS; i++)
{ {
if (Bluetooth_Connection.Channels[i].State == Channel_Closed) if (Bluetooth_Connection.Channels[i].State == BT_Channel_Closed)
{ {
ChannelData = &Bluetooth_Connection.Channels[i]; ChannelData = &Bluetooth_Connection.Channels[i];
@ -293,7 +293,7 @@ Bluetooth_Channel_t* Bluetooth_OpenChannel(const uint16_t PSM)
ChannelData->RemoteNumber = 0; ChannelData->RemoteNumber = 0;
ChannelData->PSM = PSM; ChannelData->PSM = PSM;
ChannelData->LocalMTU = MAXIMUM_CHANNEL_MTU; ChannelData->LocalMTU = MAXIMUM_CHANNEL_MTU;
ChannelData->State = Channel_WaitConnectRsp; ChannelData->State = BT_Channel_WaitConnectRsp;
struct struct
{ {
@ -332,11 +332,11 @@ Bluetooth_Channel_t* Bluetooth_OpenChannel(const uint16_t PSM)
void Bluetooth_CloseChannel(Bluetooth_Channel_t* const Channel) void Bluetooth_CloseChannel(Bluetooth_Channel_t* const Channel)
{ {
/* Don't try to close a non-existing or already closed channel */ /* Don't try to close a non-existing or already closed channel */
if ((Channel == NULL) || (Channel->State == Channel_Closed)) if ((Channel == NULL) || (Channel->State == BT_Channel_Closed))
return; return;
/* Set the channel's state to the start of the teardown process */ /* Set the channel's state to the start of the teardown process */
Channel->State = Channel_WaitDisconnect; Channel->State = BT_Channel_WaitDisconnect;
struct struct
{ {
@ -386,7 +386,7 @@ static inline void Bluetooth_Signal_ConnectionReq(const BT_Signal_Header_t* cons
/* Look through the channel information list for a free entry */ /* Look through the channel information list for a free entry */
for (uint8_t i = 0; i < BLUETOOTH_MAX_OPEN_CHANNELS; i++) for (uint8_t i = 0; i < BLUETOOTH_MAX_OPEN_CHANNELS; i++)
{ {
if (Bluetooth_Connection.Channels[i].State == Channel_Closed) if (Bluetooth_Connection.Channels[i].State == BT_Channel_Closed)
{ {
ChannelData = &Bluetooth_Connection.Channels[i]; ChannelData = &Bluetooth_Connection.Channels[i];
@ -409,7 +409,7 @@ static inline void Bluetooth_Signal_ConnectionReq(const BT_Signal_Header_t* cons
ChannelData->RemoteNumber = ConnectionRequest.SourceChannel; ChannelData->RemoteNumber = ConnectionRequest.SourceChannel;
ChannelData->PSM = ConnectionRequest.PSM; ChannelData->PSM = ConnectionRequest.PSM;
ChannelData->LocalMTU = MAXIMUM_CHANNEL_MTU; ChannelData->LocalMTU = MAXIMUM_CHANNEL_MTU;
ChannelData->State = Channel_Config_WaitConfig; ChannelData->State = BT_Channel_Config_WaitConfig;
ChannelStatus = BT_CONNECTION_SUCCESSFUL; ChannelStatus = BT_CONNECTION_SUCCESSFUL;
} }
@ -471,7 +471,7 @@ static inline void Bluetooth_Signal_ConnectionResp(const BT_Signal_Header_t* con
/* Set the channel structure's remote channel number to the channel allocated on the remote device */ /* Set the channel structure's remote channel number to the channel allocated on the remote device */
ChannelData->RemoteNumber = ConnectionResponse.SourceChannel; ChannelData->RemoteNumber = ConnectionResponse.SourceChannel;
ChannelData->State = (ConnectionResponse.Result == BT_CONNECTION_SUCCESSFUL) ? ChannelData->State = (ConnectionResponse.Result == BT_CONNECTION_SUCCESSFUL) ?
Channel_Config_WaitConfig : Channel_Closed; BT_Channel_Config_WaitConfig : BT_Channel_Closed;
} }
} }
@ -544,14 +544,14 @@ static inline void Bluetooth_Signal_ConfigurationReq(const BT_Signal_Header_t* c
{ {
switch (ChannelData->State) switch (ChannelData->State)
{ {
case Channel_Config_WaitConfig: case BT_Channel_Config_WaitConfig:
ChannelData->State = Channel_Config_WaitSendConfig; ChannelData->State = BT_Channel_Config_WaitSendConfig;
break; break;
case Channel_Config_WaitReqResp: case BT_Channel_Config_WaitReqResp:
ChannelData->State = Channel_Config_WaitResp; ChannelData->State = BT_Channel_Config_WaitResp;
break; break;
case Channel_Config_WaitReq: case BT_Channel_Config_WaitReq:
ChannelData->State = Channel_Open; ChannelData->State = BT_Channel_Open;
break; break;
} }
} }
@ -589,18 +589,18 @@ static inline void Bluetooth_Signal_ConfigurationResp(const BT_Signal_Header_t*
{ {
switch (ChannelData->State) switch (ChannelData->State)
{ {
case Channel_Config_WaitReqResp: case BT_Channel_Config_WaitReqResp:
ChannelData->State = Channel_Config_WaitReq; ChannelData->State = BT_Channel_Config_WaitReq;
break; break;
case Channel_Config_WaitResp: case BT_Channel_Config_WaitResp:
ChannelData->State = Channel_Open; ChannelData->State = BT_Channel_Open;
break; break;
} }
} }
else else
{ {
/* Configuration failed - close the channel */ /* Configuration failed - close the channel */
ChannelData->State = Channel_Closed; ChannelData->State = BT_Channel_Closed;
} }
} }
} }
@ -644,7 +644,7 @@ static inline void Bluetooth_Signal_DisconnectionReq(const BT_Signal_Header_t* c
/* If the channel was found in the channel list, close it */ /* If the channel was found in the channel list, close it */
if (ChannelData != NULL) if (ChannelData != NULL)
ChannelData->State = Channel_Closed; ChannelData->State = BT_Channel_Closed;
BT_ACL_DEBUG(1, ">> L2CAP Disconnection Response"); BT_ACL_DEBUG(1, ">> L2CAP Disconnection Response");
BT_ACL_DEBUG(2, "-- Source Channel: 0x%04X", ResponsePacket.DisconnectionResponse.SourceChannel); BT_ACL_DEBUG(2, "-- Source Channel: 0x%04X", ResponsePacket.DisconnectionResponse.SourceChannel);
@ -673,7 +673,7 @@ static inline void Bluetooth_Signal_DisconnectionResp(const BT_Signal_Header_t*
/* If the channel was found in the channel list, close it */ /* If the channel was found in the channel list, close it */
if (ChannelData != NULL) if (ChannelData != NULL)
ChannelData->State = Channel_Closed; ChannelData->State = BT_Channel_Closed;
} }
/** Internal Bluetooth stack Signal Command processing routine for an Echo Request command. /** Internal Bluetooth stack Signal Command processing routine for an Echo Request command.

29
Demos/Host/Incomplete/BluetoothHost/Lib/BluetoothStack.h
Unescape View File

@ -66,19 +66,22 @@
/** Enum for the possible states for a Bluetooth ACL channel. */ /** Enum for the possible states for a Bluetooth ACL channel. */
enum BT_ChannelStates_t enum BT_ChannelStates_t
{ {
Channel_Closed = 0, /**< Channel is closed and inactive. No data may be sent or received. */ BT_Channel_Closed = 0, /**< Channel is closed and inactive. No data may be sent or received. */
Channel_WaitConnect = 1, /**< A connection request has been received, but a response has not been sent. */ BT_Channel_WaitConnect = 1, /**< A connection request has been received, but a response has not been sent. */
Channel_WaitConnectRsp = 2, /**< A connection request has been sent, but a response has not been received. */ BT_Channel_WaitConnectRsp = 2, /**< A connection request has been sent, but a response has not been received. */
Channel_Config_WaitConfig = 3, /**< Channel has been connected, but not yet configured on either end. */ BT_Channel_Config_WaitConfig = 3, /**< Channel has been connected, but not yet configured on either end. */
Channel_Config_WaitSendConfig = 4, /**< Channel configuration has been received and accepted, but not yet sent. */ BT_Channel_Config_WaitSendConfig = 4, /**< Channel configuration has been received and accepted, but not yet sent. */
Channel_Config_WaitReqResp = 5, /**< Channel configuration has been sent but not responded to, and a configuration BT_Channel_Config_WaitReqResp = 5, /**< Channel configuration has been sent but not responded to, and a configuration
request from the remote end has not yet been received. */ * request from the remote end has not yet been received.
Channel_Config_WaitResp = 6, /**< Channel configuration has been sent but not accepted, but a configuration request */
from the remote end has been accepted. */ BT_Channel_Config_WaitResp = 6, /**< Channel configuration has been sent but not accepted, but a configuration request
Channel_Config_WaitReq = 7, /**< Channel configuration has been sent and accepted, but a configuration request * from the remote end has been accepted.
from the remote end has not yet been accepted. */ */
Channel_Open = 8, /**< Channel is open and ready to send or receive data */ BT_Channel_Config_WaitReq = 7, /**< Channel configuration has been sent and accepted, but a configuration request
Channel_WaitDisconnect = 9, /**< A disconnection request has been sent, but not yet acknowledged. */ * from the remote end has not yet been accepted.
*/
BT_Channel_Open = 8, /**< Channel is open and ready to send or receive data */
BT_Channel_WaitDisconnect = 9, /**< A disconnection request has been sent, but not yet acknowledged. */
}; };
/** Enum for the possible error codes returned by the \ref Bluetooth_SendPacket() function. */ /** Enum for the possible error codes returned by the \ref Bluetooth_SendPacket() function. */

24
Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMM.c
Unescape View File

@ -70,7 +70,7 @@ void RFCOMM_Initialize(void)
{ {
/* Reset the RFCOMM channel structures, to invalidate any confiured RFCOMM channels */ /* Reset the RFCOMM channel structures, to invalidate any confiured RFCOMM channels */
for (uint8_t i = 0; i < RFCOMM_MAX_OPEN_CHANNELS; i++) for (uint8_t i = 0; i < RFCOMM_MAX_OPEN_CHANNELS; i++)
RFCOMM_Channels[i].DLCI = 0x00; RFCOMM_Channels[i].State = RFCOMM_Channel_Closed;
} }
void RFCOMM_ProcessPacket(void* Data, Bluetooth_Channel_t* const Channel) void RFCOMM_ProcessPacket(void* Data, Bluetooth_Channel_t* const Channel)
@ -220,8 +220,11 @@ static void RFCOMM_ProcessSABM(const RFCOMM_Address_t* const FrameAddress, Bluet
/* If the channel's DLCI is zero, the channel state entry is free */ /* If the channel's DLCI is zero, the channel state entry is free */
if (!(CurrRFCOMMChannel->DLCI)) if (!(CurrRFCOMMChannel->DLCI))
{ {
CurrRFCOMMChannel->DLCI = FrameAddress->DLCI; CurrRFCOMMChannel->DLCI = FrameAddress->DLCI;
CurrRFCOMMChannel->Configured = false; CurrRFCOMMChannel->State = RFCOMM_Channel_Open;
CurrRFCOMMChannel->Priority = 7 + (CurrRFCOMMChannel->DLCI >> 3) + ((CurrRFCOMMChannel->DLCI >> 3) * 7);
CurrRFCOMMChannel->UseUIFrames = false;
CurrRFCOMMChannel->RemoteMTU = 0xFFFF;
BT_RFCOMM_DEBUG(1, ">> UA Sent"); BT_RFCOMM_DEBUG(1, ">> UA Sent");
RFCOMM_SendFrame(FrameAddress->DLCI, true, (RFCOMM_Frame_UA | FRAME_POLL_FINAL), 0, NULL, Channel); RFCOMM_SendFrame(FrameAddress->DLCI, true, (RFCOMM_Frame_UA | FRAME_POLL_FINAL), 0, NULL, Channel);
@ -244,15 +247,20 @@ static void RFCOMM_ProcessUA(const RFCOMM_Address_t* const FrameAddress, Bluetoo
static void RFCOMM_ProcessUIH(const RFCOMM_Address_t* const FrameAddress, const uint16_t FrameLength, static void RFCOMM_ProcessUIH(const RFCOMM_Address_t* const FrameAddress, const uint16_t FrameLength,
const uint8_t* FrameData, Bluetooth_Channel_t* const Channel) const uint8_t* FrameData, Bluetooth_Channel_t* const Channel)
{ {
BT_RFCOMM_DEBUG(1, "<< UIH Received");
BT_RFCOMM_DEBUG(2, "-- DLCI 0x%02X", FrameAddress->DLCI);
BT_RFCOMM_DEBUG(2, "-- Length 0x%02X", FrameLength);
if (FrameAddress->DLCI == RFCOMM_CONTROL_DLCI) if (FrameAddress->DLCI == RFCOMM_CONTROL_DLCI)
{ {
RFCOMM_ProcessControlCommand(FrameData, Channel); RFCOMM_ProcessControlCommand(FrameData, Channel);
return; return;
} }
// TODO: Handle regular channel data here BT_RFCOMM_DEBUG(1, "<< UIH Received");
BT_RFCOMM_DEBUG(2, "-- DLCI 0x%02X", FrameAddress->DLCI);
BT_RFCOMM_DEBUG(2, "-- Length 0x%02X", FrameLength);
puts("RFCOMM Data: ");
for (uint8_t i = 0; i < FrameLength; i++)
printf("0x%02X (%c) ", FrameData[i], FrameData[i]);
printf("\r\n");
} }

28
Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMM.h
Unescape View File

@ -69,24 +69,24 @@
RFCOMM_Frame_UIH = 0xEF, /**< Unnumbered Information with Header check Field */ RFCOMM_Frame_UIH = 0xEF, /**< Unnumbered Information with Header check Field */
}; };
/* Type Defines: */ enum RFCOMM_Channel_States_t
typedef struct
{
unsigned char EA : 1;
unsigned char CR : 1;
unsigned char DLCI : 6;
} RFCOMM_Address_t;
typedef struct
{ {
RFCOMM_Address_t Address; RFCOMM_Channel_Closed = 0,
uint8_t Control; RFCOMM_Channel_Create = 1,
} RFCOMM_Header_t; RFCOMM_Channel_Creating = 2,
RFCOMM_Channel_Configure = 3,
RFCOMM_Channel_Configuring = 4,
RFCOMM_Channel_Open = 5,
};
/* Type Defines: */
typedef struct typedef struct
{ {
uint8_t DLCI; uint8_t DLCI;
bool Configured; uint8_t State;
uint8_t Priority;
bool UseUIFrames;
uint16_t RemoteMTU;
} RFCOMM_Channel_t; } RFCOMM_Channel_t;
/* External Variables: */ /* External Variables: */

94
Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMMControl.c
Unescape View File

@ -42,29 +42,33 @@ void RFCOMM_ProcessControlCommand(const uint8_t* Command, Bluetooth_Channel_t* c
{ {
const RFCOMM_Command_t* CommandHeader = (const RFCOMM_Command_t*)Command; const RFCOMM_Command_t* CommandHeader = (const RFCOMM_Command_t*)Command;
const uint8_t* CommandData = (const uint8_t*)Command + sizeof(RFCOMM_Command_t); const uint8_t* CommandData = (const uint8_t*)Command + sizeof(RFCOMM_Command_t);
uint16_t ControlDataLen = RFCOMM_GetFrameDataLength(CommandData);
/* Adjust the command data pointer to skip over the variable size field */
CommandData += (ControlDataLen < 128) ? 1 : 2;
switch (CommandHeader->Command) switch (CommandHeader->Command)
{ {
case RFCOMM_Control_Test: case RFCOMM_Control_Test:
RFCOMM_ProcessTestCommand(CommandHeader, CommandData); RFCOMM_ProcessTestCommand(CommandHeader, CommandData, Channel);
break; break;
case RFCOMM_Control_FlowControlEnable: case RFCOMM_Control_FlowControlEnable:
RFCOMM_ProcessFCECommand(CommandHeader, CommandData); RFCOMM_ProcessFCECommand(CommandHeader, CommandData, Channel);
break; break;
case RFCOMM_Control_FlowControlDisable: case RFCOMM_Control_FlowControlDisable:
RFCOMM_ProcessFCDCommand(CommandHeader, CommandData); RFCOMM_ProcessFCDCommand(CommandHeader, CommandData, Channel);
break; break;
case RFCOMM_Control_ModemStatus: case RFCOMM_Control_ModemStatus:
RFCOMM_ProcessMSCommand(CommandHeader, CommandData); RFCOMM_ProcessMSCommand(CommandHeader, CommandData, Channel);
break; break;
case RFCOMM_Control_RemotePortNegotiation: case RFCOMM_Control_RemotePortNegotiation:
RFCOMM_ProcessRPNCommand(CommandHeader, CommandData); RFCOMM_ProcessRPNCommand(CommandHeader, CommandData, Channel);
break; break;
case RFCOMM_Control_RemoteLineStatus: case RFCOMM_Control_RemoteLineStatus:
RFCOMM_ProcessRLSCommand(CommandHeader, CommandData); RFCOMM_ProcessRLSCommand(CommandHeader, CommandData, Channel);
break; break;
case RFCOMM_Control_DLCParameterNegotiation: case RFCOMM_Control_DLCParameterNegotiation:
RFCOMM_ProcessDPNCommand(CommandHeader, CommandData); RFCOMM_ProcessDPNCommand(CommandHeader, CommandData, Channel);
break; break;
default: default:
BT_RFCOMM_DEBUG(1, "<< Unknown Command"); BT_RFCOMM_DEBUG(1, "<< Unknown Command");
@ -72,49 +76,101 @@ void RFCOMM_ProcessControlCommand(const uint8_t* Command, Bluetooth_Channel_t* c
} }
} }
static void RFCOMM_ProcessTestCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData) static void RFCOMM_ProcessTestCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel)
{ {
BT_RFCOMM_DEBUG(1, "<< TEST Command"); BT_RFCOMM_DEBUG(1, "<< TEST Command");
} }
static void RFCOMM_ProcessFCECommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData) static void RFCOMM_ProcessFCECommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel)
{ {
BT_RFCOMM_DEBUG(1, "<< FCE Command"); BT_RFCOMM_DEBUG(1, "<< FCE Command");
} }
static void RFCOMM_ProcessFCDCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData) static void RFCOMM_ProcessFCDCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel)
{ {
BT_RFCOMM_DEBUG(1, "<< FCD Command"); BT_RFCOMM_DEBUG(1, "<< FCD Command");
} }
static void RFCOMM_ProcessMSCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData) static void RFCOMM_ProcessMSCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel)
{ {
BT_RFCOMM_DEBUG(1, "<< MS Command"); BT_RFCOMM_DEBUG(1, "<< MS Command");
} }
static void RFCOMM_ProcessRPNCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData) static void RFCOMM_ProcessRPNCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel)
{ {
BT_RFCOMM_DEBUG(1, "<< RPN Command"); BT_RFCOMM_DEBUG(1, "<< RPN Command");
} }
static void RFCOMM_ProcessRLSCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData) static void RFCOMM_ProcessRLSCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel)
{ {
BT_RFCOMM_DEBUG(1, "<< RLS Command"); BT_RFCOMM_DEBUG(1, "<< RLS Command");
} }
static void RFCOMM_ProcessDPNCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData) static void RFCOMM_ProcessDPNCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel)
{ {
const RFCOMM_DPN_Parameters_t* Params = (const RFCOMM_DPN_Parameters_t*)CommandData;
BT_RFCOMM_DEBUG(1, "<< DPN Command"); BT_RFCOMM_DEBUG(1, "<< DPN Command");
BT_RFCOMM_DEBUG(2, "-- Config DLCI: 0x%02X", Params->DLCI);
/* Skip over the first data byte (Length field) since its size and value are fixed */ /* Ignore parameter negotiations to the control channel */
RFCOMM_Channel_t* RFCOMMChannel = RFCOMM_GetChannelData(CommandData[2]); if (Params->DLCI == RFCOMM_CONTROL_DLCI)
return;
/* Retrieve existing channel configuration data, if already opened */
RFCOMM_Channel_t* RFCOMMChannel = RFCOMM_GetChannelData(Params->DLCI);
/* Check if the channel has no corresponding entry - remote did not open it first */
if (RFCOMMChannel == NULL) if (RFCOMMChannel == NULL)
{ {
// TODO: Channel does not exist - create it /* Find a free entry in the RFCOMM channel multiplexer state array */
for (uint8_t i = 0; i < RFCOMM_MAX_OPEN_CHANNELS; i++)
{
/* If the channel's DLCI is zero, the channel state entry is free */
if (!(RFCOMM_Channels[i].DLCI))
{
RFCOMMChannel = &RFCOMM_Channels[i];
RFCOMMChannel->DLCI = Params->DLCI;
break;
}
}
/* No free entry was found, discard the request */
if (RFCOMMChannel == NULL)
{
BT_RFCOMM_DEBUG(2, "-- No Free Channel");
return;
}
} }
RFCOMMChannel->Configured = true; /* Save the new channel configuration */
RFCOMMChannel->State = RFCOMM_Channel_Open;
RFCOMMChannel->Priority = Params->Priority;
RFCOMMChannel->UseUIFrames = (Params->FrameType != 0);
RFCOMMChannel->RemoteMTU = Params->MaximumFrameSize;
// TODO: Read in channel data, ACK request struct
{
RFCOMM_Command_t CommandHeader;
uint8_t Length;
RFCOMM_DPN_Parameters_t Params;
} DPNResponse;
/* Fill out the DPN response data */
DPNResponse.CommandHeader.Command = CommandHeader->Command;
DPNResponse.CommandHeader.EA = true;
DPNResponse.Length = (sizeof(DPNResponse.Params) << 1) | 0x01;
DPNResponse.Params = *Params;
BT_RFCOMM_DEBUG(1, ">> DPN Response");
/* Send the PDN response to acknowledge the command */
RFCOMM_SendFrame(RFCOMM_CONTROL_DLCI, false, RFCOMM_Frame_UIH, sizeof(DPNResponse), &DPNResponse, Channel);
} }

49
Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMMControl.h
Unescape View File

@ -48,6 +48,9 @@
#include "BluetoothStack.h" #include "BluetoothStack.h"
#include "RFCOMM.h" #include "RFCOMM.h"
/* Macros: */
#define RFCOMM_
/* Enums: */ /* Enums: */
enum RFCOMM_Control_Commands_t enum RFCOMM_Control_Commands_t
@ -63,24 +66,56 @@
}; };
/* Type Defines: */ /* Type Defines: */
typedef struct
{
unsigned char EA : 1;
unsigned char CR : 1;
unsigned char DLCI : 6;
} RFCOMM_Address_t;
typedef struct
{
RFCOMM_Address_t Address;
uint8_t Control;
} RFCOMM_Header_t;
typedef struct typedef struct
{ {
unsigned char EA : 1; unsigned char EA : 1;
unsigned char CR : 1; unsigned char CR : 1;
unsigned char Command : 6; unsigned char Command : 6;
} RFCOMM_Command_t; } RFCOMM_Command_t;
typedef struct
{
uint8_t DLCI;
unsigned char FrameType : 4;
unsigned char ConvergenceLayer : 4;
uint8_t Priority;
uint8_t ACKTimerTicks;
uint16_t MaximumFrameSize;
uint8_t MaxRetransmissions;
uint8_t RecoveryWindowSize;
} RFCOMM_DPN_Parameters_t;
/* Function Prototypes: */ /* Function Prototypes: */
void RFCOMM_ProcessControlCommand(const uint8_t* Command, Bluetooth_Channel_t* const Channel); void RFCOMM_ProcessControlCommand(const uint8_t* Command, Bluetooth_Channel_t* const Channel);
#if defined(INCLUDE_FROM_RFCOMM_CONTROL_C) #if defined(INCLUDE_FROM_RFCOMM_CONTROL_C)
static void RFCOMM_ProcessTestCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData); static void RFCOMM_ProcessTestCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
static void RFCOMM_ProcessFCECommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData); Bluetooth_Channel_t* const Channel);
static void RFCOMM_ProcessFCDCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData); static void RFCOMM_ProcessFCECommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
static void RFCOMM_ProcessMSCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData); Bluetooth_Channel_t* const Channel);
static void RFCOMM_ProcessRPNCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData); static void RFCOMM_ProcessFCDCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
static void RFCOMM_ProcessRLSCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData); Bluetooth_Channel_t* const Channel);
static void RFCOMM_ProcessDPNCommand(const RFCOMM_Command_t* CommandHeader, const uint8_t* CommandData); static void RFCOMM_ProcessMSCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel);
static void RFCOMM_ProcessRPNCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel);
static void RFCOMM_ProcessRLSCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel);
static void RFCOMM_ProcessDPNCommand(const RFCOMM_Command_t* const CommandHeader, const uint8_t* CommandData,
Bluetooth_Channel_t* const Channel);
#endif #endif
#endif #endif

Write Preview
Loading…
Cancel
Save