#include <sstream>#include <set>#include <vector>#include <string>#include <ros/ros.h>#include <boost/shared_ptr.hpp>#include <boost/pointer_cast.hpp>#include <kdl/chainjnttojacsolver.hpp>#include "cob_twist_controller/constraints/constraint.h"#include "cob_twist_controller/constraints/constraint_params.h"#include "cob_twist_controller/constraints/constraint_ca_impl.h"#include "cob_twist_controller/constraints/constraint_jla_impl.h"
