Update stabilized_sqp.cpp

Added #include <functional> since it uses std::plus or std::minus.