Add shortcuts to SwapEndian_16() and SwapEndian_32() internal functions to improve optimization if called with constant inputs.

pull/1469/head
Dean Camera 13 years ago
parent ef4cff29c3
commit 3478178127

@ -65,7 +65,13 @@ static bool IsTMCBulkOUTReset = false;
static uint8_t CurrentTransferTag = 0; static uint8_t CurrentTransferTag = 0;
/** Length of last data transfer, for reporting to the host in case an in-progress transfer is aborted */ /** Length of last data transfer, for reporting to the host in case an in-progress transfer is aborted */
static uint32_t LastTransferLength = 0; static uint16_t LastTransferLength = 0;
/** Buffer to hold the next message to sent to the TMC host */
static uint8_t NextResponseBuffer[64];
/** Indicates the length of the next response to send */
static uint8_t NextReponseLen;
/** Main program entry point. This routine contains the overall program flow, including initial /** Main program entry point. This routine contains the overall program flow, including initial
* setup of all components and the main program loop. * setup of all components and the main program loop.
@ -318,6 +324,27 @@ void EVENT_USB_Device_ControlRequest(void)
} }
} }
void ProcessSentMessage(uint8_t* const Data, const uint8_t Length)
{
if (strncmp((char*)Data, "*IDN?", 5) == 0)
strcpy((char*)NextResponseBuffer, "LUFA TMC DEMO");
NextReponseLen = strlen((char*)NextResponseBuffer);
}
uint8_t GetNextMessage(uint8_t* const Data)
{
strcpy((char*)NextResponseBuffer, "LUFA TMC DEMO");
NextReponseLen = strlen((char*)NextResponseBuffer);
// ---
uint8_t DataLen = MIN(NextReponseLen, 64);
strlcpy((char*)Data, (char*)NextResponseBuffer, DataLen);
return DataLen;
}
/** Function to manage TMC data transmission and reception to and from the host. */ /** Function to manage TMC data transmission and reception to and from the host. */
void TMC_Task(void) void TMC_Task(void)
{ {
@ -326,7 +353,7 @@ void TMC_Task(void)
return; return;
TMC_MessageHeader_t MessageHeader; TMC_MessageHeader_t MessageHeader;
uint16_t BytesTransferred; uint8_t MessagePayload[128];
/* Try to read in a TMC message from the interface, process if one is available */ /* Try to read in a TMC message from the interface, process if one is available */
if (ReadTMCHeader(&MessageHeader)) if (ReadTMCHeader(&MessageHeader))
@ -337,34 +364,32 @@ void TMC_Task(void)
switch (MessageHeader.MessageID) switch (MessageHeader.MessageID)
{ {
case TMC_MESSAGEID_DEV_DEP_MSG_OUT: case TMC_MESSAGEID_DEV_DEP_MSG_OUT:
BytesTransferred = 0; LastTransferLength = 0;
while (Endpoint_Discard_Stream(MessageHeader.TransferSize, &BytesTransferred) == while (Endpoint_Read_Stream_LE(MessagePayload, MIN(MessageHeader.TransferSize, sizeof(MessagePayload)), &LastTransferLength) ==
ENDPOINT_RWSTREAM_IncompleteTransfer) ENDPOINT_RWSTREAM_IncompleteTransfer)
{ {
if (IsTMCBulkOUTReset) if (IsTMCBulkOUTReset)
break; break;
} }
LastTransferLength = BytesTransferred;
Endpoint_ClearOUT(); Endpoint_ClearOUT();
ProcessSentMessage(MessagePayload, LastTransferLength);
break; break;
case TMC_MESSAGEID_DEV_DEP_MSG_IN: case TMC_MESSAGEID_DEV_DEP_MSG_IN:
Endpoint_ClearOUT(); Endpoint_ClearOUT();
char MessageData[] = "TMC Class Test"; MessageHeader.TransferSize = GetNextMessage(MessagePayload);
MessageHeader.TransferSize = strlen(MessageData);
MessageHeader.MessageIDSpecific.DeviceOUT.LastMessageTransaction = true; MessageHeader.MessageIDSpecific.DeviceOUT.LastMessageTransaction = true;
WriteTMCHeader(&MessageHeader); WriteTMCHeader(&MessageHeader);
BytesTransferred = 0; LastTransferLength = 0;
while (Endpoint_Write_Stream_LE(MessageData, MessageHeader.TransferSize, &BytesTransferred) == while (Endpoint_Write_Stream_LE(MessagePayload, MessageHeader.TransferSize, &LastTransferLength) ==
ENDPOINT_RWSTREAM_IncompleteTransfer) ENDPOINT_RWSTREAM_IncompleteTransfer)
{ {
if (IsTMCBulkINReset) if (IsTMCBulkINReset)
break; break;
} }
LastTransferLength = BytesTransferred;
Endpoint_ClearIN(); Endpoint_ClearIN();
break; break;

@ -108,19 +108,15 @@
typedef struct typedef struct
{ {
unsigned LastMessageTransaction : 1; uint8_t LastMessageTransaction;
unsigned Reserved : 7; uint8_t TermChar;
uint8_t Reserved[2];
uint8_t Reserved2[3];
} TMC_DevOUTMessageHeader_t; } TMC_DevOUTMessageHeader_t;
typedef struct typedef struct
{ {
unsigned TermCharEnabled : 1; uint8_t LastMessageTransaction;
unsigned Reserved : 7; uint8_t Reserved[3];
uint8_t TermChar;
uint8_t Reserved2[2];
} TMC_DevINMessageHeader_t; } TMC_DevINMessageHeader_t;
typedef struct typedef struct

@ -83,7 +83,7 @@
* *
* \param[in] x Value to check compile time constantness of. * \param[in] x Value to check compile time constantness of.
* *
* \return Boolean true if the given value is known to be a compile time constant. * \return Boolean true if the given value is known to be a compile time constant, false otherwise.
*/ */
#define GCC_IS_COMPILE_CONST(x) __builtin_constant_p(x) #define GCC_IS_COMPILE_CONST(x) __builtin_constant_p(x)
#else #else

@ -394,6 +394,9 @@
static inline uint16_t SwapEndian_16(const uint16_t Word) ATTR_WARN_UNUSED_RESULT ATTR_CONST; static inline uint16_t SwapEndian_16(const uint16_t Word) ATTR_WARN_UNUSED_RESULT ATTR_CONST;
static inline uint16_t SwapEndian_16(const uint16_t Word) static inline uint16_t SwapEndian_16(const uint16_t Word)
{ {
if (GCC_IS_COMPILE_CONST(Word))
return SWAPENDIAN_16(Word);
uint8_t Temp; uint8_t Temp;
union union
@ -420,6 +423,9 @@
static inline uint32_t SwapEndian_32(const uint32_t DWord) ATTR_WARN_UNUSED_RESULT ATTR_CONST; static inline uint32_t SwapEndian_32(const uint32_t DWord) ATTR_WARN_UNUSED_RESULT ATTR_CONST;
static inline uint32_t SwapEndian_32(const uint32_t DWord) static inline uint32_t SwapEndian_32(const uint32_t DWord)
{ {
if (GCC_IS_COMPILE_CONST(DWord))
return SWAPENDIAN_32(DWord);
uint8_t Temp; uint8_t Temp;
union union

@ -75,6 +75,7 @@
* - Fixed KeyboardHost and KeyboardHostWithParser demos displaying incorrect values when numerical keys were pressed * - Fixed KeyboardHost and KeyboardHostWithParser demos displaying incorrect values when numerical keys were pressed
* - Fixed compile errors in the incomplete BluetoothHost demo application (thanks to Timo Lindfors) * - Fixed compile errors in the incomplete BluetoothHost demo application (thanks to Timo Lindfors)
* - Fixed incorrect Dataflash buffer use in the DataflashManager_WriteBlocks_RAM() function of several demos/projects (thanks to Jeremy Willden) * - Fixed incorrect Dataflash buffer use in the DataflashManager_WriteBlocks_RAM() function of several demos/projects (thanks to Jeremy Willden)
* - Fixed incorrect logging interval (always 500ms longer than requested) in the TempDataLogger project
* *
* \section Sec_ChangeLog110528 Version 110528 * \section Sec_ChangeLog110528 Version 110528
* <b>New:</b> * <b>New:</b>

Loading…
Cancel
Save