int main(int argc, char** argv) { ros::init(argc, argv, "traj_action_server"); ros::NodeHandle node;//("~"); TrajActionServer jte(node); ros::spin(); return 0; }
int main(int argc, char** argv) { ros::init(argc, argv, "find_contact_node"); ros::NodeHandle node; Pr2GripperFindContact jte(node); ros::spin(); return 0; }
int main(int argc, char** argv) { ros::init(argc, argv, "gripper_action_node"); ros::NodeHandle node; Pr2GripperAction jte(node); ros::spin(); return 0; }
template<size_t I> void operator()(Int<I> const &) { auto& map_indice = bf::at_c<0>(tie); auto& jacob = bf::at_c<1>(tie); auto& residu = bf::at_c<2>(tie); auto& hessien = bf::at_c<5>(tie); auto& residus = bf::at_c<6>(tie); const auto& J = bf::at_c<I>(jacob).second; const auto& indice = bf::at_c<I>(map_indice); jtj(at_h(hessien,indice),J,J); jte(at_jte(residus,indice),J,residu,ttt::wrap<MatrixTag>()); //JaTJb (only trig sup) : ttt::unroll<I+1,S>(JaTJb<I,Tie>(tie)); }