STOMP motion planner for ROS Groovy