diff --git a/sys/dev/usb2/core/usb2_generic.c b/sys/dev/usb2/core/usb2_generic.c index 9e5b34b8cea..1b3c316b605 100644 --- a/sys/dev/usb2/core/usb2_generic.c +++ b/sys/dev/usb2/core/usb2_generic.c @@ -1699,11 +1699,12 @@ ugen_set_power_mode(struct usb2_fifo *f, int mode) } switch (mode) { case USB_POWER_MODE_OFF: - /* clear suspend */ - err = usb2_req_clear_port_feature(udev->parent_hub, - NULL, udev->port_no, UHF_PORT_SUSPEND); - if (err) - break; + /* get the device unconfigured */ + err = ugen_set_config(f, USB_UNCONFIG_INDEX); + if (err) { + DPRINTFN(0, "Could not unconfigure " + "device (ignored)\n"); + } /* clear port enable */ err = usb2_req_clear_port_feature(udev->parent_hub, diff --git a/sys/dev/usb2/core/usb2_hub.c b/sys/dev/usb2/core/usb2_hub.c index 0d08b9484f4..b5847752680 100644 --- a/sys/dev/usb2/core/usb2_hub.c +++ b/sys/dev/usb2/core/usb2_hub.c @@ -1823,7 +1823,8 @@ void usb2_set_power_mode(struct usb2_device *udev, uint8_t power_mode) { /* filter input argument */ - if (power_mode != USB_POWER_MODE_ON) { + if ((power_mode != USB_POWER_MODE_ON) && + (power_mode != USB_POWER_MODE_OFF)) { power_mode = USB_POWER_MODE_SAVE; } udev->power_mode = power_mode; /* update copy of power mode */