Added a reset command in firmware.  Expanded the test routing in subwrapper