|
|
@ -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;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
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");
|
|
|
|
|
|
|
|
|
|
|
|
// TODO: Read in channel data, ACK request
|
|
|
|
/* Send the PDN response to acknowledge the command */
|
|
|
|
|
|
|
|
RFCOMM_SendFrame(RFCOMM_CONTROL_DLCI, false, RFCOMM_Frame_UIH, sizeof(DPNResponse), &DPNResponse, Channel);
|
|
|
|
}
|
|
|
|
}
|
|
|
|