fix: add clearing interrupts

This commit is contained in:
doryan 2025-02-13 00:29:02 +04:00
parent 9b4f758045
commit 30850a473d

View File

@ -161,9 +161,8 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
let (udint, udien, usbint) = (usb.udint.read(), usb.udien.read(), usb.usbint.read()); let (udint, udien, usbint) = (usb.udint.read(), usb.udien.read(), usb.usbint.read());
if usbint.vbusti().bit_is_set() { if usbint.vbusti().bit_is_set() {
usb.usbint.write(|w| usb.usbint
// unsafe { w.bits(0x01) } .write(|w| unsafe { w.bits(0x01) }.vbusti().clear_bit());
w.vbusti().clear_bit());
if usb.usbsta.read().vbus().bit_is_set() { if usb.usbsta.read().vbus().bit_is_set() {
return PollResult::Resume; return PollResult::Resume;
} else { } else {
@ -184,9 +183,8 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
} }
if udint.sofi().bit_is_set() { if udint.sofi().bit_is_set() {
usb.udint.write(|w| usb.udint
// unsafe { w.bits(0x7d) } .write(|w| unsafe { w.bits(0x7d) }.sofi().clear_bit());
w.sofi().clear_bit());
} }
if usb.usbcon.read().frzclk().bit_is_clear() { if usb.usbcon.read().frzclk().bit_is_clear() {
@ -250,8 +248,11 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
} }
usb.ueintx.write(|w| { usb.ueintx.write(|w| {
/* unsafe { w.bits(0xdf) } */ unsafe { w.bits(0xdf) }
w.rxouti().clear_bit().rxstpi().clear_bit() .rxouti()
.clear_bit()
.rxstpi()
.clear_bit()
}); });
Ok(buf_size) Ok(buf_size)
@ -259,9 +260,8 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
if usb.ueintx.read().rxouti().bit_is_clear() { if usb.ueintx.read().rxouti().bit_is_clear() {
return Err(UsbError::WouldBlock); return Err(UsbError::WouldBlock);
} }
usb.ueintx.write(|w| usb.ueintx
// unsafe { w.bits(0xdf) } .write(|w| unsafe { w.bits(0xdf) }.rxouti().clear_bit());
w.rxouti().clear_bit());
let mut bytes_read = 0; let mut bytes_read = 0;
for slot in buf { for slot in buf {
@ -276,9 +276,8 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
return Err(UsbError::BufferOverflow); return Err(UsbError::BufferOverflow);
} }
usb.ueintx.write(|w| usb.ueintx
// unsafe { w.bits(0xdf) } .write(|w| unsafe { w.bits(0xdf) }.fifocon().clear_bit());
w.fifocon().clear_bit());
Ok(bytes_read) Ok(bytes_read)
} }
} }
@ -298,8 +297,11 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
// Clear resume informations. // // Clear resume informations. //
usb.udint.write(|w| { usb.udint.write(|w| {
// unsafe { w.bits(0x7d) } unsafe { w.bits(0x7d) }
w.wakeupi().clear_bit().suspi().clear_bit() .wakeupi()
.clear_bit()
.suspi()
.clear_bit()
}); });
usb.udien usb.udien
@ -323,8 +325,11 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
usb.usbcon.modify(|_, w| w.frzclk().clear_bit()); usb.usbcon.modify(|_, w| w.frzclk().clear_bit());
usb.udint.write(|w| { usb.udint.write(|w| {
// unsafe { w.bits(0x7d) } unsafe { w.bits(0x7d) }
w.wakeupi().clear_bit().suspi().clear_bit() .wakeupi()
.clear_bit()
.suspi()
.clear_bit()
}); });
usb.udien usb.udien
@ -364,8 +369,11 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
let (usb, pll) = (self.usb.borrow(cs), self.pll.borrow(cs)); let (usb, pll) = (self.usb.borrow(cs), self.pll.borrow(cs));
usb.udint.write(|w| { usb.udint.write(|w| {
// unsafe { w.bits(0x7d) } unsafe { w.bits(0x7d) }
w.wakeupi().clear_bit().suspi().clear_bit() .wakeupi()
.clear_bit()
.suspi()
.clear_bit()
}); });
// Suspend. // // Suspend. //
@ -407,16 +415,18 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
usb.uedatx.write(|w| w.bits(byte)); usb.uedatx.write(|w| w.bits(byte));
} }
usb.ueintx.write(|w| usb.ueintx
// unsafe { w.bits(0xdf) } .write(|w| unsafe { w.bits(0xdf) }.txini().clear_bit());
w.txini().clear_bit());
} else { } else {
if usb.ueintx.read().txini().bit_is_clear() { if usb.ueintx.read().txini().bit_is_clear() {
return Err(UsbError::WouldBlock); return Err(UsbError::WouldBlock);
} }
usb.ueintx.write(|w| { usb.ueintx.write(|w| {
// unsafe { w.bits(0xdf) } unsafe { w.bits(0xdf) }
w.txini().clear_bit().rxouti().clear_bit() .txini()
.clear_bit()
.rxouti()
.clear_bit()
}); });
for &byte in buf { for &byte in buf {
@ -428,8 +438,11 @@ impl<const L: usize> UsbBus for UsbDevice<L> {
} }
usb.ueintx.write(|w| { usb.ueintx.write(|w| {
// unsafe { w.bits(0xdf) } unsafe { w.bits(0xdf) }
w.rxouti().clear_bit().fifocon().clear_bit() .rxouti()
.clear_bit()
.fifocon()
.clear_bit()
}); });
} }