Fix timeout logic of LUFA sendchar(), sned_*().
This commit is contained in:
parent
2a5ce5ef70
commit
45ea1874d6
@ -76,7 +76,7 @@ static void Console_Task(void)
|
|||||||
{
|
{
|
||||||
/* Device must be connected and configured for the task to run */
|
/* Device must be connected and configured for the task to run */
|
||||||
if (USB_DeviceState != DEVICE_STATE_Configured)
|
if (USB_DeviceState != DEVICE_STATE_Configured)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
uint8_t ep = Endpoint_GetCurrentEndpoint();
|
uint8_t ep = Endpoint_GetCurrentEndpoint();
|
||||||
|
|
||||||
@ -107,6 +107,10 @@ static void Console_Task(void)
|
|||||||
|
|
||||||
/* IN packet */
|
/* IN packet */
|
||||||
Endpoint_SelectEndpoint(CONSOLE_IN_EPNUM);
|
Endpoint_SelectEndpoint(CONSOLE_IN_EPNUM);
|
||||||
|
if (!Endpoint_IsEnabled() || !Endpoint_IsConfigured()) {
|
||||||
|
Endpoint_SelectEndpoint(ep);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
// fill empty bank
|
// fill empty bank
|
||||||
while (Endpoint_IsReadWriteAllowed())
|
while (Endpoint_IsReadWriteAllowed())
|
||||||
@ -299,12 +303,14 @@ static uint8_t keyboard_leds(void)
|
|||||||
|
|
||||||
static void send_keyboard(report_keyboard_t *report)
|
static void send_keyboard(report_keyboard_t *report)
|
||||||
{
|
{
|
||||||
|
uint8_t timeout = 0;
|
||||||
|
|
||||||
// TODO: handle NKRO report
|
// TODO: handle NKRO report
|
||||||
/* Select the Keyboard Report Endpoint */
|
/* Select the Keyboard Report Endpoint */
|
||||||
Endpoint_SelectEndpoint(KEYBOARD_IN_EPNUM);
|
Endpoint_SelectEndpoint(KEYBOARD_IN_EPNUM);
|
||||||
|
|
||||||
/* Check if Keyboard Endpoint Ready for Read/Write */
|
/* Check if Keyboard Endpoint Ready for Read/Write */
|
||||||
while (!Endpoint_IsReadWriteAllowed()) ;
|
while (--timeout && !Endpoint_IsReadWriteAllowed()) ;
|
||||||
|
|
||||||
/* Write Keyboard Report Data */
|
/* Write Keyboard Report Data */
|
||||||
Endpoint_Write_Stream_LE(report, sizeof(report_keyboard_t), NULL);
|
Endpoint_Write_Stream_LE(report, sizeof(report_keyboard_t), NULL);
|
||||||
@ -318,11 +324,13 @@ static void send_keyboard(report_keyboard_t *report)
|
|||||||
static void send_mouse(report_mouse_t *report)
|
static void send_mouse(report_mouse_t *report)
|
||||||
{
|
{
|
||||||
#ifdef MOUSE_ENABLE
|
#ifdef MOUSE_ENABLE
|
||||||
|
uint8_t timeout = 0;
|
||||||
|
|
||||||
/* Select the Mouse Report Endpoint */
|
/* Select the Mouse Report Endpoint */
|
||||||
Endpoint_SelectEndpoint(MOUSE_IN_EPNUM);
|
Endpoint_SelectEndpoint(MOUSE_IN_EPNUM);
|
||||||
|
|
||||||
/* Check if Mouse Endpoint Ready for Read/Write */
|
/* Check if Mouse Endpoint Ready for Read/Write */
|
||||||
while (!Endpoint_IsReadWriteAllowed()) ;
|
while (--timeout && !Endpoint_IsReadWriteAllowed()) ;
|
||||||
|
|
||||||
/* Write Mouse Report Data */
|
/* Write Mouse Report Data */
|
||||||
Endpoint_Write_Stream_LE(report, sizeof(report_mouse_t), NULL);
|
Endpoint_Write_Stream_LE(report, sizeof(report_mouse_t), NULL);
|
||||||
@ -334,24 +342,28 @@ static void send_mouse(report_mouse_t *report)
|
|||||||
|
|
||||||
static void send_system(uint16_t data)
|
static void send_system(uint16_t data)
|
||||||
{
|
{
|
||||||
|
uint8_t timeout = 0;
|
||||||
|
|
||||||
report_extra_t r = {
|
report_extra_t r = {
|
||||||
.report_id = REPORT_ID_SYSTEM,
|
.report_id = REPORT_ID_SYSTEM,
|
||||||
.usage = data
|
.usage = data
|
||||||
};
|
};
|
||||||
Endpoint_SelectEndpoint(EXTRAKEY_IN_EPNUM);
|
Endpoint_SelectEndpoint(EXTRAKEY_IN_EPNUM);
|
||||||
while (!Endpoint_IsReadWriteAllowed()) ;
|
while (--timeout && !Endpoint_IsReadWriteAllowed()) ;
|
||||||
Endpoint_Write_Stream_LE(&r, sizeof(report_extra_t), NULL);
|
Endpoint_Write_Stream_LE(&r, sizeof(report_extra_t), NULL);
|
||||||
Endpoint_ClearIN();
|
Endpoint_ClearIN();
|
||||||
}
|
}
|
||||||
|
|
||||||
static void send_consumer(uint16_t data)
|
static void send_consumer(uint16_t data)
|
||||||
{
|
{
|
||||||
|
uint8_t timeout = 0;
|
||||||
|
|
||||||
report_extra_t r = {
|
report_extra_t r = {
|
||||||
.report_id = REPORT_ID_CONSUMER,
|
.report_id = REPORT_ID_CONSUMER,
|
||||||
.usage = data
|
.usage = data
|
||||||
};
|
};
|
||||||
Endpoint_SelectEndpoint(EXTRAKEY_IN_EPNUM);
|
Endpoint_SelectEndpoint(EXTRAKEY_IN_EPNUM);
|
||||||
while (!Endpoint_IsReadWriteAllowed()) ;
|
while (--timeout && !Endpoint_IsReadWriteAllowed()) ;
|
||||||
Endpoint_Write_Stream_LE(&r, sizeof(report_extra_t), NULL);
|
Endpoint_Write_Stream_LE(&r, sizeof(report_extra_t), NULL);
|
||||||
Endpoint_ClearIN();
|
Endpoint_ClearIN();
|
||||||
}
|
}
|
||||||
@ -364,11 +376,26 @@ static void send_consumer(uint16_t data)
|
|||||||
#define SEND_TIMEOUT 5
|
#define SEND_TIMEOUT 5
|
||||||
int8_t sendchar(uint8_t c)
|
int8_t sendchar(uint8_t c)
|
||||||
{
|
{
|
||||||
|
// Not wait once timeouted.
|
||||||
|
// Because sendchar() is called so many times, waiting each call causes big lag.
|
||||||
|
static bool timeouted = false;
|
||||||
|
|
||||||
if (USB_DeviceState != DEVICE_STATE_Configured)
|
if (USB_DeviceState != DEVICE_STATE_Configured)
|
||||||
return -1;
|
return -1;
|
||||||
|
|
||||||
uint8_t ep = Endpoint_GetCurrentEndpoint();
|
uint8_t ep = Endpoint_GetCurrentEndpoint();
|
||||||
Endpoint_SelectEndpoint(CONSOLE_IN_EPNUM);
|
Endpoint_SelectEndpoint(CONSOLE_IN_EPNUM);
|
||||||
|
if (!Endpoint_IsEnabled() || !Endpoint_IsConfigured()) {
|
||||||
|
Endpoint_SelectEndpoint(ep);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (timeouted && !Endpoint_IsReadWriteAllowed()) {
|
||||||
|
Endpoint_SelectEndpoint(ep);
|
||||||
|
return - 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
timeouted = false;
|
||||||
|
|
||||||
uint8_t timeout = SEND_TIMEOUT;
|
uint8_t timeout = SEND_TIMEOUT;
|
||||||
uint16_t prevFN = USB_Device_GetFrameNumber();
|
uint16_t prevFN = USB_Device_GetFrameNumber();
|
||||||
@ -384,6 +411,7 @@ int8_t sendchar(uint8_t c)
|
|||||||
}
|
}
|
||||||
if (prevFN != USB_Device_GetFrameNumber()) {
|
if (prevFN != USB_Device_GetFrameNumber()) {
|
||||||
if (!(timeout--)) {
|
if (!(timeout--)) {
|
||||||
|
timeouted = true;
|
||||||
Endpoint_SelectEndpoint(ep);
|
Endpoint_SelectEndpoint(ep);
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user