https://1library.org/document/q7r12rky-multiple-manipulators-path-planning-using-double-a.html