Commit Graph

514 Commits

Author SHA1 Message Date
Robert Haschke
e58488ad75 Revert "Enable parallel planning with PipelinePlanner (#450)"
This reverts commit 0e02fcae77.
2025-06-02 20:45:36 +02:00
Marq Rasmussen
584197ab76
Let Task::preempt() cancel execute() (#684)
Some checks failed
CI / ${{ matrix.env.IMAGE }}${{ matrix.env.NAME && ' • ' || ''}}${{ matrix.env.NAME }}${{ matrix.env.CLANG_TIDY && ' • clang-tidy' || '' }} (map[CLANG_TIDY:pedantic IMAGE:rolling-source]) (push) Has been cancelled
CI / ${{ matrix.env.IMAGE }}${{ matrix.env.NAME && ' • ' || ''}}${{ matrix.env.NAME }}${{ matrix.env.CLANG_TIDY && ' • clang-tidy' || '' }} (map[DOCKER_RUN_OPTS:-e PRELOAD=libasan.so.8 -e LSAN_OPTIONS="suppressions=$PWD/.github/workflows/lsan.suppressio… (push) Has been cancelled
CI / ${{ matrix.env.IMAGE }}${{ matrix.env.NAME && ' • ' || ''}}${{ matrix.env.NAME }}${{ matrix.env.CLANG_TIDY && ' • clang-tidy' || '' }} (map[IMAGE:rolling-source NAME:ccov TARGET_CMAKE_ARGS:-DCMAKE_BUILD_TYPE=Debug -DCMAKE_CXX_FLAGS="--coverage"]) (push) Has been cancelled
Format / pre-commit (push) Has been cancelled
2025-05-29 20:31:15 +02:00
Robert Haschke
dd74b59061 Merge branch 'master' into ros2 2025-02-11 08:59:27 +01:00
Robert Haschke
9ea1692f96
Correctly report failures instead of issueing console warnings
Don't use command-line warnings, but spawn failure solutions.
2025-02-06 15:09:15 +01:00
Robert Haschke
cf1c452614 Merge branch 'master' into ros2 2025-01-19 17:52:32 +01:00
Ali Haider
a924b566fb
Fix typo 2025-01-05 23:09:58 +01:00
Robert Haschke
325c4012f5 Merge branch 'master' into ros2 2024-12-22 14:12:55 +01:00
Robert Haschke
4dfcf09516 clang-format-14 2024-12-22 14:09:08 +01:00
Robert Haschke
45ea86c163 clang-tidy fixes: use uint8_t enums 2024-12-22 12:28:58 +01:00
Robert Haschke
5067dbb432 clang-tidy fixes 2024-12-22 12:28:26 +01:00
Cihat Kurtuluş Altıparmak
3cd567e09b
Use .hpp headers (#641)
based on PR https://github.com/moveit/moveit2/pull/3113
2024-12-22 12:13:33 +01:00
Robert Haschke
8b4aa43712 Merge branch 'master' into ros2 2024-12-09 09:54:45 +01:00
JafarAbdi
5d23cb89df Add support for GenerateRandomPose 2024-12-09 09:53:07 +01:00
Robert Haschke
dc8399f221 Merge branch 'master' into ros2 2024-10-15 20:06:22 +02:00
Robert Haschke
b3b5ee6086 CI: Update pre-commit hooks / clang-format-14 2024-10-15 19:52:23 +02:00
Michael Görner
721ff356b7
provide a fmt wrapper (#615)
for special eigen formatter, which is not available in fmt9

https://github.com/fmtlib/fmt/issues/3465
https://stackoverflow.com/a/73755864/21260084
2024-09-24 20:41:12 +02:00
Robert Haschke
cc7f9f0585 Merge branch 'master' into ros2 2024-09-17 15:00:39 +02:00
Robert Haschke
99ccc115e0
Update API: JumpThreshold -> CartesianPrecision (#611)
Python: Access properties via writable references
This allows to modify properties in place, e.g. cartesian_solver.precision.translational = 0.01
2024-09-17 10:59:14 +02:00
Captain Yoshi
fdc06c3b91
Reduce stop time due to preempt (#598)
The preempt_request_ flag was only checked at the top-level task container before each compute iteration.
As a single sweep might take a while, we should check the flag before computing each stage.
2024-07-19 15:46:12 +02:00
Captain Yoshi
cd28bdcd1f
Fix early planning preemption (#597)
Calling preempt() before plan() is able to reset the preempt_requested_ flag causes the preemption request to get lost. To avoid this issue, we allow a) manual resetting of the request and b) reset the request before leaving plan().
2024-07-17 14:56:01 +02:00
Robert Haschke
29d12196da Reenable python bindings 2024-07-13 02:08:30 +02:00
Robert Haschke
98000f37ff Merge branch 'master' into ros2 2024-07-13 02:07:53 +02:00
Robert Haschke
4debc37904 Silence gcc's overloaded-virtual warnings 2024-07-11 09:50:35 +02:00
Robert Haschke
fbc05e4496
Add property to enable/disable pruning at runtime (#590) 2024-07-06 16:51:14 +02:00
Robert Haschke
42a08d6444 PassThrough: cleanup unused headers 2024-07-04 11:57:31 +02:00
Robert Haschke
b1336dc210 CartesianPath: allow ik_frame definition
... if start and end are given as joint-space poses
2024-06-29 18:02:05 +02:00
Robert Haschke
177e19de1f Generalize utils::getRobotTipForFrame()
... to return error_msg instead of calling markAsFailure() on a solution
2024-06-29 17:55:45 +02:00
Robert Haschke
7666f73e04
Simplify formatting code with https://github.com/fmtlib (#499)
* Simplify formatting code with https://github.com/fmtlib
* Update to clang-format-12
2024-05-25 19:12:42 +02:00
Robert Haschke
5d2857be6b Merge branches 'simplify-node-creation' and 'master' into ros2 2024-05-24 14:39:38 +02:00
Captain Yoshi
a0c00646c2
Add NoOp stage (#534)
This stage can be used to add arbitrary user-defined properties w/o modifying the PlanningScene state or adding a trajectory.

Co-authored-by: Robert Haschke <rhaschke@techfak.uni-bielefeld.de>
2024-05-24 14:34:27 +02:00
Robert Haschke
54e653ebdb Fix failing assertion
The cost of a newly created Priority does not need to be finite.
An example occurs in the Pick+Place demo: the CurrentState solution
is filtered by an applicibility test, which may set the cost to infinity
while lifting the solution to the wrapper stage.
In this case, new InterfaceStates are created from the infinite cost solution.
Consequently, the state should be marked as PRUNED.
2024-05-24 12:02:20 +02:00
Robert Haschke
405755595a Switch to package py_binding_tools 2024-05-23 14:08:49 +02:00
Captain Yoshi
ad19ea5479
Add ability to move CollisionObjects (#567) 2024-05-12 11:03:47 +02:00
Daniel García López
560aa0a476
Add Generator::spawn(from, to, trajectory) variant (#546) 2024-03-20 15:32:15 +01:00
Robert Haschke
739375298a Merge branch master into ros2 2024-03-09 13:34:36 +01:00
Robert Haschke
55c4b52b13 Cosmetic fixes 2024-03-09 11:11:01 +01:00
Abishalini
e09fecd71f Propagate errors from planners to solution comment (#525) 2024-03-08 11:13:10 +01:00
Robert Haschke
d0a904c313 Add property trajectory_execution_info (#355, #502)
... to pass a list of controller names to PlanExecution

---------

Co-authored-by: Luca Lach <llach@techfak.uni-bielefeld.de>
2024-03-07 20:01:03 +01:00
Henning Kayser
111d9ba207
Add GenerateRandomPose stage (#166)
Implements a generic pose randomizer

Co-authored-by: JafarAbdi <cafer.abdi@gmail.com>
Co-authored-by: Sebastian Jahr <sebastian.jahr@picknik.ai>
Co-authored-by: Robert Haschke <rhaschke@techfak.uni-bielefeld.de>
2024-03-06 22:32:13 +01:00
Sebastian Jahr
1e058598c7 Add planner_id to SubTrajectory info (#490) 2024-03-06 18:11:57 +01:00
Sebastian Jahr
0e02fcae77 Enable parallel planning with PipelinePlanner (#450)
* Refactor pipeline planner

Make code readable

Re-order plan functions

Make usable with parallel planning

Enable configuring multiple pipelines

Add callbacks

Cleanup and documentation

Add API to set parallel planning callbacks and deprecate functions

Pass pipeline map by reference

Small clang-tidy fix

Update core/src/solvers/pipeline_planner.cpp

Co-authored-by: Sebastian Castro <4603398+sea-bass@users.noreply.github.com>

Update core/src/solvers/pipeline_planner.cpp

Format

Refactor to avoid calling .at(0) twice

Use no default stopping criteria

Update fallbacks_move demo

* Cleanup + address deprecation warnings

* Enabling optionally using a property defined pipeline planner map

* Address review

* Disable humble CI for ros2 branch

* Add pipeline planner unittests + some checks

* Add short comment
2024-03-06 15:59:09 +01:00
Captain Yoshi
911bc67c4d
GenerateGraspPose: Expose rotation_axis as property (#535) 2024-03-06 11:02:44 +01:00
Captain Yoshi
5720b83dce
Connect: ensure end-state matches goal state (#532) 2024-02-25 16:58:56 +01:00
Robert Haschke
bf2714b42d printPendingPairs(os) -> os<<pendingPairsPrinter() 2023-10-25 22:21:36 +02:00
Robert Haschke
7b965863e3 Add more debugging output
- Add Stage::introspection() accessor
- Introspection: debug-log solution registration
- RemoteSolutionModel: show internal solution id as tooltip in 1st column
2023-10-25 22:19:49 +02:00
Michael Görner
ab4bb40dfd
Fix demos (#493)
* improve demo rviz config
  - orbit view centered at workspace instead of 2d orbit
  - REALTIME trajectory display
* FixedState: setter for ignore_collisions property
* Fix clearance_cost demo
  - verify default state
  - use model frame over virtual "world" which is not known in fresh PlanningScene
  - ignore initial collisions with the IK seed
* improve documentation in Fallbacks demo
2023-10-11 14:30:54 +02:00
Robert Haschke
349e3c6c6c Merge branch master into ros2 2023-05-26 16:38:15 +02:00
Robert Haschke
6f7282423d MPS: fixup processCollisionObject
- Declare CollisionObject argument as constant:
  Internally the argument is temporarily modified, but for a caller it is effectively const.
- Correctly restore the old operation mode
- Fixup check in unit test
2023-05-26 01:15:50 +02:00
Robert Haschke
397fc070ea Fix SolutionBase::fillMessage(): also write start_scene
This method was only doing half of the job, namely adding subsolutions
to the message fields. However, the start_scene was not yet written.
This was handled manually in some but not all callers.
To avoid this inconsistency, the new method toMsg() takes care of both
actions now, while the old fillMessage() method was renamed to appendTo().
2023-05-19 08:43:14 +02:00
Robert Haschke
bd400de184 Fix add/remove object in backward operation
- addObject() will actually remove the object from scene
- removeObject() is not supported (we would need to know which object to add)
2023-05-19 08:43:12 +02:00