Make usb more robust
Add i2cm_test2