added test write function. added queue pointers
fixed usb pos. was using uint8 instead of uint16