v4hn
2bee9d5f66
rearrange fallback test fixtures
2021-09-20 14:42:35 +02:00
v4hn
5d9efc3b2b
fallback tests: use fixture
2021-09-20 14:42:26 +02:00
v4hn
001eadaf3d
move fallback to separate test
2021-09-20 14:42:20 +02:00
v4hn
14380c5552
add another test to cover both cases for failing children
2021-09-20 14:42:14 +02:00
v4hn
3244ac92b1
disable ConnectStageInsideFallbacks
...
This should work, but will require more changes.
2021-09-20 14:42:08 +02:00
Robert Haschke
c6cdd1a970
Fix test Fallback.ActiveChildReset
2021-09-20 14:41:51 +02:00
j-kuehn
f6eadb3fc4
add unit tests for Fallbacks container
2021-09-20 14:41:42 +02:00
Robert Haschke
d0ab3c3703
Improve readability of internal-external bimap using tags ( #293 )
2021-09-16 13:52:34 +02:00
v4hn
06b3df9c30
split assert
...
so that it becomes obvious which condition triggered it.
2021-09-01 14:53:52 +02:00
v4hn
fa8d21741c
print debug message in runCompute
...
so that it prints from all containers
2021-09-01 14:53:14 +02:00
v4hn
f51f6eb982
address interface changes for object poses in MoveIt
...
Also include a check for the new object pose field in `Connecting::compatible()`.
2021-08-23 00:33:37 +02:00
v4hn
0273aec83e
remove dirty MOVEIT_MASTER-check
...
... in favor of checking version numbers.
Checking for one header was used for multiple independent things.
In theory we could do exact feature testing instead of using the next release number,
but in practice nobody cares about the individual commits between older releases.
2021-08-23 00:06:42 +02:00
v4hn
6b4eae9d51
ComputeIK: spawn failures with correct states
...
Otherwise all failures look correct in the introspection.
That was a stupid oversight at some point.
2021-08-21 22:15:21 +02:00
v4hn
ff86217f9a
do not modify scene in isTargetPoseColliding
...
Especially, do not create a custom scene at all.
The method only affects a RobotState.
Fixes https://github.com/ros-planning/moveit_task_constructor/issues/209
2021-08-21 22:15:12 +02:00
v4hn
74d33c4ec0
Merge different mockup implementations
...
Co-authored-by: Jascha Kühn <57101356+j-kuehn@users.noreply.github.com>
2021-07-07 14:25:42 +02:00
v4hn
4b1f240c21
test_container: correctly initialize robot_model
...
The local mocks do not care, but leaving a dangling nullptr
leads to segfaults with refactoring/new tests. :-)
2021-07-07 14:25:42 +02:00
v4hn
062c127b86
better API comments for StageCallback
2021-06-15 09:49:05 +02:00
Captain Yoshi
64b65e4eca
GenerateGraspPose: Handle RobotState.msg as pregrasp property ( #275 )
...
Co-authored-by: v4hn <me@v4hn.de>
2021-06-15 07:51:18 +02:00
v4hn
0e40b464ec
support TYPED_TEST_SUITE
...
Get rid of deprecation warning if new variant exists.
2021-06-04 14:19:52 +02:00
v4hn
1f51124ae5
add missing virtual destructor to CostTerm
...
Correctly pointed out by the clang-tidy CI.
2021-06-04 14:19:52 +02:00
v4hn
9d53987e53
satisfy clang-tidy & -Werror -Wall -Wextra
2021-06-04 14:19:52 +02:00
Robert Haschke
437cc550f2
Add missing semicolons after cleanup of MoveIt
2021-05-29 00:38:43 +02:00
Michael Görner
84d668b0d5
Split ClassLoader plugin code from main libraries ( #271 )
...
to work around https://github.com/ros/class_loader/issues/131
2021-05-29 00:38:02 +02:00
v4hn
059a939203
Fix test: correctly reset Interface
2021-05-28 00:20:07 +02:00
v4hn
58b1a020b5
Fix memory leak in unit test
2021-05-28 00:19:45 +02:00
Robert Haschke
f070247a25
Fix compiler warnings
2021-05-27 22:24:29 +02:00
j-kuehn
67fe4faa30
allow to consider specific joints only in cost terms
2021-05-25 15:47:18 +02:00
Robert Haschke
84ccd679d9
Fix compiler warnings
...
unused parameters and functions
2021-05-19 21:54:48 +02:00
v4hn
7eb8fad57e
remove unused helper method
2021-05-12 19:21:19 +02:00
v4hn
f7015ee021
fix pick_ur5 test
...
TAMS' models changed and often produces less solutions.
2021-05-12 19:21:19 +02:00
j-kuehn
d71c645d83
add visualization for Point goals ( #264 )
...
- move visualization from `getPoseGoal` to `compute`
- create target frame from `target_eigen` to allow visualization from Pose and Point goals
2021-05-11 10:53:15 +02:00
j-kuehn
ba0b4f6146
Improve arrow visualization for MoveRelative stage ( #255 )
...
Implement visualization as red-green arrow
* overload makeArrow to allow creation with points
* create new function for visualization
* if no plan is found, construct arrow from green cylinder and red arrow
* adjust arrow construction for backward propagators
2021-05-03 21:29:05 +02:00
Robert Haschke
cfcb1f274e
Fix more clang-tidy issues
2021-04-24 02:12:24 +02:00
Robert Haschke
4fa8c10f44
clang-tidy auto-fixes
2021-04-24 02:03:24 +02:00
Robert Haschke
889b61529b
Fix trailing white space
2021-04-23 23:49:50 +02:00
Robert Haschke
dc8cd34b86
Simplify tests
2021-04-01 00:21:07 +02:00
v4hn
4e09d78239
Implement pruning inside-to-outside of a container
...
- Remove public onNewFailure() interface
Moved to ContainerBasePrivate to reuse logic for serial and parallel containers.
- Add tests
2021-04-01 00:19:15 +02:00
v4hn
472a78800d
implement bimap for internal_external state map
...
Get hashing for inverted lookups, but incur
structural overhead.
Whether this is worth it depends on the number of mapped interface states
and the number of pruning/reactivation requests.
2021-03-30 15:19:49 +02:00
Robert Haschke
0e3ec0b6ec
fix constness
2021-03-30 15:19:49 +02:00
v4hn
106c138ef5
Implement pruning inside serial container
...
By inefficient inverse lookup.
Also add disabled test for the inverted inference (failure inside should prune outside)
2021-03-30 15:19:49 +02:00
Michael Görner
36d9d3e8c0
Rework PipelinePlanner creation ( #249 )
...
- Moved Task::createPlanner into PipelinePlanner::create
- Handle mutiple planner pipeline configs as introduced in https://github.com/ros-planning/moveit/pull/2127
2021-03-29 12:00:28 +02:00
Robert Haschke
4ee71881ae
Rework Pruning ( #221 )
2021-03-23 13:04:38 +01:00
Michael Görner
f2958a4a0b
Explicitly instantiate PropagatingEitherWay::send<> templates ( #246 )
...
Otherwise compiler was optimizing (inlining) them away.
2021-03-23 11:37:30 +01:00
v4hn
b7f80939ef
add more asserts to onNewSolution
...
Strictly speaking there is no need for the invariant,
but if something violates it a stage computed something it wasn't meant to.
2021-03-22 14:42:23 +01:00
v4hn
3b6c13e26b
only run propagators on enabled solutions
...
resolve simple pruning test
2021-03-22 14:42:23 +01:00
v4hn
3e5e1da429
add (failing) simple pruning test
...
to validate propagators do not compute disabled solutions.
It's also good to have a simpler test around than 2 connects.
2021-03-22 14:42:23 +01:00
v4hn
9cf3c01b9a
pruning tests: restructure tests
2021-03-22 14:42:23 +01:00
v4hn
be1c8292b5
add more (commented-out) debug statements
...
Also print generator symbol for completeness.
2021-03-22 14:42:23 +01:00
v4hn
e33962364d
resolve PruningMultiForward test
...
Every InterfaceState along the partial solution has to be disabled
for pruning, not just the ends that are currently relevant.
2021-03-22 14:42:23 +01:00
v4hn
f8f885966e
add failing pruning test for branching propagator
2021-03-22 14:42:23 +01:00