Some changes to hart85 algo...not as easy as it looked!!