Singularity robust algorithm in serial manipulators - Oetomo, D. (2014)
10.1016/j.rcim.2007.09.007