diff --git a/demo/src/cartesian.cpp b/demo/src/cartesian.cpp index edf8a76b..728a08f9 100644 --- a/demo/src/cartesian.cpp +++ b/demo/src/cartesian.cpp @@ -97,6 +97,14 @@ Task createTask() { t.add(std::move(stage)); } + { // perform a Cartesian motion, defined as a relative offset in joint space + auto stage = std::make_unique("joint offset", cartesian); + stage->setGroup(group); + std::map offsets = { { "panda_joint1", M_PI / 6. }, { "panda_joint3", -M_PI / 6 } }; + stage->setDirection(offsets); + t.add(std::move(stage)); + } + { // move from reached state back to the original state, using joint interpolation auto joint_interpolation = std::make_shared(); stages::Connect::GroupPlannerVector planners = { { group, joint_interpolation } };