Add header comments
Add heap implementation
Update to-do list in README