D. Szabo, E.G. Szadeczky-Kardoss "Novel Cost Function based Motion-planning Method for Robotic Manipulators", Advances in Science, Technology and Engineering Systems Journal, vol. 4, no. 6, pp. 386-396 (2019).