[extensions] Optimize part of vincenty_inverse and add more tests.

Replace trigonometric functions (6 calls) with identity using sqrt (2
calls).

One new test is failing. The tests for azimuth21 are still disabled.