fix: split rp2 ep packet id reset

Author: mikesmitty

src/machine/machine_rp2_usb.go

@@ -139,11 +139,22 @@ func handleEndpointRx(ep uint32) []byte {
 // AckUsbOutTransfer is called to acknowledge the completion of a USB OUT transfer.
 func AckUsbOutTransfer(ep uint32) {
 	ep = ep & 0x7F
-	setEPDataPID(ep, !outEpXdata0[ep])
+	setEPOutDataPID(ep, !outEpXdata0[ep])
 }
 
 // Set the USB endpoint Packet ID to DATA0 or DATA1.
-func setEPDataPID(ep uint32, dataOne bool) {
+func setEPInDataPID(ep uint32, dataOne bool) {
+	ep = ep & 0x7F
+	inEpXdata0[ep] = dataOne
+	if inEpXdata0[ep] || ep == 0 {
+		_usbDPSRAM.EPxBufferControl[ep].In.SetBits(usbBuf0CtrlData1Pid)
+	}
+
+	_usbDPSRAM.EPxBufferControl[ep].Out.SetBits(usbBuf0CtrlAvail)
+}
+
+// Set the USB endpoint Packet ID to DATA0 or DATA1.
+func setEPOutDataPID(ep uint32, dataOne bool) {
 	outEpXdata0[ep] = dataOne
 	if outEpXdata0[ep] || ep == 0 {
 		_usbDPSRAM.EPxBufferControl[ep].Out.SetBits(usbBuf0CtrlData1Pid)
@@ -205,7 +216,7 @@ func (dev *USBDevice) ClearStallEPIn(ep uint32) {
 	_usbDPSRAM.EPxBufferControl[ep].In.ClearBits(val)
 	if inEpXPIDReset[ep] {
 		// Reset the PID to DATA0
-		setEPDataPID(ep, false)
+		setEPInDataPID(ep, false)
 	}
 }
 
@@ -216,7 +227,7 @@ func (dev *USBDevice) ClearStallEPOut(ep uint32) {
 	_usbDPSRAM.EPxBufferControl[ep].Out.ClearBits(val)
 	if outEpXPIDReset[ep] {
 		// Reset the PID to DATA0
-		setEPDataPID(ep, false)
+		setEPOutDataPID(ep, false)
 	}
 }