Currently segmenting because of RRTstar.cpp
Segmentation fault identified
Segmentation fault identified
First CForest path-shared version done
path sharing changed by state sharing
towards clean RRTForest
towards clean RRTForest
Stable RRTForest path shared version
Clean CForest
Clean CForest