Pimpest/toid
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

wip-behaviors #3

Merged
Pimpest merged 86 commits from wip-behaviors into main 2026-05-28 06:21:26 +00:00
Conversation 0 Commits 86 Files Changed 129 +2 -2
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Showing only changes of commit c48e483d60 - Show all commits

4
toid_bt/include/toid_bt/plugins/in_position_decorator.hpp
View File

@@ -51,13 +51,13 @@ public:
if(checkIfInPose(pose)) { if(checkIfInPose(pose)) {
if(checkIfPosesAreClose(last_pos, pose)) { if(checkIfPosesAreClose(last_pos, pose)) {
if(clock.now() - last_pos_change > rclcpp::Duration::from_seconds(timeout)) { if(rclcpp::Time(pose.header.stamp) - last_pos_change > rclcpp::Duration::from_seconds(timeout)) {
haltChild(); haltChild();
return BT::NodeStatus::SUCCESS; return BT::NodeStatus::SUCCESS;
} }
} else { } else {
last_pos = pose; last_pos = pose;
last_pos_change = clock.now(); last_pos_change = pose.header.stamp;
} }
} }