Working msm_otg.c for testing