Package: opof-sbmp
opof-sbmpOPOFSampling-based motion planning (SBMP) domains for high-DoF robots to accomplish real-world picking tasks. They include the optimization of planner hyperparameters, sampling distributions, and projections.opof-sbmpis maintained by theKavraki Labat Rice University.Installation$pipinstallopof-sbmpopof-sbmpis officially tested and supported for Python 3.9, 3.10 and Ubuntu 20.04, 22.04.Domain:SBMPHyp[env,planner]fromopof_sbmp.domainsimportSBMPHyp# Creates a SBMPHyp domain instance for the "Bookshelf" environment using the "RRTConnect" planner.domain=SBMPHyp("Bookshelf","RRTConnect")DescriptionWe explore doing sampling-based motion planning in a specifiedenvironmentusing a specifiedplanner.
Unlike the grid world domains, these planners are much more complex and the relationship between the choice of planning parameters and planner performance is unclear.
This makes it particularly suitable for OPOF, since we treat the planner as closed black-box function and specifically assume no knowledge of the planner's internals.Planner optimization problemThe robot is tasked with moving its arm(s) from a start configuration to a goal configuration by running a sampling-based motion planner.
The planner optimization problem is to find a generator $G_\theta(c)$ that maps a problem instance $c$
(in this case, the combination of obstacle poses in the environment and the start and goal robot configurations) to a set of planner hyperparameters
(which depend on the planner used), such that the number of planner iterations taken for the motion planner to find a path is minimized.Planning objective$\boldsymbol{f}(x; c)$ is given as $-iter / {max\_{iter}}$, where $iter$ is the number of planner iterations taken for the
motion planner to find a collision-free path from the start to goal robot configuration, and $max\_iter$ is the maximum allowed
planner iterations.Problem instance distributionThe training set and testing set contain $1000$ and $100$ problem instances respectively.
These problem instances are adapted fromMotionBenchMaker.
Obstacle positions are sampled according to a predefined distribution,
while start and goal configurations are sampled using inverse kinematics for some environment-specific task.EnvironmentsCageDescriptionA (6)-dof UR5 robot is tasked to pick up a block (green) in a cage, starting from a random robot configuration.
The position and orientation of the cage, as well as the position of the block in the cage, are randomized.BookshelfDescriptionA (8)-dof Fetch robot is tasked to reach for a cylinder in a bookshelf, starting from a random robot configuration.
The position and orientation of the bookshelf and cylinders, as well as the choice of cylinder to reach for, are randomized.TableDescriptionA (14)-dof dual-arm Baxter robot must fold its arms crossed in a constricted space underneath a table and in between two vertical bars,
starting from a random robot configuration. The lateral positions of the vertical bars are randomized.PlannersRRTConnectDescriptionWe grow two random search trees from the start and the goal configurations toward randomly sampled target points in the free space, until the two trees connect.Planner hyperparametersWe tune the following parameters:aweightvector $\in \mathbb{R}^{50}$ with non-negative entries summing to $1$, which controls the sampling of target points using the experience-based sampling scheme adapted fromhere.The package currently supports simultaneously optimizing other parameters such as therangeparameter. However, the learning of such simultaneous parameters
have yet to be properly studied for RRTConnect. Thus, we do not include the these additional parameters by default.LBKPIECE1DescriptionTwo random search trees are grown from the start and the goal configurations, but controls the exploration of the configuration space using grid-based projections.We note that the learning of conditional hyperparameters for LBKPIECE1 has not been well studied. Thus, this planner should be exploratory for now (i.e. it should
not be used as a baseline to compare learning algorithms).Planner hyperparametersWe tune the following parameters:range$\in [0.01, 5.00]$ which determines ho wmuch to extend the trees at each step;border_fraction$\in [0.001, 1]$ which determins how much to focus exploration on unexplored cells;min_valid_path_fraction$\in [0.001, 1]$ which determins the threshold for which partially valid extensions are allowed; andaprojectionvector $[0, 1]^{2 \times d} \subset \mathbb{R}^{2 \times d}$ which corresponds to the linear projection function used to induce the 2-dimensional exploration grid, where $d$ is the robot's number of degrees of freedom.CitingIf you useopof-sbmp, please cite us with:@article{lee23opof,
  author = {Lee, Yiyuan and Lee, Katie and Cai, Panpan and Hsu, David and Kavraki, Lydia E.},
  title = {The Planner Optimization Problem: Formulations and Frameworks},
  booktitle = {arXiv},
  year = {2023},
  doi = {10.48550/ARXIV.2303.06768},
}

@article{lee22apes,
  title={Adaptive Experience Sampling for Motion Planning using the Generator-Critic Framework},
  author = {Lee, Yiyuan and Chamzas, Constantinos and E. Kavraki, Lydia},
  year = {2022},
  month = jul,
  journal={IEEE Robotics and Automation Letters},
}Licenseopof-sbmpis licensed under theBSD-3 license.opof-sbmpincludes a copy of the following libraries as dependencies. These copies are protected and distributed according to the corresponding original license.Boost(homepage):Boost Software LicenseEigen(homepage):MPL2OMPL(homepage):BSD-3opof-sbmpis maintained by theKavraki Labat Rice University, funded in part by NSF RI 2008720 and Rice University funds.