X-Git-Url: http://git.linex4red.de/pub/USBasp.git/blobdiff_plain/37f8a84f35dadf27a6f8997b675238269f854b45..ab2ae13d81427ddddbd24e8ba6bdfbd2f05ff958:/LUFA/Drivers/USB/LowLevel/DevChapter9.c diff --git a/LUFA/Drivers/USB/LowLevel/DevChapter9.c b/LUFA/Drivers/USB/LowLevel/DevChapter9.c index deaa9c038..7fecd1f54 100644 --- a/LUFA/Drivers/USB/LowLevel/DevChapter9.c +++ b/LUFA/Drivers/USB/LowLevel/DevChapter9.c @@ -117,13 +117,22 @@ void USB_Device_ProcessControlPacket(void) static void USB_Device_SetAddress(void) { + uint8_t DeviceAddress = (USB_ControlRequest.wValue & 0x7F); + Endpoint_ClearSETUP(); Endpoint_ClearIN(); - while (!(Endpoint_IsINReady())); + while (!(Endpoint_IsINReady())) + { + if (USB_DeviceState == DEVICE_STATE_Unattached) + return; + } + + UDADDR = ((1 << ADDEN) | DeviceAddress); - UDADDR = ((1 << ADDEN) | ((uint8_t)USB_ControlRequest.wValue & 0x7F)); + if (DeviceAddress) + USB_DeviceState = DEVICE_STATE_Addressed; return; } @@ -132,8 +141,8 @@ static void USB_Device_SetConfiguration(void) { bool AlreadyConfigured = (USB_ConfigurationNumber != 0); -#if defined(TOTAL_NUM_CONFIGURATIONS) - if ((uint8_t)USB_ControlRequest.wValue > TOTAL_NUM_CONFIGURATIONS) +#if defined(FIXED_NUM_CONFIGURATIONS) + if ((uint8_t)USB_ControlRequest.wValue > FIXED_NUM_CONFIGURATIONS) return; #else #if !defined(USE_FLASH_DESCRIPTORS) && !defined(USE_EEPROM_DESCRIPTORS) && !defined(USE_RAM_DESCRIPTORS) @@ -144,8 +153,9 @@ static void USB_Device_SetConfiguration(void) if (CALLBACK_USB_GetDescriptor((DTYPE_Device << 8), 0, (void*)&DevDescriptorPtr #if !defined(USE_FLASH_DESCRIPTORS) && !defined(USE_EEPROM_DESCRIPTORS) && !defined(USE_RAM_DESCRIPTORS) - , &MemoryAddressSpace) == NO_DESCRIPTOR) + , &MemoryAddressSpace #endif + ) == NO_DESCRIPTOR) { return; } @@ -184,8 +194,17 @@ static void USB_Device_SetConfiguration(void) Endpoint_ClearIN(); - if (!(AlreadyConfigured) && USB_ConfigurationNumber) - EVENT_USB_DeviceEnumerationComplete(); + if (USB_ConfigurationNumber) + { + USB_DeviceState = DEVICE_STATE_Configured; + + if (!(AlreadyConfigured)) + EVENT_USB_DeviceEnumerationComplete(); + } + else + { + USB_DeviceState = DEVICE_STATE_Addressed; + } EVENT_USB_ConfigurationChanged(); } @@ -198,7 +217,12 @@ void USB_Device_GetConfiguration(void) Endpoint_ClearIN(); - while (!(Endpoint_IsOUTReceived())); + while (!(Endpoint_IsOUTReceived())) + { + if (USB_DeviceState == DEVICE_STATE_Unattached) + return; + } + Endpoint_ClearOUT(); } @@ -208,10 +232,10 @@ static void USB_Device_GetInternalSerialDescriptor(void) struct { USB_Descriptor_Header_t Header; - int16_t UnicodeString[12]; + int16_t UnicodeString[20]; } SignatureDescriptor; - uint8_t SigReadAddress = 0x0E; + uint8_t SigReadAddress = 0x0E; bool OddNibbleRead = false; #if defined(USE_NONSTANDARD_DESCRIPTOR_NAMES) @@ -222,7 +246,7 @@ static void USB_Device_GetInternalSerialDescriptor(void) SignatureDescriptor.Header.bDescriptorType = DTYPE_String; #endif - for (uint8_t SerialCharNum = 0; SerialCharNum < 12; SerialCharNum++) + for (uint8_t SerialCharNum = 0; SerialCharNum < 20; SerialCharNum++) { uint8_t SerialByte = boot_signature_byte_get(SigReadAddress); @@ -331,7 +355,12 @@ static void USB_Device_GetStatus(void) Endpoint_ClearIN(); - while (!(Endpoint_IsOUTReceived())); + while (!(Endpoint_IsOUTReceived())) + { + if (USB_DeviceState == DEVICE_STATE_Unattached) + return; + } + Endpoint_ClearOUT(); }