Added more functions from prrts.c to pRRTstar.cpp.