Worked on heap

Worked on heap implementation and JUnitTests