Changed heading calculations to radians...Vic