Added insert into heap

- height is now calculated on the go
- added a swap function to swap heap node value