Adding initial code and debug harness