Commit 3125fd5f authored by Dean Camera's avatar Dean Camera
Browse files

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

Add missing BT_* prefix to the Bluetooth stack's channel state enum values.
parent dcedde01
...@@ -62,11 +62,11 @@ void Bluetooth_ACLTask(void) ...@@ -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 ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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 ...@@ -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 ...@@ -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 ...@@ -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 ...@@ -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* ...@@ -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 ...@@ -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* ...@@ -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.
......
...@@ -66,19 +66,22 @@ ...@@ -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. */
......
...@@ -70,7 +70,7 @@ void RFCOMM_Initialize(void) ...@@ -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 ...@@ -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 ...@@ -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");
} }
...@@ -69,24 +69,24 @@ ...@@ -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: */
......
...@@ -42,29 +42,33 @@ void RFCOMM_ProcessControlCommand(const uint8_t* Command, Bluetooth_Channel_t* c ...@@ -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 ...@@ -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);
} }
...@@ -48,6 +48,9 @@ ...@@ -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 @@ ...@@ -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;