Adds a linear segment to the path from the lastPose to the endPose. The heading will be held constant at the lastPose's heading throughout the segment, regardless of the direction of travel.