Changes in uspace/drv/usbhub/usbhub.c [ffca03c:7d521e24] in mainline

File:

• uspace/drv/usbhub/usbhub.c (modified) (4 diffs)

uspace/drv/usbhub/usbhub.c

@@ -67 +67 @@
     usb_hub_status_t status);
 
-static int usb_process_hub_local_power_change(usb_hub_info_t * hub_info,
+static int usb_process_hub_power_change(usb_hub_info_t * hub_info,
     usb_hub_status_t status);
 
@@ -386 +386 @@
         int opResult;
         if (usb_hub_is_status(status,USB_HUB_FEATURE_HUB_OVER_CURRENT)){
-                //poweroff all ports
-                unsigned int port;
-                for(port = 1;port <= hub_info->port_count;++port){
-                        opResult = usb_hub_clear_port_feature(
-                            hub_info->control_pipe,port,
-                            USB_HUB_FEATURE_PORT_POWER);
-                        if (opResult != EOK) {
-                                usb_log_warning(
-                                    "cannot power off port %d;  %d\n",
-                                    port, opResult);
-                        }
+                opResult = usb_hub_clear_feature(hub_info->control_pipe,
+                    USB_HUB_FEATURE_HUB_LOCAL_POWER);
+                if (opResult != EOK) {
+                        usb_log_error("cannot power off hub: %d\n",
+                            opResult);
                 }
         } else {
-                //power all ports
-                unsigned int port;
-                for(port = 1;port <= hub_info->port_count;++port){
-                        opResult = usb_hub_set_port_feature(
-                            hub_info->control_pipe,port,
-                            USB_HUB_FEATURE_PORT_POWER);
-                        if (opResult != EOK) {
-                                usb_log_warning(
-                                    "cannot power off port %d;  %d\n",
-                                    port, opResult);
-                        }
+                opResult = usb_hub_set_feature(hub_info->control_pipe,
+                    USB_HUB_FEATURE_HUB_LOCAL_POWER);
+                if (opResult != EOK) {
+                        usb_log_error("cannot power on hub: %d\n",
+                            opResult);
                 }
         }
@@ -416 +404 @@
 
 /**
- * process hub local power change
- *
- * This change is ignored.
+ * process hub power change
+ *
+ * If the power has been lost, reestablish it.
+ * If it was reestablished, re-power all ports.
  * @param hub_info hub instance
  * @param status hub status bitmask
  * @return error code
  */
-static int usb_process_hub_local_power_change(usb_hub_info_t * hub_info,
+static int usb_process_hub_power_change(usb_hub_info_t * hub_info,
     usb_hub_status_t status) {
         int opResult = EOK;
+        if (!usb_hub_is_status(status,USB_HUB_FEATURE_HUB_LOCAL_POWER)) {
+                //restart power on hub
+                opResult = usb_hub_set_feature(hub_info->control_pipe,
+                    USB_HUB_FEATURE_HUB_LOCAL_POWER);
+                if (opResult != EOK) {
+                        usb_log_error("cannot power on hub: %d\n",
+                            opResult);
+                }
+        } else {//power reestablished on hub- restart ports
+                size_t port;
+                for (port = 1; port <= hub_info->port_count; ++port) {
+                        opResult = usb_hub_set_port_feature(
+                            hub_info->control_pipe,
+                            port, USB_HUB_FEATURE_PORT_POWER);
+                        if (opResult != EOK) {
+                                usb_log_error("Cannot power on port %zu: %s.\n",
+                                    port, str_error(opResult));
+                        }
+                }
+        }
+        if(opResult!=EOK){
+                return opResult;//no feature clearing
+        }
         opResult = usb_hub_clear_feature(hub_info->control_pipe,
             USB_HUB_FEATURE_C_HUB_LOCAL_POWER);
@@ -475 +487 @@
         if (
             usb_hub_is_status(status,16+USB_HUB_FEATURE_C_HUB_LOCAL_POWER)) {
-                usb_process_hub_local_power_change(hub_info, status);
+                usb_process_hub_power_change(hub_info, status);
         }
 }