I don't already know how the fuck it works, but it is.
A bit slow currently, but hope to improve it soon.
The current limitations:
1. No constraints. At all.
2. Used simplest CCD algorithm, I just can't believe
in jacobian construction from code.
3. Slow to get to target.
Sergey Lapin