diff --git a/src/btree_nodes/src/nodes/GenerateXYPose.cpp b/src/btree_nodes/src/nodes/GenerateXYPose.cpp index 0c8f5bf..4ace1c4 100644 --- a/src/btree_nodes/src/nodes/GenerateXYPose.cpp +++ b/src/btree_nodes/src/nodes/GenerateXYPose.cpp @@ -77,6 +77,11 @@ BT::NodeStatus BT::GenerateXYPose::tick() { auto randomPose = std::make_shared(); randomPose->position.x = pos.x; randomPose->position.y = pos.y; + randomPose->position.z = 0; + randomPose->orientation.w = 0; + randomPose->orientation.x = 0; + randomPose->orientation.y = 0; + randomPose->orientation.z = 0; printf("Generated Target: %f %f\n", pos.x, pos.y); setOutput>("pose", randomPose);