Implement smarter keypoint insertion (closes #5)
This is implemented by choosing the first and second existing keypoints that are closer to the insertion point and choosing the appropriate index such that the new keypoint is inserted correctly.
This is implemented by choosing the first and second existing keypoints that are closer to the insertion point and choosing the appropriate index such that the new keypoint is inserted correctly.