Fix USB Mass Storage issue

This should fix USB Mass storage issue.I've not tested it on your source yet.