Bug Fixes and debug command for TestNanoBot