Changes in uspace/drv/usbhub/utils.c [09daa8b:c1693dae] in mainline

File:

• uspace/drv/usbhub/utils.c (modified) (1 diff)

uspace/drv/usbhub/utils.c

@@ -56 +56 @@
 //hub descriptor utils
 
-void * usb_serialize_hub_descriptor(usb_hub_descriptor_t * descriptor) {
+/**
+ * create uint8_t array with serialized descriptor
+ *
+ * @param descriptor
+ * @return newly created serializd descriptor pointer
+ */
+void * usb_create_serialized_hub_descriptor(usb_hub_descriptor_t * descriptor) {
         //base size
         size_t size = 7;
         //variable size according to port count
-        size_t var_size = descriptor->ports_count / 8 + ((descriptor->ports_count % 8 > 0) ? 1 : 0);
+        size_t var_size = (descriptor->ports_count+7)/8;
         size += 2 * var_size;
-        uint8_t * result = (uint8_t*) malloc(size);
+        uint8_t * result = malloc(size);
         //size
-        result[0] = size;
+        if(result)
+                usb_serialize_hub_descriptor(descriptor,result);
+        return result;
+}
+
+/**
+ * serialize descriptor into given buffer
+ *
+ * The buffer size is not checked.
+ * @param descriptor
+ * @param serialized_descriptor
+ */
+void usb_serialize_hub_descriptor(usb_hub_descriptor_t * descriptor,
+    void * serialized_descriptor) {
+        //base size
+        uint8_t * sdescriptor = serialized_descriptor;
+        size_t size = 7;
+        //variable size according to port count
+        size_t var_size = (descriptor->ports_count+7)/8;
+        size += 2 * var_size;
+        //size
+        sdescriptor[0] = size;
         //descriptor type
-        result[1] = USB_DESCTYPE_HUB;
-        result[2] = descriptor->ports_count;
+        sdescriptor[1] = USB_DESCTYPE_HUB;
+        sdescriptor[2] = descriptor->ports_count;
         /// @fixme handling of endianness??
-        result[3] = descriptor->hub_characteristics / 256;
-        result[4] = descriptor->hub_characteristics % 256;
-        result[5] = descriptor->pwr_on_2_good_time;
-        result[6] = descriptor->current_requirement;
+        sdescriptor[3] = descriptor->hub_characteristics / 256;
+        sdescriptor[4] = descriptor->hub_characteristics % 256;
+        sdescriptor[5] = descriptor->pwr_on_2_good_time;
+        sdescriptor[6] = descriptor->current_requirement;
 
         size_t i;
         for (i = 0; i < var_size; ++i) {
-                result[7 + i] = descriptor->devices_removable[i];
+                sdescriptor[7 + i] = descriptor->devices_removable[i];
         }
         for (i = 0; i < var_size; ++i) {
-                result[7 + var_size + i] = 255;
+                sdescriptor[7 + var_size + i] = 255;
         }
+}
+
+
+/**
+ * create deserialized desriptor structure out of serialized descriptor
+ *
+ * The serialized descriptor must be proper usb hub descriptor,
+ * otherwise an eerror might occur.
+ *
+ * @param sdescriptor serialized descriptor
+ * @return newly created deserialized descriptor pointer
+ */
+usb_hub_descriptor_t * usb_create_deserialized_hub_desriptor(
+void * serialized_descriptor) {
+        uint8_t * sdescriptor = serialized_descriptor;
+
+        if (sdescriptor[1] != USB_DESCTYPE_HUB) {
+                usb_log_warning("trying to deserialize wrong descriptor %x\n",
+                    sdescriptor[1]);
+                return NULL;
+        }
+
+        usb_hub_descriptor_t * result = malloc(sizeof(usb_hub_descriptor_t));
+        if(result)
+                usb_deserialize_hub_desriptor(serialized_descriptor,result);
         return result;
 }
 
-usb_hub_descriptor_t * usb_deserialize_hub_desriptor(void * serialized_descriptor) {
-        uint8_t * sdescriptor = (uint8_t*) serialized_descriptor;
-
-        if (sdescriptor[1] != USB_DESCTYPE_HUB) {
-                usb_log_warning("trying to deserialize wrong descriptor %x\n",sdescriptor[1]);
-                return NULL;
-        }
-
-        usb_hub_descriptor_t * result = usb_new(usb_hub_descriptor_t);
-        
-
-        result->ports_count = sdescriptor[2];
+/**
+ * deserialize descriptor into given pointer
+ * 
+ * @param serialized_descriptor
+ * @param descriptor
+ * @return
+ */
+void usb_deserialize_hub_desriptor(
+void * serialized_descriptor, usb_hub_descriptor_t * descriptor) {
+        uint8_t * sdescriptor = serialized_descriptor;
+        descriptor->ports_count = sdescriptor[2];
         /// @fixme handling of endianness??
-        result->hub_characteristics = sdescriptor[4] + 256 * sdescriptor[3];
-        result->pwr_on_2_good_time = sdescriptor[5];
-        result->current_requirement = sdescriptor[6];
-        size_t var_size = result->ports_count / 8 + ((result->ports_count % 8 > 0)
-                        ? 1 : 0);
-        result->devices_removable = (uint8_t*) malloc(var_size);
+        descriptor->hub_characteristics = sdescriptor[4] + 256 * sdescriptor[3];
+        descriptor->pwr_on_2_good_time = sdescriptor[5];
+        descriptor->current_requirement = sdescriptor[6];
+        size_t var_size = (descriptor->ports_count+7) / 8;
+        //descriptor->devices_removable = (uint8_t*) malloc(var_size);
 
         size_t i;
         for (i = 0; i < var_size; ++i) {
-                result->devices_removable[i] = sdescriptor[7 + i];
+                descriptor->devices_removable[i] = sdescriptor[7 + i];
         }
-        return result;
 }
-
-
 
 /**