Added heap code, updated readme with bug info