Added test for ompl library