aikido:gilwoo/SequenceConfigurationToConfigurationMetaPlanner

Last commit made on 2022-11-23
Get this branch:
git clone -b gilwoo/SequenceConfigurationToConfigurationMetaPlanner https://git.launchpad.net/aikido

Branch merges

Branch information

Name:
gilwoo/SequenceConfigurationToConfigurationMetaPlanner
Repository:
lp:aikido

Recent commits

47d6ed5... by Ethan Gordon <email address hidden>

Merge branch 'master' into gilwoo/SequenceConfigurationToConfigurationMetaPlanner

ce7dd79... by Ethan Gordon <email address hidden>

Update code maintainers (#627)

7012618... by Ethan Gordon <email address hidden>

Add ability to clear frame and trajectory markers from Rviz (#625)

* Add ability to clear frame and trajectory markers from InteractiveMarkerViewer

* update CHANGELOG

* Remove default arg

d5e4223... by Ethan Gordon <email address hidden>

Make sure self-collision chcks entire skeleton, not just subrobot (#624)

b7d96e2... by Ethan Gordon <email address hidden>

Add VisualServoingVelocityExecutor class (#620)

* example interface

* add separate placeholder for new robot interface

* include required FCL dep

* set root robot

* test plan to config

* add collision checking

* first commit before templatizing subrobot registration

* minor updates

* minor updates and move TODOs to issues

* nit name change

* Remove RosPositionCommandExecutor and pr_control_msgs, will refactor with updated control_msgs

* Re-add pr_control_msgs as dep

* Add Executor base class, add empty header files for RosJointGoup Executors

* Add pass-through Position/Velocity/Effort Executors based on JointGroupCommandAction

* Ran make format

* Summarize changes in CHANGELOG

* Add cancel command to pass-thru executors

* Add KinematicSimulationPositionExecutor

* Added KinematicSimulationVelocityExecutor (builds, not tested)

* Add test for KinematicSimulationPositionExecutor

* Fixed linker errors, still doesn't quite pass PositionExecutor tests

* Working tests for KinematicSimulationPositionExecutor

* Add test for KinematicSimulationVelocityExecutor

* Allow execute to overwrite previous pos/vel commands, plus remove XCode test dep until fixed

* Make format

* Initial commit to add JacobianVelocityExecutor

* Update CHANGELOG

* Template ROS, Kinematic, and base executor classes for easier review

* Addressed comments and ran make format

* Updated control.hpp list to reflect templating.

* Remove extra reference to deleted classes, and install new deps for CI

* Split off ROS-specific functions of Robot into subclass, update interface to re-add basic planning functions, and get the whole thing to build

* No longer globally require urdf and srdfdom, only for robot_ros

* Explicitly add control as component dependency for robot since we use KinematicSimulationTrajectoryExecutor (and will use others in the future)

* Re-ran make format for clang-format-10

* Added RNG and trajectory post-processing management to Robot

* Added summary to CHANGELOG and added WorldPtr functionality

* Fixed formatting on docstring

* Flesh out step functionality to propogate to all subrobots

* Switch to configuration interface instead of state interface, plus add skeleton locking

* Add ability to specify postprocessor for each plan

* Forgot postprocessor in function def

* Make format

* Expose metaskeleton

* Enforce root robot MetaSkeleton to be true Skeleton, and subrobots are ReferentialSkeletons referencing the root Skeleton

* Move all implementations to cpp file

* Fixed segfault by early cast of goalState, plus limited statespace to controlled metaskeleton, plus have child robots handle their own collisionfree generation to ensure statespaces match

* Fixed segfaults plus tested both self and world collision checker

* Don't init subrobots with shared_ptr root, as this dobule-frees everything on destruction

* Make format

* Make loadSkeletonFromURDF externally accessible

* Get world from parent robot

* Addressed comments and add DoF resource manager

* Finished addressing comments by checking traj statespae vs provided Dofs

* Ran make format

* Added control::Executor test, and fixed up other executor tests

* Null check on TrajectoryExecutor in ConcreteRobot

* Re-added PlanToOffset with default vector field parameters

* Update DART version in README

* WIP: Updated Robot.hpp

* WIP: New executor swapping interface

* Removed merge conflict artifacts

* [WIP] JacobianExecutor builds

* Make format

* [WIP] Executor list compiles, now needs unit tests

* [WIP] Ran make format

* Added tests to new Robot executor interface

* Add const back to dofs getter

* Ran make format

* Add tests for JacobianExecutor

* VisualServoingExecutor now builds

* Added VisualServoingExecutor Tests

* Update CHANGELOG

* Make tighter default lambda

* Add getter/setter for visual servoing properties

* Better EXPECT_NEAR criterion, within one step of the timeout

* Addressed comments

Co-authored-by: Aditya Vamsikrishna Mandalika <email address hidden>
Co-authored-by: Aditya Vamsikrishna Mandalika <email address hidden>

4966b53... by Ethan Gordon <email address hidden>

Add non-trajectory executors to Robot Class (#614)

* example interface

* add separate placeholder for new robot interface

* include required FCL dep

* set root robot

* test plan to config

* add collision checking

* first commit before templatizing subrobot registration

* minor updates

* minor updates and move TODOs to issues

* nit name change

* Remove RosPositionCommandExecutor and pr_control_msgs, will refactor with updated control_msgs

* Re-add pr_control_msgs as dep

* Add Executor base class, add empty header files for RosJointGoup Executors

* Add pass-through Position/Velocity/Effort Executors based on JointGroupCommandAction

* Ran make format

* Summarize changes in CHANGELOG

* Add cancel command to pass-thru executors

* Add KinematicSimulationPositionExecutor

* Added KinematicSimulationVelocityExecutor (builds, not tested)

* Add test for KinematicSimulationPositionExecutor

* Fixed linker errors, still doesn't quite pass PositionExecutor tests

* Working tests for KinematicSimulationPositionExecutor

* Add test for KinematicSimulationVelocityExecutor

* Allow execute to overwrite previous pos/vel commands, plus remove XCode test dep until fixed

* Make format

* Initial commit to add JacobianVelocityExecutor

* Update CHANGELOG

* Template ROS, Kinematic, and base executor classes for easier review

* Addressed comments and ran make format

* Updated control.hpp list to reflect templating.

* Remove extra reference to deleted classes, and install new deps for CI

* Split off ROS-specific functions of Robot into subclass, update interface to re-add basic planning functions, and get the whole thing to build

* No longer globally require urdf and srdfdom, only for robot_ros

* Explicitly add control as component dependency for robot since we use KinematicSimulationTrajectoryExecutor (and will use others in the future)

* Re-ran make format for clang-format-10

* Added RNG and trajectory post-processing management to Robot

* Added summary to CHANGELOG and added WorldPtr functionality

* Fixed formatting on docstring

* Flesh out step functionality to propogate to all subrobots

* Switch to configuration interface instead of state interface, plus add skeleton locking

* Add ability to specify postprocessor for each plan

* Forgot postprocessor in function def

* Make format

* Expose metaskeleton

* Enforce root robot MetaSkeleton to be true Skeleton, and subrobots are ReferentialSkeletons referencing the root Skeleton

* Move all implementations to cpp file

* Fixed segfault by early cast of goalState, plus limited statespace to controlled metaskeleton, plus have child robots handle their own collisionfree generation to ensure statespaces match

* Fixed segfaults plus tested both self and world collision checker

* Don't init subrobots with shared_ptr root, as this dobule-frees everything on destruction

* Make format

* Make loadSkeletonFromURDF externally accessible

* Get world from parent robot

* Addressed comments and add DoF resource manager

* Finished addressing comments by checking traj statespae vs provided Dofs

* Ran make format

* Added control::Executor test, and fixed up other executor tests

* Null check on TrajectoryExecutor in ConcreteRobot

* Re-added PlanToOffset with default vector field parameters

* Update DART version in README

* WIP: Updated Robot.hpp

* WIP: New executor swapping interface

* Removed merge conflict artifacts

* [WIP] JacobianExecutor builds

* Make format

* [WIP] Executor list compiles, now needs unit tests

* [WIP] Ran make format

* Added tests to new Robot executor interface

* Add const back to dofs getter

* Ran make format

* Add tests for JacobianExecutor

* Make tighter default lambda

* Update CHANGELOG

* Remove deprecated function

* Removed auto-register DoFs from Executor class

* Do not clone metaskeleton when construction self-collision check, self collision blacklist isn't carried over

* Addressed comments

* Have executors try to register Dofs on threaad start

Co-authored-by: Aditya Vamsikrishna Mandalika <email address hidden>
Co-authored-by: Aditya Vamsikrishna Mandalika <email address hidden>

bda3396... by Ethan Gordon <email address hidden>

Adds JacobianExecutor (#605)

* example interface

* add separate placeholder for new robot interface

* include required FCL dep

* set root robot

* test plan to config

* add collision checking

* first commit before templatizing subrobot registration

* minor updates

* minor updates and move TODOs to issues

* nit name change

* Remove RosPositionCommandExecutor and pr_control_msgs, will refactor with updated control_msgs

* Re-add pr_control_msgs as dep

* Add Executor base class, add empty header files for RosJointGoup Executors

* Add pass-through Position/Velocity/Effort Executors based on JointGroupCommandAction

* Ran make format

* Summarize changes in CHANGELOG

* Add cancel command to pass-thru executors

* Add KinematicSimulationPositionExecutor

* Added KinematicSimulationVelocityExecutor (builds, not tested)

* Add test for KinematicSimulationPositionExecutor

* Fixed linker errors, still doesn't quite pass PositionExecutor tests

* Working tests for KinematicSimulationPositionExecutor

* Add test for KinematicSimulationVelocityExecutor

* Allow execute to overwrite previous pos/vel commands, plus remove XCode test dep until fixed

* Make format

* Initial commit to add JacobianVelocityExecutor

* Update CHANGELOG

* Template ROS, Kinematic, and base executor classes for easier review

* Addressed comments and ran make format

* Updated control.hpp list to reflect templating.

* Remove extra reference to deleted classes, and install new deps for CI

* Split off ROS-specific functions of Robot into subclass, update interface to re-add basic planning functions, and get the whole thing to build

* No longer globally require urdf and srdfdom, only for robot_ros

* Explicitly add control as component dependency for robot since we use KinematicSimulationTrajectoryExecutor (and will use others in the future)

* Re-ran make format for clang-format-10

* Added RNG and trajectory post-processing management to Robot

* Added summary to CHANGELOG and added WorldPtr functionality

* Fixed formatting on docstring

* Flesh out step functionality to propogate to all subrobots

* Switch to configuration interface instead of state interface, plus add skeleton locking

* Add ability to specify postprocessor for each plan

* Forgot postprocessor in function def

* Make format

* Expose metaskeleton

* Enforce root robot MetaSkeleton to be true Skeleton, and subrobots are ReferentialSkeletons referencing the root Skeleton

* Move all implementations to cpp file

* Fixed segfault by early cast of goalState, plus limited statespace to controlled metaskeleton, plus have child robots handle their own collisionfree generation to ensure statespaces match

* Fixed segfaults plus tested both self and world collision checker

* Don't init subrobots with shared_ptr root, as this dobule-frees everything on destruction

* Make format

* Make loadSkeletonFromURDF externally accessible

* Get world from parent robot

* Addressed comments and add DoF resource manager

* Finished addressing comments by checking traj statespae vs provided Dofs

* Ran make format

* Added control::Executor test, and fixed up other executor tests

* Null check on TrajectoryExecutor in ConcreteRobot

* Re-added PlanToOffset with default vector field parameters

* Update DART version in README

* WIP: Updated Robot.hpp

* WIP: New executor swapping interface

* Removed merge conflict artifacts

* [WIP] JacobianExecutor builds

* Make format

* [WIP] Executor list compiles, now needs unit tests

* [WIP] Ran make format

* Added tests to new Robot executor interface

* Add const back to dofs getter

* Ran make format

* Add tests for JacobianExecutor

* Make tighter default lambda

* Addressed comments

Co-authored-by: Aditya Vamsikrishna Mandalika <email address hidden>
Co-authored-by: Aditya Vamsikrishna Mandalika <email address hidden>

003ee72... by Ethan Gordon <email address hidden>

Check ability of Robot class to handle R0 joints (#622)

* Check ability of Robot class to handle R0 joints

* Update CHANGELOG

* Fixed nit

1303e3f... by Sherdil Niyaz <email address hidden>

[WIP] Create new AIKIDO IK solver class. (#616)

* Add simple IK interface header.

* Fix comment in last commit.

* Draft GradientDescentIk header.

* Add shell GradientDescentIk source file.

* Kill separate IK folder for robot.

* Add grad solver source to CMake, all hell breaks loose :)

* Get thinks to build, yay.

* Draft getsolutions() in GradientDescentIk!

* Small name/type tweaks.

* Think GradientDescentIk constructor drafted too?

* Run make format.

* Nit response.

* Whoops, don't apply!

* Add shell IkFast.

* Draft ikFast constructor.

* Write solve method in IkFast.

* Revert to solveAndApply().

* Damn capitalization gets you.

Co-authored-by: Amal Nanavati <email address hidden>

3b37ef4... by Amal Nanavati <email address hidden>

Fix the AddTSRMarker Bug (#618)

* Replaced raw frame ptrs with shared_ptrs

* Updated changelog