Test Bench close to done

Commands that need to be sent are all formatted. The data in the
commands just needs to be filled in. The tb does not complile right now