Fixed heap. Fixed LPA* implementation. Added comments.