Created
August 28, 2020 11:39
-
-
Save JeroenDM/ed2b84ac769730084d35e348f4bb8f53 to your computer and use it in GitHub Desktop.
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| // debug code for MoveIt ompl interface ConstrainedPlanningStateSpace::getValueAddressAtIndex method | |
| // (jeroendm) left in the debug code, because it is not unlikely that issues will arise here when adding new things in | |
| // the future. Use dynamic casting to make our debugging live easier. | |
| // -------------------------------------------------------------------------- | |
| // auto casted_state = dynamic_cast<ompl_interface::ConstrainedPlanningStateSpace::StateType*>(ompl_state); | |
| // if (casted_state) | |
| // { | |
| // return casted_state->values + index; | |
| // } | |
| // else | |
| // { | |
| // ROS_ERROR_STREAM("ompl_interface::ConstrainedPlanningStateSpace::getValueAddressAtIndex:" | |
| // " got unexpected state type!!."); | |
| // } | |
| // return nullptr; | |
| // -------------------------------------------------------------------------- |
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment