// Clear the data toggle bit to (set to 0) and clear buffers before clear stall of
// the endpoint.
wEPCFG = ISP1581_GetEndpointConfig(endp);
ISP1581_SetEndpointConfig(endp, 0); // disable endpoint *
// Enable endpoint, clear the buffer and set the data toggle bit to 0.
ISP1581_SetEndpointConfig(endp, wEPCFG);
ISP1581_SetEndpointStatus(endp, 0); // clear the Stall condition of the
//endpoint.
Chap9_ControlWriteHandshake();

CONFIGURATION_DESCRIPTOR config_descriptor = {
        SIZEOF_USB_CONFIGURATION_DESCRIPTOR,//...bLength
        USB_CONFIGURATION_DESCRIPTOR_TYPE,  //...bDescriptorType
        CONFIG_DESCRIPTOR_LENGTH,
        0,                             //...wTotalLength
        0x01,                               //...bNumInterfaces
        0x01,                               //...bConfigurationValue
        0x00,                               //...iConfiguration
        0x60,                               //...bmAttributes
        0x01                               //...MaxPower
};  

INTERFACE_DESCRIPTOR interface_descriptor = {
        SIZEOF_USB_INTERFACE_DESCRIPTOR,    //...bLength
        USB_INTERFACE_DESCRIPTOR_TYPE,      //...bDescriptorType
        0x00,                               //...bInterfaceNumber
        0x00,                               //...bAlternateSetting
        NUM_ENDPOINTS,                      //...bNumEndpoints
        USB_CLASS_CODE_TEST_CLASS_DEVICE,   //...bInterfaceClass
        USB_SUBCLASS_CODE_TEST_CLASS,       //...bInterfaceSubClass
        USB_PROTOCOL_CODE_TEST_CLASS,       //...bInterfaceProtocol
        0x00                               //...iInterface
};  

ENDPOINT_DESCRIPTOR EP2_TXDescr = {
        SIZEOF_USB_ENDPOINT_DESCRIPTOR,     //...bLength
        USB_ENDPOINT_DESCRIPTOR_TYPE,       //...bDescriptorType
        0x82,                               //...bEndpointAddress
        USB_ENDPOINT_TYPE_BULK,                 //...bmAttributes
        EP2_PACKET_SIZE&0xff,EP2_PACKET_SIZE/256,//...wMaxPacketSize    
//      0x20,0x3,                           //...wMaxPacketSize
        0x0A                               //...bInterval
};        
        
ENDPOINT_DESCRIPTOR EP2_RXDescr = {
        SIZEOF_USB_ENDPOINT_DESCRIPTOR,     //...bLength
        USB_ENDPOINT_DESCRIPTOR_TYPE,       //...bDescriptorType
        0x02,                               //...bEndpointAddress
        USB_ENDPOINT_TYPE_BULK,                             //...bmAttributes
        EP2_PACKET_SIZE&0xff,EP2_PACKET_SIZE/256,               //...wMaxPacketSize    
//      0x40,0x4,                           //...wMaxPacketSize
        0x0A                               //...bInterval
};

void SetConfig(void)
{
    IntFlag &= ~(1 << ISP_INT_EP0RX);   //USB_Int_Flag.BITS.EP0RX = 0;

    if(ReqUSB->wValue == 0)
    {
        Device_Config_Value = 0;
        
        ep0in_ack();
        wait_ep0tx();
    }
    //else if (ReqUSB->wValue ==  0x0100)
    else if (ReqUSB->wValue ==  0x01)
    {
        Device_Config_Value = (unsigned char)(ReqUSB->wValue);
        
        ep0in_ack();
        wait_ep0tx();
    }
    else
    {
        //WriteByteToISP(ISP_REG_ENDP_INDX, 1);  
        WriteByteToISP(ISP_REG_ENDP_INDX, ISP_ENDP_EP0TX);
        
        CntrlFun |= (1 << ISP_CNTRL_STALL);
        WriteByteToISP(ISP_REG_CNTRL_FUN, CntrlFun);
        
        while (!(IntFlag & (1 << ISP_INT_EP0SET)))
        {
            IntFlag |= ReadByteFromISP(ISP_REG_INT);    
            WriteByteToISP(ISP_REG_INT, IntFlag);  
            if ((IntFlag & (1 << ISP_INT_SUSP)) ||
                (IntFlag & (1 << ISP_INT_RESET)))            
                return;
        }
        IntFlag &= ~(1 << ISP_INT_EP0TX);
    }
}

unsigned int write_endpoint(unsigned char endp, unsigned int lenB,  unsigned char *buf)
{

    unsigned int data;
    WriteByteToISP(ISP_REG_ENDP_INDX, endp);
    WriteByteToISP(ISP_REG_BUFF_LENGTH, lenB);

    SetAddr(ISP_REG_DATA);
    while (lenB)
    {
        data = *buf++;
        data |= *buf++ << 8;
        WriteData(data);
        lenB -= 2;  
    }

    return lenB;
}