Faster implementation for position recovery. Having fun with Severyn figurating out the maths