diff --git a/lib/usb/usb_fx07_common.c b/lib/usb/usb_fx07_common.c
index 234c9c1e..82d8a5a4 100644
--- a/lib/usb/usb_fx07_common.c
+++ b/lib/usb/usb_fx07_common.c
@@ -326,11 +326,11 @@ void stm32fx07_poll(usbd_device *usbd_dev)
 		}
 		REBASE(OTG_GINTSTS) = OTG_FS_GINTSTS_SOF;
 	}
-	
+
 	if (usbd_dev->user_callback_sof) {
-		BBIO_PERIPH(OTG_FS_GINTMSK, OTG_FS_GINTMSK_SOFM) = 1;
+		REBASE(OTG_GINTMSK) |= OTG_FS_GINTMSK_SOFM;
 	} else {
-		BBIO_PERIPH(OTG_FS_GINTMSK, OTG_FS_GINTMSK_SOFM) = 0;
+		REBASE(OTG_GINTMSK) &= ~OTG_FS_GINTMSK_SOFM;
 	}
 }