Не могу передать пакеты хосту по усб, at91sam7s256 Опции

[Bulat]

Использую стандартную прошивку AT91SAM7S256-USART_USB_SAM7S-IAR4_31A-1_00 для связи контроллера с усб, только переписал дескрипторы,
чтобы работала с моим драйвером и убрал код связанный с усарт. Нумерация проходит нормально. Writefile тоже работает. Пакеты благополучно
доставляются моему девайсу. Не могу реализовать передачу пакетов от девайса хосту. Readfile возвращает ошибку.
В стандартной прошивке в файле cdc_enumerate.c я нашел функцию AT91F_UDP_IsConfigured(AT91PS_CDC pCdc), которая, как я понял отвечает за обработку
источников прерываний isr. Туда я добавил свой код, кот обрабатывает прерывания от ер1 и ер2 (ер1 - in, ep2 - out).
Вот этот код:

Код

//*----------------------------------------------------------------------------
//* \fn    AT91F_UDP_IsConfigured
//* \brief Test if the device is configured and handle enumeration
//*----------------------------------------------------------------------------
static uchar AT91F_UDP_IsConfigured(AT91PS_CDC pCdc)
{
    AT91PS_UDP pUDP = pCdc->pUdp;
    AT91_REG isr = pUDP->UDP_ISR;

    if (isr & AT91C_UDP_ENDBUSRES) {
        pUDP->UDP_ICR = AT91C_UDP_ENDBUSRES;
        // reset all endpoints
        pUDP->UDP_RSTEP  = (unsigned int)-1;
        pUDP->UDP_RSTEP  = 0;
        // Enable the function
        pUDP->UDP_FADDR = AT91C_UDP_FEN;
        // Configure endpoint 0
        pUDP->UDP_CSR[0] = (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_CTRL);
    }
    else if (isr & AT91C_UDP_EPINT0) {
        pUDP->UDP_ICR = AT91C_UDP_EPINT0;
        AT91F_CDC_Enumerate(pCdc);
    }
             else if (isr & AT91C_UDP_EPINT1){
             pUDP->UDP_ICR = AT91C_UDP_EPINT1;
         pUDP->UDP_CSR[1]=0; //подтверждает, что хост принял данные
             }
                  else if (isr & AT91C_UDP_EPINT2){
                  pUDP->UDP_ICR = AT91C_UDP_EPINT2;
                  AT91F_CDC_ReadData(pCdc);
                  }  
    return pCdc->currentConfiguration;
}

Т.е. при получении данных от хоста возникает прерывание от ер2 и вызывается функция AT91F_CDC_ReadData(pCdc). Ее код приведен ниже:

Код

  extern struct _AT91S_CDC     pCDC;
  static char adrRT[64];
  AT91PS_UDP pUDP = pCdc->pUdp;
  
  pCDC.Read(&pCDC, adrRT,64);
  uint nbytes = AT91F_UDP_Read(pCdc, adrRT, 64);
  pUDP->UDP_CSR[2]=pUDP->UDP_CSR[2]&0x7FFFFFD;/*сброс бита  RX_DATA_BK0 -
подтвердение того, что данные из FIFO считаны*/  
  static char CWord[64];
  CWord[1] = nbytes;
  pCDC.Write(&pCDC,CWord,64);

Т.е. я считываю данные из буфера, а потом пытаюсь передать количество полученных байт обратно на хост, но они не передаются, т.к. device monitoring studio не показывает принятых байт от моего девайса.

Привожу код функции main() из файла main.c

Код

// Enable User Reset and set its minimal assertion to 960 us
     AT91C_BASE_RSTC->RSTC_RMR = AT91C_RSTC_URSTEN | (0x4<<8) | (unsigned int)(0xA5<<24);
    
    // Init USB device
    AT91F_USB_Open();
    // Init USB device
    // Wait for the end of enumeration
    while (!pCDC.IsConfigured(&pCDC));  
    
    while(1);

Как правильно воспользоваться этой стандартной прошивкой, чтобы считывать и записывать данные в конечные точки? Может я свой код не туда добавил, вроде кроме как в AT91F_UDP_IsConfigured(AT91PS_CDC pCdc) и некуда, она же прерывания обрабатывает или я не прав?

[KAlex]

Как правильно воспользоваться этой стандартной прошивкой, чтобы считывать и записывать данные в конечные точки? Может я свой код не туда добавил, вроде кроме как в AT91F_UDP_IsConfigured(AT91PS_CDC pCdc) и некуда, она же прерывания обрабатывает или я не прав?

AT91F_UDP_IsConfigured не обрабатывает прерывания.
Сконфигурируйте в main прерывания от EP0, что то типа этого:
if (HID.IsConfigured(&HID)) {
HID.pUdp->UDP_ICR = 0xff00;
AT91F_UDP_DisableIt ( HID.pUdp, 0xFFFF);
AT91F_UDP_EnableIt ( HID.pUdp, AT91C_UDP_EPINT2);
AT91F_AIC_ConfigureIt ( AT91C_BASE_AIC, AT91C_ID_UDP, UDP_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE, udp_c_irq_handler);
AT91F_AIC_EnableIt (AT91C_BASE_AIC, AT91C_ID_UDP);}

Обработка прерывания:
__ramfunc __arm void udp_c_irq_handler(void){
AT91PS_UDP pUdp = HID.pUdp;
u_int packetSize, nbBytesRcv = 0, currentReceiveBank = HID.currentRcvBank;
pUdp->UDP_CSR[AT91C_EP_OUT] &= ~(AT91C_UDP_TXCOMP | AT91C_UDP_RXSETUP | AT91C_UDP_ISOERROR );

while (length_in) {
if ( pUdp->UDP_CSR[AT91C_EP_OUT] & (AT91C_UDP_RX_DATA_BK0 | AT91C_UDP_RX_DATA_BK1) ) {
packetSize = MIN(pUdp->UDP_CSR[AT91C_EP_OUT] >> 16, length_in);
length_in -= packetSize;
if (packetSize < AT91C_EP_OUT_SIZE)
length_in = 0;
while(packetSize--)
data_in[nbBytesRcv++] = pUdp->UDP_FDR[AT91C_EP_OUT];
pUdp->UDP_CSR[AT91C_EP_OUT] &= ~(currentReceiveBank);
if (currentReceiveBank == AT91C_UDP_RX_DATA_BK0)
currentReceiveBank = AT91C_UDP_RX_DATA_BK1;
else
currentReceiveBank = AT91C_UDP_RX_DATA_BK0;

}
}
// Write_ack(); //Если надо.
HID.currentRcvBank = currentReceiveBank;
}

[Bulat]

AT91F_UDP_IsConfigured не обрабатывает прерывания.
Сконфигурируйте в main прерывания от EP0, что то типа этого:
if (HID.IsConfigured(&HID)) {
HID.pUdp->UDP_ICR = 0xff00;
AT91F_UDP_DisableIt ( HID.pUdp, 0xFFFF);
AT91F_UDP_EnableIt ( HID.pUdp, AT91C_UDP_EPINT2);
AT91F_AIC_ConfigureIt ( AT91C_BASE_AIC, AT91C_ID_UDP, UDP_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE, udp_c_irq_handler);
AT91F_AIC_EnableIt (AT91C_BASE_AIC, AT91C_ID_UDP);}

Обработка прерывания:
__ramfunc __arm void udp_c_irq_handler(void){
AT91PS_UDP pUdp = HID.pUdp;
u_int packetSize, nbBytesRcv = 0, currentReceiveBank = HID.currentRcvBank;
pUdp->UDP_CSR[AT91C_EP_OUT] &= ~(AT91C_UDP_TXCOMP | AT91C_UDP_RXSETUP | AT91C_UDP_ISOERROR );

while (length_in) {
if ( pUdp->UDP_CSR[AT91C_EP_OUT] & (AT91C_UDP_RX_DATA_BK0 | AT91C_UDP_RX_DATA_BK1) ) {
packetSize = MIN(pUdp->UDP_CSR[AT91C_EP_OUT] >> 16, length_in);
length_in -= packetSize;
if (packetSize < AT91C_EP_OUT_SIZE)
length_in = 0;
while(packetSize--)
data_in[nbBytesRcv++] = pUdp->UDP_FDR[AT91C_EP_OUT];
pUdp->UDP_CSR[AT91C_EP_OUT] &= ~(currentReceiveBank);
if (currentReceiveBank == AT91C_UDP_RX_DATA_BK0)
currentReceiveBank = AT91C_UDP_RX_DATA_BK1;
else
currentReceiveBank = AT91C_UDP_RX_DATA_BK0;

}
}
// Write_ack(); //Если надо.
HID.currentRcvBank = currentReceiveBank;
}

Спасибо, но хотелось бы еще посмотреть на пример кода осуществляющий запись данных в конечную точку EP_IN, для передачи их хосту.
Да и еще вопрос. В функции AT91F_AIC_ConfigureIt ( AT91C_BASE_AIC, AT91C_ID_UDP, UDP_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE, udp_c_irq_handler) не определены параметры UDP_INTERRUPT_LEVEL и AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE. Где они определяются?

[KAlex]

Спасибо, но хотелось бы еще посмотреть на пример кода осуществляющий запись данных в конечную точку EP_IN, для передачи их хосту.

__ramfunc __arm u_int AT91F_UDP_Write(AT91PS_HID pCdc, char *pData, u_int length){
AT91PS_UDP pUdp = pCdc->pUdp;
u_int cpt = 0;
if (length)
while ( (pUdp->UDP_CSR[AT91C_EP_IN] & AT91C_UDP_TXPKTRDY) && !(pUdp->UDP_ISR & AT91C_UDP_RXSUSP) );
// Send the first packet
cpt = MIN(length, FTDI_EP_IN_SIZE);
length -= cpt;
while (cpt--) pUdp->UDP_FDR[AT91C_EP_IN] = *pData++;
pUdp->UDP_CSR[AT91C_EP_IN] |= AT91C_UDP_TXPKTRDY;
while (length) {
// Fill the second bank
cpt = MIN(length, FTDI_EP_IN_SIZE);
length -= cpt;
while ( (pUdp->UDP_CSR[AT91C_EP_IN] & AT91C_UDP_TXPKTRDY) && !(pUdp->UDP_ISR & AT91C_UDP_RXSUSP) );
if ( pUdp->UDP_ISR & AT91C_UDP_RXSUSP ) return length;
while (cpt--) pUdp->UDP_FDR[AT91C_EP_IN] = *pData++;
// Wait for the the first bank to be sent
while ( !(pUdp->UDP_CSR[AT91C_EP_IN] & AT91C_UDP_TXCOMP) )
if ( !AT91F_UDP_IsConfigured(pCdc) )
return length;
pUdp->UDP_CSR[AT91C_EP_IN] &= ~(AT91C_UDP_TXCOMP);
while (pUdp->UDP_CSR[AT91C_EP_IN] & AT91C_UDP_TXCOMP);
pUdp->UDP_CSR[AT91C_EP_IN] |= AT91C_UDP_TXPKTRDY;
}
// Wait for the end of transfer
while ( !(pUdp->UDP_CSR[AT91C_EP_IN] & AT91C_UDP_TXCOMP) ){
if ( !AT91F_UDP_IsConfigured(pCdc) )
return length;
};
pUdp->UDP_CSR[AT91C_EP_IN] &= ~(AT91C_UDP_TXCOMP);
while (pUdp->UDP_CSR[AT91C_EP_IN] & AT91C_UDP_TXCOMP);

return length;
}

Для ускоренной передачи пакетов не более 64 байта:
__ramfunc __arm void AT91F_UDP_Write64(AT91PS_HID pCdc, char *pData, char length){
AT91PS_UDP pUdp = pCdc->pUdp;
while ( (pUdp->UDP_CSR[AT91C_EP_IN] & AT91C_UDP_TXPKTRDY) && !(pUdp->UDP_ISR & AT91C_UDP_RXSUSP) );
pUdp->UDP_CSR[AT91C_EP_IN] &= ~(AT91C_UDP_TXCOMP);

while (length--) pUdp->UDP_FDR[AT91C_EP_IN] = *pData++;
pUdp->UDP_CSR[AT91C_EP_IN] |= AT91C_UDP_TXPKTRDY;
}

Да и еще вопрос. В функции AT91F_AIC_ConfigureIt ( AT91C_BASE_AIC, AT91C_ID_UDP, UDP_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE, udp_c_irq_handler) не определены параметры UDP_INTERRUPT_LEVEL и AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE. Где они определяются?

Делается один раз в main:
if (HID.IsConfigured(&HID)) {
HID.pUdp->UDP_ICR = 0xff00;
AT91F_UDP_DisableIt ( HID.pUdp, 0xFFFF);
AT91F_UDP_EnableIt ( HID.pUdp, AT91C_UDP_EPINT2);
AT91F_AIC_ConfigureIt ( AT91C_BASE_AIC, AT91C_ID_UDP, UDP_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE, udp_c_irq_handler);
AT91F_AIC_EnableIt (AT91C_BASE_AIC, AT91C_ID_UDP);
}