Version 1152 was commited by markb on 2009-08-28 00:04:24 +0100 (Fri, 28 Aug 2009) Try harder to determine a valid initial heading. If the passed nextCoord point is equal to the source point, use the destination point instead to determine the initial heading.