Fix USB OTG bug

* See comment in source file