4242#include < hpp/manipulation/graph/state.hh>
4343#include < hpp/manipulation/steering-method/graph.hh>
4444#include < pinocchio/spatial/se3.hpp>
45+
4546#include " hpp/manipulation/constraint-set.hh"
4647
4748namespace {
@@ -676,7 +677,7 @@ void PyWGraph::registerConstraints(const ImplicitPtr_t& constraint,
676677// =============================================================================
677678
678679boost::python::tuple PyWGraph::getConfigErrorForState (PyWStatePtr_t component,
679- ConfigurationIn_t input) {
680+ ConfigurationIn_t input) {
680681 try {
681682 hpp::core::vector_t error;
682683 bool res = obj->getConfigErrorForState (input, component->obj , error);
@@ -686,8 +687,8 @@ boost::python::tuple PyWGraph::getConfigErrorForState(PyWStatePtr_t component,
686687 }
687688}
688689
689- boost::python::tuple PyWGraph::getConfigErrorForTransition (PyWEdgePtr_t edge,
690- ConfigurationIn_t input) {
690+ boost::python::tuple PyWGraph::getConfigErrorForTransition (
691+ PyWEdgePtr_t edge, ConfigurationIn_t input) {
691692 try {
692693 // Check if steering method is properly initialized
693694 if (!edge->obj ->parentGraph ()->problem ()->manipulationSteeringMethod () ||
@@ -705,17 +706,21 @@ boost::python::tuple PyWGraph::getConfigErrorForTransition(PyWEdgePtr_t edge,
705706 }
706707}
707708
708- boost::python::tuple PyWGraph::getConfigErrorForTransitionLeaf ( const PyWEdgePtr_t& edge,
709- ConfigurationIn_t leafConfig, ConfigurationIn_t config) const {
709+ boost::python::tuple PyWGraph::getConfigErrorForTransitionLeaf (
710+ const PyWEdgePtr_t& edge, ConfigurationIn_t leafConfig,
711+ ConfigurationIn_t config) const {
710712 hpp::core::vector_t error;
711- bool res = obj->getConfigErrorForEdgeLeaf (leafConfig, config, edge->obj , error);
713+ bool res =
714+ obj->getConfigErrorForEdgeLeaf (leafConfig, config, edge->obj , error);
712715 return boost::python::make_tuple (error, res);
713716}
714717
715- boost::python::tuple PyWGraph::getConfigErrorForTransitionTarget (const PyWEdgePtr_t& edge,
716- ConfigurationIn_t leafConfig, ConfigurationIn_t config) const {
718+ boost::python::tuple PyWGraph::getConfigErrorForTransitionTarget (
719+ const PyWEdgePtr_t& edge, ConfigurationIn_t leafConfig,
720+ ConfigurationIn_t config) const {
717721 hpp::core::vector_t error;
718- bool res = obj->getConfigErrorForEdgeTarget (leafConfig, config, edge->obj , error);
722+ bool res =
723+ obj->getConfigErrorForEdgeTarget (leafConfig, config, edge->obj , error);
719724 return boost::python::make_tuple (error, res);
720725}
721726
@@ -1054,8 +1059,8 @@ boost::python::tuple PyWGraph::createPlacementConstraint(
10541059 contactFunction->setNormalMargin (margin);
10551060
10561061 constraintsAndComplements.push_back (ConstraintAndComplement_t (
1057- std::get<0 >(constraints), std::get<1 >(constraints),
1058- std::get<2 >(constraints)));
1062+ std::get<0 >(constraints), std::get<1 >(constraints),
1063+ std::get<2 >(constraints)));
10591064
10601065 return boost::python::make_tuple (std::get<0 >(constraints),
10611066 std::get<1 >(constraints),
@@ -1156,9 +1161,8 @@ ImplicitPtr_t PyWGraph::createPrePlacementConstraint2(
11561161}
11571162
11581163boost::python::list PyWGraph::createGraspConstraint (const std::string& name,
1159- const std::string& gripper,
1160- const std::string& handle) {
1161-
1164+ const std::string& gripper,
1165+ const std::string& handle) {
11621166 boost::python::list result;
11631167
11641168 GripperPtr_t g = robot->obj ->grippers .get (gripper, GripperPtr_t ());
@@ -1170,20 +1174,20 @@ boost::python::list PyWGraph::createGraspConstraint(const std::string& name,
11701174 ImplicitPtr_t constraint (h->createGrasp (g, name));
11711175 ImplicitPtr_t complement (h->createGraspComplement (g, cname));
11721176 ImplicitPtr_t both (h->createGraspAndComplement (g, bname));
1173-
1177+
11741178 result.append (constraint);
11751179 result.append (complement);
11761180 result.append (both);
11771181
11781182 constraintsAndComplements.push_back (
11791183 ConstraintAndComplement_t (constraint, complement, both));
1180-
1184+
11811185 return result;
11821186}
11831187
11841188ImplicitPtr_t PyWGraph::createPreGraspConstraint (const std::string& name,
1185- const std::string& gripper,
1186- const std::string& handle) {
1189+ const std::string& gripper,
1190+ const std::string& handle) {
11871191 GripperPtr_t g = robot->obj ->grippers .get (gripper, GripperPtr_t ());
11881192 if (!g) throw std::runtime_error (" No gripper with name " + gripper + " ." );
11891193 HandlePtr_t h = robot->obj ->handles .get (handle, HandlePtr_t ());
0 commit comments