Move USB code out of main.c
Command parser, configuration, and some commands