rAKA/extra_packages/contact_alejandro/examples/optimization/fn_optimize.cc

bugfixes/clean…5d56e862d8fccef46d85f09…