Fixed c pretty printing to print pretty
Added a method to print the heap in a proper tree-like fashion