stomp_moveit_interface: first implementation, compiles