Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
12 changes: 12 additions & 0 deletions visualization/motion_planning_tasks/src/task_display.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -184,12 +184,24 @@ void TaskDisplay::calculateOffsetPosition() {
scene_node_->setOrientation(orientation);
}

#if RCLCPP_VERSION_GTE(30, 0, 0)
void TaskDisplay::update(std::chrono::nanoseconds wall_dt, std::chrono::nanoseconds ros_dt) {
requestPanel();
Display::update(wall_dt, ros_dt);
calculateOffsetPosition();
using namespace std::chrono;
float wall_dt_s = duration_cast<duration<float>>(wall_dt).count();
float ros_dt_s = duration_cast<duration<float>>(ros_dt).count();
trajectory_visual_->update(wall_dt_s, ros_dt_s);
}
#else
void TaskDisplay::update(float wall_dt, float ros_dt) {
requestPanel();
Display::update(wall_dt, ros_dt);
calculateOffsetPosition();
trajectory_visual_->update(wall_dt, ros_dt);
}
#endif

void TaskDisplay::changedRobotDescription() {
if (isEnabled())
Expand Down
6 changes: 6 additions & 0 deletions visualization/motion_planning_tasks/src/task_display.h
Original file line number Diff line number Diff line change
Expand Up @@ -38,6 +38,8 @@

#pragma once

#include <chrono>
#include <rclcpp/version.h>
#include <rviz_common/display.hpp>
#include <rviz_common/ros_integration/ros_client_abstraction_iface.hpp>
#include <moveit/visualization_tools/task_solution_visualization.h>
Expand Down Expand Up @@ -83,7 +85,11 @@ class TaskDisplay : public rviz_common::Display

void loadRobotModel();

#if RCLCPP_VERSION_GTE(30, 0, 0)
void update(std::chrono::nanoseconds wall_dt, std::chrono::nanoseconds ros_dt) override;
#else
void update(float wall_dt, float ros_dt) override;
#endif
void reset() override;
void save(rviz_common::Config config) const override;
void load(const rviz_common::Config& config) override;
Expand Down
Loading