Cleared up USB handling, working on main loop routines