mirror of
https://github.com/moveit/moveit_task_constructor.git
synced 2025-11-04 14:49:57 +08:00
print debug message in runCompute
so that it prints from all containers
This commit is contained in:
parent
f51f6eb982
commit
fa8d21741c
@ -43,6 +43,8 @@
|
|||||||
#include <moveit/task_constructor/cost_terms.h>
|
#include <moveit/task_constructor/cost_terms.h>
|
||||||
#include <moveit/task_constructor/cost_queue.h>
|
#include <moveit/task_constructor/cost_queue.h>
|
||||||
|
|
||||||
|
#include <ros/console.h>
|
||||||
|
|
||||||
#include <ostream>
|
#include <ostream>
|
||||||
#include <chrono>
|
#include <chrono>
|
||||||
|
|
||||||
@ -148,6 +150,7 @@ public:
|
|||||||
void newSolution(const SolutionBasePtr& solution);
|
void newSolution(const SolutionBasePtr& solution);
|
||||||
bool storeFailures() const { return introspection_ != nullptr; }
|
bool storeFailures() const { return introspection_ != nullptr; }
|
||||||
void runCompute() {
|
void runCompute() {
|
||||||
|
ROS_DEBUG_STREAM_NAMED("Stage", "Computing stage '" << name() << "'");
|
||||||
auto compute_start_time = std::chrono::steady_clock::now();
|
auto compute_start_time = std::chrono::steady_clock::now();
|
||||||
compute();
|
compute();
|
||||||
auto compute_stop_time = std::chrono::steady_clock::now();
|
auto compute_stop_time = std::chrono::steady_clock::now();
|
||||||
|
|||||||
@ -640,7 +640,6 @@ void SerialContainer::compute() {
|
|||||||
if (!stage->pimpl()->canCompute())
|
if (!stage->pimpl()->canCompute())
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
ROS_DEBUG("Computing stage '%s'", stage->name().c_str());
|
|
||||||
stage->pimpl()->runCompute();
|
stage->pimpl()->runCompute();
|
||||||
} catch (const Property::error& e) {
|
} catch (const Property::error& e) {
|
||||||
stage->reportPropertyError(e);
|
stage->reportPropertyError(e);
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user