Restructured testbench, added init functions, switched to using fprintf for debugging purposes