Changes in uspace/drv/usbhub/utils.c [c1693dae:f35b294] in mainline
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/usbhub/utils.c
rc1693dae rf35b294 56 56 //hub descriptor utils 57 57 58 /** 59 * create uint8_t array with serialized descriptor 60 * 61 * @param descriptor 62 * @return newly created serializd descriptor pointer 63 */ 64 void * usb_create_serialized_hub_descriptor(usb_hub_descriptor_t * descriptor) { 58 void * usb_serialize_hub_descriptor(usb_hub_descriptor_t * descriptor) { 65 59 //base size 66 60 size_t size = 7; … … 70 64 uint8_t * result = malloc(size); 71 65 //size 72 if(result) 73 usb_serialize_hub_descriptor(descriptor,result); 66 result[0] = size; 67 //descriptor type 68 result[1] = USB_DESCTYPE_HUB; 69 result[2] = descriptor->ports_count; 70 /// @fixme handling of endianness?? 71 result[3] = descriptor->hub_characteristics / 256; 72 result[4] = descriptor->hub_characteristics % 256; 73 result[5] = descriptor->pwr_on_2_good_time; 74 result[6] = descriptor->current_requirement; 75 76 size_t i; 77 for (i = 0; i < var_size; ++i) { 78 result[7 + i] = descriptor->devices_removable[i]; 79 } 80 for (i = 0; i < var_size; ++i) { 81 result[7 + var_size + i] = 255; 82 } 74 83 return result; 75 84 } 76 85 77 /** 78 * serialize descriptor into given buffer 79 * 80 * The buffer size is not checked. 81 * @param descriptor 82 * @param serialized_descriptor 83 */ 84 void usb_serialize_hub_descriptor(usb_hub_descriptor_t * descriptor, 85 void * serialized_descriptor) { 86 //base size 87 uint8_t * sdescriptor = serialized_descriptor; 88 size_t size = 7; 89 //variable size according to port count 90 size_t var_size = (descriptor->ports_count+7)/8; 91 size += 2 * var_size; 92 //size 93 sdescriptor[0] = size; 94 //descriptor type 95 sdescriptor[1] = USB_DESCTYPE_HUB; 96 sdescriptor[2] = descriptor->ports_count; 97 /// @fixme handling of endianness?? 98 sdescriptor[3] = descriptor->hub_characteristics / 256; 99 sdescriptor[4] = descriptor->hub_characteristics % 256; 100 sdescriptor[5] = descriptor->pwr_on_2_good_time; 101 sdescriptor[6] = descriptor->current_requirement; 102 103 size_t i; 104 for (i = 0; i < var_size; ++i) { 105 sdescriptor[7 + i] = descriptor->devices_removable[i]; 106 } 107 for (i = 0; i < var_size; ++i) { 108 sdescriptor[7 + var_size + i] = 255; 109 } 110 } 111 112 113 /** 114 * create deserialized desriptor structure out of serialized descriptor 115 * 116 * The serialized descriptor must be proper usb hub descriptor, 117 * otherwise an eerror might occur. 118 * 119 * @param sdescriptor serialized descriptor 120 * @return newly created deserialized descriptor pointer 121 */ 122 usb_hub_descriptor_t * usb_create_deserialized_hub_desriptor( 86 usb_hub_descriptor_t * usb_deserialize_hub_desriptor( 123 87 void * serialized_descriptor) { 124 88 uint8_t * sdescriptor = serialized_descriptor; … … 131 95 132 96 usb_hub_descriptor_t * result = malloc(sizeof(usb_hub_descriptor_t)); 133 if(result) 134 usb_deserialize_hub_desriptor(serialized_descriptor,result); 97 98 99 result->ports_count = sdescriptor[2]; 100 /// @fixme handling of endianness?? 101 result->hub_characteristics = sdescriptor[4] + 256 * sdescriptor[3]; 102 result->pwr_on_2_good_time = sdescriptor[5]; 103 result->current_requirement = sdescriptor[6]; 104 size_t var_size = (result->ports_count+7) / 8; 105 result->devices_removable = (uint8_t*) malloc(var_size); 106 107 size_t i; 108 for (i = 0; i < var_size; ++i) { 109 result->devices_removable[i] = sdescriptor[7 + i]; 110 } 135 111 return result; 136 112 } 137 113 138 /**139 * deserialize descriptor into given pointer140 *141 * @param serialized_descriptor142 * @param descriptor143 * @return144 */145 void usb_deserialize_hub_desriptor(146 void * serialized_descriptor, usb_hub_descriptor_t * descriptor) {147 uint8_t * sdescriptor = serialized_descriptor;148 descriptor->ports_count = sdescriptor[2];149 /// @fixme handling of endianness??150 descriptor->hub_characteristics = sdescriptor[4] + 256 * sdescriptor[3];151 descriptor->pwr_on_2_good_time = sdescriptor[5];152 descriptor->current_requirement = sdescriptor[6];153 size_t var_size = (descriptor->ports_count+7) / 8;154 //descriptor->devices_removable = (uint8_t*) malloc(var_size);155 114 156 size_t i;157 for (i = 0; i < var_size; ++i) {158 descriptor->devices_removable[i] = sdescriptor[7 + i];159 }160 }161 115 162 116 /**
Note:
See TracChangeset
for help on using the changeset viewer.