fix: add clearing interrupts
This commit is contained in:
parent
9b4f758045
commit
30850a473d
67
src/lib.rs
67
src/lib.rs
|
@ -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()
|
||||||
});
|
});
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue