Changes in uspace/drv/usbhub/usbhub.c [e93e319:42a3a57] in mainline

File:

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

uspace/drv/usbhub/usbhub.c

@@ -78 +78 @@
                 async_usleep(1000 * 1000 );/// \TODO proper number once
         }
-        usb_log_error("something in ctrl loop went wrong, errno %d",errorCode);
-
+        dprintf(USB_LOG_LEVEL_ERROR,
+                                "something in ctrl loop went wrong, errno %d",errorCode);
         return 0;
 }
@@ -104 +104 @@
                         hub->device);
         if(opResult != EOK){
-                usb_log_error("could not initialize connection to hc, errno %d",opResult);
+                dprintf(USB_LOG_LEVEL_ERROR,
+                                "could not initialize connection to hc, errno %d",opResult);
                 return opResult;
         }
@@ -111 +112 @@
                         hub->device);
         if(opResult != EOK){
-                usb_log_error("could not initialize connection to device, errno %d",
-                                opResult);
+                dprintf(USB_LOG_LEVEL_ERROR,
+                                "could not initialize connection to device, errno %d",opResult);
                 return opResult;
         }
@@ -119 +120 @@
             &hub->device_connection);
         if(opResult != EOK){
-                usb_log_error("could not initialize connection to device endpoint, errno %d",
-                                opResult);
+                dprintf(USB_LOG_LEVEL_ERROR,
+                                "could not initialize connection to device endpoint, errno %d",opResult);
                 return opResult;
         }
@@ -126 +127 @@
         opResult = usb_endpoint_pipe_probe_default_control(&hub->endpoints.control);
         if (opResult != EOK) {
-                usb_log_error("failed probing endpoint 0, %d", opResult);
+                dprintf(USB_LOG_LEVEL_ERROR, "failed probing endpoint 0, %d", opResult);
                 return opResult;
         }
@@ -150 +151 @@
             &std_descriptor);
         if(opResult!=EOK){
-                usb_log_error("could not get device descriptor, %d",opResult);
-                return opResult;
-        }
-        usb_log_info("hub has %d configurations",
+                dprintf(USB_LOG_LEVEL_ERROR, "could not get device descriptor, %d",opResult);
+                return opResult;
+        }
+        dprintf(USB_LOG_LEVEL_INFO, "hub has %d configurations",
                         std_descriptor.configuration_count);
         if(std_descriptor.configuration_count<1){
-                usb_log_error("THERE ARE NO CONFIGURATIONS AVAILABLE");
+                dprintf(USB_LOG_LEVEL_ERROR, "THERE ARE NO CONFIGURATIONS AVAILABLE");
                 //shouldn`t I return?
         }
@@ -183 +184 @@
                 return opResult;
         }
-        usb_log_debug("\tused configuration %d",
+        dprintf(USB_LOG_LEVEL_DEBUG, "\tused configuration %d",
                         config_descriptor->configuration_number);
 
@@ -199 +200 @@
             &hub->device_connection);
         if (opResult != EOK) {
-                usb_log_error("Failed to initialize status change pipe: %s",
+                dprintf(USB_LOG_LEVEL_ERROR,
+                                "Failed to initialize status change pipe: %s",
                     str_error(opResult));
                 return opResult;
         }
         if (!endpoint_mapping[0].present) {
-                usb_log_error("Not accepting device, " \
+                dprintf(USB_LOG_LEVEL_ERROR,"Not accepting device, " \
                     "cannot understand what is happenning");
                 return EREFUSED;
@@ -233 +235 @@
         result->port_count = -1;
         result->device = device;
-        result->is_default_address_used = false;
 
         //result->usb_device = usb_new(usb_hcd_attached_device_info_t);
@@ -239 +240 @@
 
         // get hub descriptor
-        usb_log_debug("creating serialized descripton");
+        dprintf(USB_LOG_LEVEL_DEBUG, "creating serialized descripton");
         void * serialized_descriptor = malloc(USB_HUB_MAX_DESCRIPTOR_SIZE);
         usb_hub_descriptor_t * descriptor;
-        usb_log_debug("starting control transaction");
+        dprintf(USB_LOG_LEVEL_DEBUG, "starting control transaction");
         usb_endpoint_pipe_start_session(&result->endpoints.control);
         opResult = usb_request_set_configuration(&result->endpoints.control, 1);
@@ -255 +256 @@
 
         if (opResult != EOK) {
-                usb_log_error("failed when receiving hub descriptor, badcode = %d",
-                                opResult);
+                dprintf(USB_LOG_LEVEL_ERROR, "failed when receiving hub descriptor, badcode = %d",opResult);
                 free(serialized_descriptor);
                 free(result);
                 return NULL;
         }
-        usb_log_debug2("deserializing descriptor");
+        dprintf(USB_LOG_LEVEL_DEBUG2, "deserializing descriptor");
         descriptor = usb_deserialize_hub_desriptor(serialized_descriptor);
         if(descriptor==NULL){
-                usb_log_warning("could not deserialize descriptor ");
+                dprintf(USB_LOG_LEVEL_WARNING, "could not deserialize descriptor ");
                 free(result);
                 return NULL;
         }
 
-        usb_log_info("setting port count to %d",descriptor->ports_count);
+        dprintf(USB_LOG_LEVEL_INFO, "setting port count to %d",descriptor->ports_count);
         result->port_count = descriptor->ports_count;
         result->attached_devs = (usb_hc_attached_device_t*)
@@ -278 +278 @@
                 result->attached_devs[i].address=0;
         }
-        usb_log_debug2("freeing data");
+        dprintf(USB_LOG_LEVEL_DEBUG2, "freeing data");
         free(serialized_descriptor);
         free(descriptor->devices_removable);
@@ -285 +285 @@
         //finish
 
-        usb_log_info("hub info created");
+        dprintf(USB_LOG_LEVEL_INFO, "hub info created");
 
         return result;
@@ -296 +296 @@
  */
 int usb_add_hub_device(ddf_dev_t *dev) {
-        usb_log_info("add_hub_device(handle=%d)", (int) dev->handle);
+        dprintf(USB_LOG_LEVEL_INFO, "add_hub_device(handle=%d)", (int) dev->handle);
 
         //dev->ops = &hub_device_ops;
@@ -313 +313 @@
         opResult = usb_hub_process_configuration_descriptors(hub_info);
         if(opResult != EOK){
-                usb_log_error("could not get configuration descriptors, %d",
+                dprintf(USB_LOG_LEVEL_ERROR,"could not get configuration descriptors, %d",
                                 opResult);
                 return opResult;
@@ -324 +324 @@
                 opResult = usb_endpoint_pipe_control_write(&hub_info->endpoints.control,
                                 &request,sizeof(usb_device_request_setup_packet_t), NULL, 0);
-                usb_log_info("powering port %d",port);
+                dprintf(USB_LOG_LEVEL_INFO, "powering port %d",port);
                 if (opResult != EOK) {
-                        usb_log_warning("something went wrong when setting hub`s %dth port", port);
+                        dprintf(USB_LOG_LEVEL_WARNING, "something went wrong when setting hub`s %dth port", port);
                 }
         }
@@ -337 +337 @@
         usb_lst_append(&usb_hub_list, hub_info);
         fibril_mutex_unlock(&usb_hub_list_lock);
-        usb_log_debug("hub info added to list");
-
-        usb_log_debug("adding to ddf");
+        dprintf(USB_LOG_LEVEL_DEBUG, "hub info added to list");
+
+        dprintf(USB_LOG_LEVEL_DEBUG, "adding to ddf");
         ddf_fun_t *hub_fun = ddf_fun_create(dev, fun_exposed, "hub");
         assert(hub_fun != NULL);
@@ -351 +351 @@
         fid_t fid = fibril_create(usb_hub_control_loop, hub_info);
         if (fid == 0) {
-                usb_log_error("failed to start monitoring fibril for new hub");
+                dprintf(USB_LOG_LEVEL_ERROR, 
+                                ": failed to start monitoring fibril for new hub");
                 return ENOMEM;
         }
         fibril_add_ready(fid);
 
-        usb_log_debug("hub fibril created");
+        dprintf(USB_LOG_LEVEL_DEBUG, "hub fibril created");
         //(void)hub_info;
         //usb_hub_check_hub_changes();
         
-        usb_log_info("hub dev added");
+        dprintf(USB_LOG_LEVEL_INFO, "hub dev added");
         //address is lost...
-        usb_log_debug("\taddress %d, has %d ports ",
+        dprintf(USB_LOG_LEVEL_DEBUG, "\taddress %d, has %d ports ",
                         //hub_info->endpoints.control.,
                         hub_info->port_count);
@@ -378 +379 @@
 
 /**
- * release default address used by given hub
- *
- * Also unsets hub->is_default_address_used. Convenience wrapper function.
- * @note hub->connection MUST be open for communication
- * @param hub hub representation
- * @return error code
- */
-static int usb_hub_release_default_address(usb_hub_info_t * hub){
-        int opResult = usb_hc_release_default_address(&hub->connection);
-        if(opResult!=EOK){
-                usb_log_error("could not release default address, errno %d",opResult);
-                return opResult;
-        }
-        hub->is_default_address_used = false;
-        return EOK;
-}
-
-/**
  * Reset the port with new device and reserve the default address.
  * @param hc
@@ -402 +385 @@
  */
 static void usb_hub_init_add_device(usb_hub_info_t * hub, uint16_t port,
-                usb_speed_t speed) {
-        //if this hub already uses default address, it cannot request it once more
-        if(hub->is_default_address_used) return;
-        int opResult = usb_hub_clear_port_feature(&hub->endpoints.control,
-                                port, USB_HUB_FEATURE_C_PORT_CONNECTION);
-        if(opResult != EOK){
-                usb_log_warning("could not clear port-change-connection flag");
-        }
-
+                bool isLowSpeed) {
         usb_device_request_setup_packet_t request;
-        usb_log_info("some connection changed");
+        int opResult;
+        dprintf(USB_LOG_LEVEL_INFO, "some connection changed");
         assert(hub->endpoints.control.hc_phone);
         //get default address
+        usb_speed_t speed = isLowSpeed?USB_SPEED_LOW:USB_SPEED_FULL;
         opResult = usb_hc_reserve_default_address(&hub->connection, speed);
         
         if (opResult != EOK) {
-                usb_log_warning("cannot assign default address, it is probably used %d",
-                                opResult);
-                return;
-        }
-        hub->is_default_address_used = true;
+                dprintf(USB_LOG_LEVEL_WARNING, 
+                                "cannot assign default address, it is probably used %d",opResult);
+                return;
+        }
         //reset port
         usb_hub_set_reset_port_request(&request, port);
@@ -431 +407 @@
                         );
         if (opResult != EOK) {
-                usb_log_error("something went wrong when reseting a port %d",opResult);
+                dprintf(USB_LOG_LEVEL_ERROR, 
+                                "something went wrong when reseting a port %d",opResult);
                 //usb_hub_release_default_address(hc);
-                usb_hub_release_default_address(hub);
-        }
-        return;
+                usb_hc_release_default_address(&hub->connection);
+        }
 }
 
@@ -448 +424 @@
 
         int opResult;
-        usb_log_info("finalizing add device");
+        dprintf(USB_LOG_LEVEL_INFO, "finalizing add device");
         opResult = usb_hub_clear_port_feature(&hub->endpoints.control,
             port, USB_HUB_FEATURE_C_PORT_RESET);
 
         if (opResult != EOK) {
-                usb_log_error("failed to clear port reset feature");
-                usb_hub_release_default_address(hub);
+                dprintf(USB_LOG_LEVEL_ERROR, "failed to clear port reset feature");
+                usb_hc_release_default_address(&hub->connection);
                 return;
         }
@@ -478 +454 @@
                         );
         if (new_device_address < 0) {
-                usb_log_error("failed to get free USB address");
+                dprintf(USB_LOG_LEVEL_ERROR, "failed to get free USB address");
                 opResult = new_device_address;
-                usb_hub_release_default_address(hub);
-                return;
-        }
-        usb_log_info("setting new address %d",new_device_address);
+                usb_hc_release_default_address(&hub->connection);
+                return;
+        }
+        dprintf(USB_LOG_LEVEL_INFO, "setting new address %d",new_device_address);
         //opResult = usb_drv_req_set_address(hc, USB_ADDRESS_DEFAULT,
         //    new_device_address);
@@ -490 +466 @@
         usb_endpoint_pipe_end_session(&new_device_pipe);
         if (opResult != EOK) {
-                usb_log_error("could not set address for new device %d",opResult);
-                usb_hub_release_default_address(hub);
+                dprintf(USB_LOG_LEVEL_ERROR, 
+                                "could not set address for new device %d",opResult);
+                usb_hc_release_default_address(&hub->connection);
                 return;
         }
@@ -497 +474 @@
 
         //opResult = usb_hub_release_default_address(hc);
-        opResult = usb_hub_release_default_address(hub);
+        opResult = usb_hc_release_default_address(&hub->connection);
         if(opResult!=EOK){
                 return;
@@ -509 +486 @@
 
         if (opResult != EOK) {
-                usb_log_error("could not start driver for new device %d",opResult);
+                dprintf(USB_LOG_LEVEL_ERROR, 
+                                "could not start driver for new device %d",opResult);
                 return;
         }
@@ -520 +498 @@
                         &hub->attached_devs[port]);
         if (opResult != EOK) {
-                usb_log_error("could not assign address of device in hcd %d",opResult);
-                return;
-        }
-        usb_log_info("new device address %d, handle %zu",
+                dprintf(USB_LOG_LEVEL_ERROR, 
+                                "could not assign address of device in hcd %d",opResult);
+                return;
+        }
+        dprintf(USB_LOG_LEVEL_INFO, "new device address %d, handle %zu",
             new_device_address, child_handle);
 
@@ -536 +515 @@
 static void usb_hub_removed_device(
     usb_hub_info_t * hub,uint16_t port) {
-
-        int opResult = usb_hub_clear_port_feature(&hub->endpoints.control,
-                                port, USB_HUB_FEATURE_C_PORT_CONNECTION);
-        if(opResult != EOK){
-                usb_log_warning("could not clear port-change-connection flag");
-        }
+                
         /** \TODO remove device from device manager - not yet implemented in
          * devide manager
@@ -559 +533 @@
                  */
         }else{
-                usb_log_warning("this is strange, disconnected device had no address");
+                dprintf(USB_LOG_LEVEL_WARNING, "this is strange, disconnected device had no address");
                 //device was disconnected before it`s port was reset - return default address
-                usb_hub_release_default_address(hub);
-        }
-}
-
-
-/**
- * Process over current condition on port.
+                //usb_drv_release_default_address(hc);
+                usb_hc_release_default_address(&hub->connection);
+        }
+}
+
+
+/**
+ *Process over current condition on port.
  * 
  * Turn off the power on the port.
@@ -580 +555 @@
             port, USB_HUB_FEATURE_PORT_POWER);
         if(opResult!=EOK){
-                usb_log_error("cannot power off port %d;  %d",
+                dprintf(USB_LOG_LEVEL_ERROR, "cannot power off port %d;  %d",
                                 port, opResult);
         }
@@ -593 +568 @@
 static void usb_hub_process_interrupt(usb_hub_info_t * hub, 
         uint16_t port) {
-        usb_log_debug("interrupt at port %d", port);
+        dprintf(USB_LOG_LEVEL_DEBUG, "interrupt at port %d", port);
         //determine type of change
         usb_endpoint_pipe_t *pipe = &hub->endpoints.control;
@@ -612 +587 @@
                         );
         if (opResult != EOK) {
-                usb_log_error("could not get port status");
+                dprintf(USB_LOG_LEVEL_ERROR, "could not get port status");
                 return;
         }
         if (rcvd_size != sizeof (usb_port_status_t)) {
-                usb_log_error("received status has incorrect size");
+                dprintf(USB_LOG_LEVEL_ERROR, "received status has incorrect size");
                 return;
         }
         //something connected/disconnected
         if (usb_port_connect_change(&status)) {
+                opResult = usb_hub_clear_port_feature(pipe,
+                    port, USB_HUB_FEATURE_C_PORT_CONNECTION);
+                // TODO: check opResult
                 if (usb_port_dev_connected(&status)) {
-                        usb_log_info("some connection changed");
-                        usb_hub_init_add_device(hub, port, usb_port_speed(&status));
+                        dprintf(USB_LOG_LEVEL_INFO, "some connection changed");
+                        usb_hub_init_add_device(hub, port, usb_port_low_speed(&status));
                 } else {
                         usb_hub_removed_device(hub, port);
@@ -634 +612 @@
                         usb_hub_over_current(hub,port);
                 }else{
-                        usb_log_info("over current condition was auto-resolved on port %d",
-                                        port);
+                        dprintf(USB_LOG_LEVEL_INFO,
+                                "over current condition was auto-resolved on port %d",port);
                 }
         }
         //port reset
         if (usb_port_reset_completed(&status)) {
-                usb_log_info("port reset complete");
+                dprintf(USB_LOG_LEVEL_INFO, "port reset complete");
                 if (usb_port_enabled(&status)) {
                         usb_hub_finalize_add_device(hub, port, usb_port_low_speed(&status));
                 } else {
-                        usb_log_warning("port reset, but port still not enabled");
+                        dprintf(USB_LOG_LEVEL_WARNING, "port reset, but port still not enabled");
                 }
         }
@@ -653 +631 @@
         usb_port_set_dev_connected(&status, false);
         if (status>>16) {
-                usb_log_info("there was some unsupported change on port %d: %X",
-                                port,status);
-
-        }
-        /// \TODO handle other changes - is there any?
+                dprintf(USB_LOG_LEVEL_INFO, "there was some unsupported change on port %d: %X",port,status);
+
+        }
+        /// \TODO handle other changes
 }
 
@@ -670 +647 @@
         opResult = usb_endpoint_pipe_start_session(&hub_info->endpoints.status_change);
         if(opResult != EOK){
-                usb_log_error("could not initialize communication for hub; %d",
-                                opResult);
+                dprintf(USB_LOG_LEVEL_ERROR,
+                                "could not initialize communication for hub; %d", opResult);
                 return opResult;
         }
@@ -692 +669 @@
         if (opResult != EOK) {
                 free(change_bitmap);
-                usb_log_warning("something went wrong while getting status of hub");
+                dprintf(USB_LOG_LEVEL_WARNING, "something went wrong while getting status of hub");
                 usb_endpoint_pipe_end_session(&hub_info->endpoints.status_change);
                 return opResult;
@@ -699 +676 @@
         opResult = usb_endpoint_pipe_start_session(&hub_info->endpoints.control);
         if(opResult!=EOK){
-                usb_log_error("could not start control pipe session %d", opResult);
+                dprintf(USB_LOG_LEVEL_ERROR, "could not start control pipe session %d",
+                                opResult);
                 usb_endpoint_pipe_end_session(&hub_info->endpoints.status_change);
                 return opResult;
@@ -705 +683 @@
         opResult = usb_hc_connection_open(&hub_info->connection);
         if(opResult!=EOK){
-                usb_log_error("could not start host controller session %d",
+                dprintf(USB_LOG_LEVEL_ERROR, "could not start host controller session %d",
                                 opResult);
                 usb_endpoint_pipe_end_session(&hub_info->endpoints.control);