rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-01-29 14:52:12 +01:00
Code Issues Releases Activity

OP-155 Flight/HID: Make the HID stall when buffer full. Not sure the consequences on ground (i.e. if it handles the stall correctly)

Browse Source 
git-svn-id: svn://svn.openpilot.org/OpenPilot/trunk@1665 ebee16cc-31ac-478f-84a7-5cbb03baadba
This commit is contained in:
peabody124 2010-09-16 20:23:02 +00:00 committed by peabody124
parent 96990b5f60
commit a6ca5b82e7
1 changed files with 13 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
flight/PiOS/STM32F10x/pios_usb_hid.c
View File

@ -284,7 +284,12 @@ int32_t PIOS_USB_HID_TxBufferPutMore(uint8_t id, const uint8_t *buffer, uint16_t
*/
int32_t PIOS_USB_HID_RxBufferGet(uint8_t id)
{
return bufferGetFromFront(&rxBuffer);
uint8_t read = bufferGetFromFront(&rxBuffer);
// If endpoint was stalled and there is now space make it valid
if((GetEPRxStatus(ENDP1) == EP_RX_STALL) && (bufferRemainingSpace(&rxBuffer) > 62)) {
SetEPRxStatus(ENDP1, EP_RX_VALID);
}
return read;
}
/**
@ -327,7 +332,13 @@ void PIOS_USB_HID_EP1_OUT_Callback(void)
#else
bufferAddChunkToEnd(&rxBuffer, &rx_buffer[2], rx_buffer[1]);
#endif
SetEPRxStatus(ENDP1, EP_RX_VALID);
// Only reactivate endpoint if available space in buffer
if(bufferRemainingSpace(&rxBuffer) > 62) {
SetEPRxStatus(ENDP1, EP_RX_VALID);
} else {
SetEPRxStatus(ENDP1, EP_RX_STALL);
}
}
#endif