We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
There was an error while loading. Please reload this page.
1 parent 0a3dd3a commit 6d104e8Copy full SHA for 6d104e8
core/src/stages/fixed_state.cpp
@@ -63,10 +63,12 @@ bool FixedState::canCompute() const {
63
}
64
65
void FixedState::compute() {
66
- auto cost = !properties().get<bool>("ignore_collisions") && scene_->isStateColliding() ?
67
- std::numeric_limits<double>::infinity() :
68
- 0.0;
69
- spawn(InterfaceState(scene_), cost);
+ SubTrajectory trajectory;
+ if (!properties().get<bool>("ignore_collisions") && scene_->isStateColliding()) {
+ trajectory.markAsFailure("in collision");
+ }
70
+
71
+ spawn(InterfaceState(scene_), std::move(trajectory));
72
ran_ = true;
73
74
} // namespace stages
0 commit comments