Updated USBStorage code - Legacy fix

Signed-off-by: Swizzy <swizzy@hotmail.co.uk>