Initial commit
PQP v1.3
Added CMakeLists for compatibility with OMPL