Add mass storage USB mode support