Add USB function switching
Remove CPU params from init