1st Debugging, insertionsort works

- Heap compiles, have not tested any of it yet.
- insertionsort works and prints correctly.