stm32f4: Refactor RX FIFO read into its own function; remove RXFLVL
resetting (read only) and masking (no nested ints).
This commit is contained in:
		| @@ -512,11 +512,51 @@ static void transmit_packet(xfer_ctl_t * xfer, USB_OTG_INEndpointTypeDef * in_ep | ||||
|   } | ||||
| } | ||||
|  | ||||
| static void read_rx_fifo(USB_OTG_OUTEndpointTypeDef * out_ep) { | ||||
|   uint32_t * rx_fifo = FIFO_BASE(0); | ||||
|  | ||||
|   // Pop control word off FIFO (completed xfers will have 2 control words, | ||||
|   // we only pop one ctl word each interrupt). | ||||
|   uint32_t ctl_word = USB_OTG_FS->GRXSTSP; | ||||
|   uint8_t pktsts = (ctl_word & USB_OTG_GRXSTSP_PKTSTS_Msk) >> USB_OTG_GRXSTSP_PKTSTS_Pos; | ||||
|   uint8_t epnum = (ctl_word &  USB_OTG_GRXSTSP_EPNUM_Msk) >>  USB_OTG_GRXSTSP_EPNUM_Pos; | ||||
|   uint16_t bcnt = (ctl_word & USB_OTG_GRXSTSP_BCNT_Msk) >> USB_OTG_GRXSTSP_BCNT_Pos; | ||||
|  | ||||
|   switch(pktsts) { | ||||
|     case 0x01: // Global OUT NAK (Interrupt) | ||||
|       break; | ||||
|     case 0x02: // Out packet recvd | ||||
|       { | ||||
|         xfer_ctl_t * xfer = XFER_CTL_BASE(epnum, TUSB_DIR_OUT); | ||||
|         receive_packet(xfer, bcnt); | ||||
|       } | ||||
|       break; | ||||
|     case 0x03: // Out packet done (Interrupt) | ||||
|       break; | ||||
|     case 0x04: // Setup packet done (Interrupt) | ||||
|       out_ep[epnum].DOEPTSIZ |= (1 << USB_OTG_DOEPTSIZ_STUPCNT_Pos); | ||||
|       break; | ||||
|     case 0x06: // Setup packet recvd | ||||
|       { | ||||
|         // For some reason, it's possible to get a mismatch between | ||||
|         // how many setup packets were received versus the location | ||||
|         // of the Setup packet done word. This leads to situations | ||||
|         // where stale setup packets are in the RX FIFO that were received | ||||
|         // after the core loaded the Setup packet done word. Workaround by | ||||
|         // only accepting one setup packet at a time for now. | ||||
|         _setup_packet[0] = (* rx_fifo); | ||||
|         _setup_packet[1] = (* rx_fifo); | ||||
|       } | ||||
|       break; | ||||
|     default: // Invalid, do something here, like breakpoint? | ||||
|       break; | ||||
|   } | ||||
| } | ||||
|  | ||||
| void OTG_FS_IRQHandler(void) { | ||||
|   USB_OTG_DeviceTypeDef * dev = DEVICE_BASE; | ||||
|   USB_OTG_OUTEndpointTypeDef * out_ep = OUT_EP_BASE; | ||||
|   USB_OTG_INEndpointTypeDef * in_ep = IN_EP_BASE; | ||||
|   uint32_t * rx_fifo = FIFO_BASE(0); | ||||
|  | ||||
|   uint32_t int_status = USB_OTG_FS->GINTSTS; | ||||
|  | ||||
| @@ -541,49 +581,7 @@ void OTG_FS_IRQHandler(void) { | ||||
|   } | ||||
|  | ||||
|   if(int_status & USB_OTG_GINTSTS_RXFLVL) { | ||||
|     USB_OTG_FS->GINTSTS = USB_OTG_GINTSTS_RXFLVL; | ||||
|  | ||||
|     // Receive data before reenabling interrupts. | ||||
|     USB_OTG_FS->GINTMSK &= (~USB_OTG_GINTMSK_RXFLVLM); | ||||
|  | ||||
|     // Pop control word off FIFO (completed xfers will have 2 control words, | ||||
|     // we only pop one ctl word each interrupt). | ||||
|     uint32_t ctl_word = USB_OTG_FS->GRXSTSP; | ||||
|     uint8_t pktsts = (ctl_word & USB_OTG_GRXSTSP_PKTSTS_Msk) >> USB_OTG_GRXSTSP_PKTSTS_Pos; | ||||
|     uint8_t epnum = (ctl_word &  USB_OTG_GRXSTSP_EPNUM_Msk) >>  USB_OTG_GRXSTSP_EPNUM_Pos; | ||||
|     uint16_t bcnt = (ctl_word & USB_OTG_GRXSTSP_BCNT_Msk) >> USB_OTG_GRXSTSP_BCNT_Pos; | ||||
|  | ||||
|     switch(pktsts) { | ||||
|       case 0x01: // Global OUT NAK (Interrupt) | ||||
|         break; | ||||
|       case 0x02: // Out packet recvd | ||||
|         { | ||||
|           xfer_ctl_t * xfer = XFER_CTL_BASE(epnum, TUSB_DIR_OUT); | ||||
|           receive_packet(xfer, bcnt); | ||||
|         } | ||||
|         break; | ||||
|       case 0x03: // Out packet done (Interrupt) | ||||
|         break; | ||||
|       case 0x04: // Setup packet done (Interrupt) | ||||
|         out_ep[epnum].DOEPTSIZ |= (1 << USB_OTG_DOEPTSIZ_STUPCNT_Pos); | ||||
|         break; | ||||
|       case 0x06: // Setup packet recvd | ||||
|         { | ||||
|           // For some reason, it's possible to get a mismatch between | ||||
|           // how many setup packets were received versus the location | ||||
|           // of the Setup packet done word. This leads to situations | ||||
|           // where stale setup packets are in the RX FIFO that were received | ||||
|           // after the core loaded the Setup packet done word. Workaround by | ||||
|           // only accepting one setup packet at a time for now. | ||||
|           _setup_packet[0] = (* rx_fifo); | ||||
|           _setup_packet[1] = (* rx_fifo); | ||||
|         } | ||||
|         break; | ||||
|       default: // Invalid, do something here, like breakpoint? | ||||
|         break; | ||||
|     } | ||||
|  | ||||
|     USB_OTG_FS->GINTMSK |= USB_OTG_GINTMSK_RXFLVLM; | ||||
|     read_rx_fifo(out_ep); | ||||
|   } | ||||
|  | ||||
|   // OUT endpoint interrupt handling. | ||||
|   | ||||
		Reference in New Issue
	
	Block a user
	 William D. Jones
					William D. Jones