Speeds up ik calculation by using np builtins

Speeds up the ik by roughly 50% just by introducing np builtins instead of calculating inverse by hand.

Success rate remained the same (tested a couple of thousand IKs)