D. Szabo and 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, doi: 10.25046/aj040649.