Enhancement/speed up ortho

The orthorectification is now much faster (factor 6-10) and not stuck anymore in deadlocks.

Fixes issue #52 (closed).

@segl @nbohn