switch to C++
flags for ompl and add planner.cpp