Add add_cost method in the inverse kinematics#130

Giulero merged 4 commits intomaingbionics/adam:mainfrom

add_cost_methodgbionics/adam:add_cost_methodCopy head branch name to clipboard